]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - sound/soc/codecs/wm8731.c
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit...
[mirror_ubuntu-bionic-kernel.git] / sound / soc / codecs / wm8731.c
CommitLineData
40e0aa64
RP
1/*
2 * wm8731.c -- WM8731 ALSA SoC Audio driver
3 *
4 * Copyright 2005 Openedhand Ltd.
5 *
6 * Author: Richard Purdie <richard@openedhand.com>
7 *
8 * Based on wm8753.c by Liam Girdwood
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
13 */
14
15#include <linux/module.h>
16#include <linux/moduleparam.h>
17#include <linux/init.h>
18#include <linux/delay.h>
19#include <linux/pm.h>
20#include <linux/i2c.h>
5a0e3ad6 21#include <linux/slab.h>
40e0aa64 22#include <linux/platform_device.h>
7dea7c01 23#include <linux/regulator/consumer.h>
d2a40355 24#include <linux/spi/spi.h>
40e0aa64
RP
25#include <sound/core.h>
26#include <sound/pcm.h>
27#include <sound/pcm_params.h>
28#include <sound/soc.h>
29#include <sound/soc-dapm.h>
30#include <sound/initval.h>
d00efa64 31#include <sound/tlv.h>
40e0aa64
RP
32
33#include "wm8731.h"
34
5998102b 35static struct snd_soc_codec *wm8731_codec;
40e0aa64
RP
36struct snd_soc_codec_device soc_codec_dev_wm8731;
37
7dea7c01
MB
38#define WM8731_NUM_SUPPLIES 4
39static const char *wm8731_supply_names[WM8731_NUM_SUPPLIES] = {
40 "AVDD",
41 "HPVDD",
42 "DCVDD",
43 "DBVDD",
44};
45
b36d61d4
FM
46/* codec private data */
47struct wm8731_priv {
5998102b 48 struct snd_soc_codec codec;
7dea7c01 49 struct regulator_bulk_data supplies[WM8731_NUM_SUPPLIES];
5998102b 50 u16 reg_cache[WM8731_CACHEREGNUM];
b36d61d4
FM
51 unsigned int sysclk;
52};
53
a8035c8f 54
40e0aa64
RP
55/*
56 * wm8731 register cache
57 * We can't read the WM8731 register space when we are
58 * using 2 wire for device control, so we cache them instead.
59 * There is no point in caching the reset register
60 */
61static const u16 wm8731_reg[WM8731_CACHEREGNUM] = {
17a52fd6
MB
62 0x0097, 0x0097, 0x0079, 0x0079,
63 0x000a, 0x0008, 0x009f, 0x000a,
64 0x0000, 0x0000
40e0aa64
RP
65};
66
17a52fd6 67#define wm8731_reset(c) snd_soc_write(c, WM8731_RESET, 0)
40e0aa64
RP
68
69static const char *wm8731_input_select[] = {"Line In", "Mic"};
70static const char *wm8731_deemph[] = {"None", "32Khz", "44.1Khz", "48Khz"};
71
72static const struct soc_enum wm8731_enum[] = {
73 SOC_ENUM_SINGLE(WM8731_APANA, 2, 2, wm8731_input_select),
74 SOC_ENUM_SINGLE(WM8731_APDIGI, 1, 4, wm8731_deemph),
75};
76
d00efa64
MB
77static const DECLARE_TLV_DB_SCALE(in_tlv, -3450, 150, 0);
78static const DECLARE_TLV_DB_SCALE(sidetone_tlv, -1500, 300, 0);
79static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1);
80
40e0aa64
RP
81static const struct snd_kcontrol_new wm8731_snd_controls[] = {
82
d00efa64
MB
83SOC_DOUBLE_R_TLV("Master Playback Volume", WM8731_LOUT1V, WM8731_ROUT1V,
84 0, 127, 0, out_tlv),
bd903b6e
LG
85SOC_DOUBLE_R("Master Playback ZC Switch", WM8731_LOUT1V, WM8731_ROUT1V,
86 7, 1, 0),
40e0aa64 87
d00efa64
MB
88SOC_DOUBLE_R_TLV("Capture Volume", WM8731_LINVOL, WM8731_RINVOL, 0, 31, 0,
89 in_tlv),
40e0aa64
RP
90SOC_DOUBLE_R("Line Capture Switch", WM8731_LINVOL, WM8731_RINVOL, 7, 1, 1),
91
92SOC_SINGLE("Mic Boost (+20dB)", WM8731_APANA, 0, 1, 0),
ef38ed88 93SOC_SINGLE("Mic Capture Switch", WM8731_APANA, 1, 1, 1),
40e0aa64 94
d00efa64
MB
95SOC_SINGLE_TLV("Sidetone Playback Volume", WM8731_APANA, 6, 3, 1,
96 sidetone_tlv),
40e0aa64
RP
97
98SOC_SINGLE("ADC High Pass Filter Switch", WM8731_APDIGI, 0, 1, 1),
99SOC_SINGLE("Store DC Offset Switch", WM8731_APDIGI, 4, 1, 0),
100
101SOC_ENUM("Playback De-emphasis", wm8731_enum[1]),
102};
103
40e0aa64
RP
104/* Output Mixer */
105static const struct snd_kcontrol_new wm8731_output_mixer_controls[] = {
106SOC_DAPM_SINGLE("Line Bypass Switch", WM8731_APANA, 3, 1, 0),
107SOC_DAPM_SINGLE("Mic Sidetone Switch", WM8731_APANA, 5, 1, 0),
108SOC_DAPM_SINGLE("HiFi Playback Switch", WM8731_APANA, 4, 1, 0),
109};
110
111/* Input mux */
112static const struct snd_kcontrol_new wm8731_input_mux_controls =
113SOC_DAPM_ENUM("Input Select", wm8731_enum[0]);
114
115static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = {
116SND_SOC_DAPM_MIXER("Output Mixer", WM8731_PWR, 4, 1,
117 &wm8731_output_mixer_controls[0],
118 ARRAY_SIZE(wm8731_output_mixer_controls)),
119SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8731_PWR, 3, 1),
120SND_SOC_DAPM_OUTPUT("LOUT"),
121SND_SOC_DAPM_OUTPUT("LHPOUT"),
122SND_SOC_DAPM_OUTPUT("ROUT"),
123SND_SOC_DAPM_OUTPUT("RHPOUT"),
124SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8731_PWR, 2, 1),
125SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0, &wm8731_input_mux_controls),
126SND_SOC_DAPM_PGA("Line Input", WM8731_PWR, 0, 1, NULL, 0),
127SND_SOC_DAPM_MICBIAS("Mic Bias", WM8731_PWR, 1, 1),
128SND_SOC_DAPM_INPUT("MICIN"),
129SND_SOC_DAPM_INPUT("RLINEIN"),
130SND_SOC_DAPM_INPUT("LLINEIN"),
131};
132
a65f0568 133static const struct snd_soc_dapm_route intercon[] = {
40e0aa64
RP
134 /* output mixer */
135 {"Output Mixer", "Line Bypass Switch", "Line Input"},
136 {"Output Mixer", "HiFi Playback Switch", "DAC"},
137 {"Output Mixer", "Mic Sidetone Switch", "Mic Bias"},
138
139 /* outputs */
140 {"RHPOUT", NULL, "Output Mixer"},
141 {"ROUT", NULL, "Output Mixer"},
142 {"LHPOUT", NULL, "Output Mixer"},
143 {"LOUT", NULL, "Output Mixer"},
144
145 /* input mux */
146 {"Input Mux", "Line In", "Line Input"},
147 {"Input Mux", "Mic", "Mic Bias"},
148 {"ADC", NULL, "Input Mux"},
149
150 /* inputs */
151 {"Line Input", NULL, "LLINEIN"},
152 {"Line Input", NULL, "RLINEIN"},
153 {"Mic Bias", NULL, "MICIN"},
40e0aa64
RP
154};
155
156static int wm8731_add_widgets(struct snd_soc_codec *codec)
157{
a65f0568
MB
158 snd_soc_dapm_new_controls(codec, wm8731_dapm_widgets,
159 ARRAY_SIZE(wm8731_dapm_widgets));
40e0aa64 160
a65f0568 161 snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
40e0aa64 162
40e0aa64
RP
163 return 0;
164}
165
166struct _coeff_div {
167 u32 mclk;
168 u32 rate;
169 u16 fs;
170 u8 sr:4;
171 u8 bosr:1;
172 u8 usb:1;
173};
174
175/* codec mclk clock divider coefficients */
176static const struct _coeff_div coeff_div[] = {
177 /* 48k */
178 {12288000, 48000, 256, 0x0, 0x0, 0x0},
179 {18432000, 48000, 384, 0x0, 0x1, 0x0},
180 {12000000, 48000, 250, 0x0, 0x0, 0x1},
181
182 /* 32k */
183 {12288000, 32000, 384, 0x6, 0x0, 0x0},
184 {18432000, 32000, 576, 0x6, 0x1, 0x0},
298a2c75 185 {12000000, 32000, 375, 0x6, 0x0, 0x1},
40e0aa64
RP
186
187 /* 8k */
188 {12288000, 8000, 1536, 0x3, 0x0, 0x0},
189 {18432000, 8000, 2304, 0x3, 0x1, 0x0},
190 {11289600, 8000, 1408, 0xb, 0x0, 0x0},
191 {16934400, 8000, 2112, 0xb, 0x1, 0x0},
192 {12000000, 8000, 1500, 0x3, 0x0, 0x1},
193
194 /* 96k */
195 {12288000, 96000, 128, 0x7, 0x0, 0x0},
196 {18432000, 96000, 192, 0x7, 0x1, 0x0},
197 {12000000, 96000, 125, 0x7, 0x0, 0x1},
198
199 /* 44.1k */
200 {11289600, 44100, 256, 0x8, 0x0, 0x0},
201 {16934400, 44100, 384, 0x8, 0x1, 0x0},
202 {12000000, 44100, 272, 0x8, 0x1, 0x1},
203
204 /* 88.2k */
205 {11289600, 88200, 128, 0xf, 0x0, 0x0},
206 {16934400, 88200, 192, 0xf, 0x1, 0x0},
207 {12000000, 88200, 136, 0xf, 0x1, 0x1},
208};
209
210static inline int get_coeff(int mclk, int rate)
211{
212 int i;
213
214 for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
215 if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
216 return i;
217 }
218 return 0;
219}
220
b36d61d4 221static int wm8731_hw_params(struct snd_pcm_substream *substream,
dee89c4d
MB
222 struct snd_pcm_hw_params *params,
223 struct snd_soc_dai *dai)
40e0aa64 224{
b36d61d4
FM
225 struct snd_soc_pcm_runtime *rtd = substream->private_data;
226 struct snd_soc_device *socdev = rtd->socdev;
6627a653 227 struct snd_soc_codec *codec = socdev->card->codec;
b36d61d4 228 struct wm8731_priv *wm8731 = codec->private_data;
17a52fd6 229 u16 iface = snd_soc_read(codec, WM8731_IFACE) & 0xfff3;
b36d61d4
FM
230 int i = get_coeff(wm8731->sysclk, params_rate(params));
231 u16 srate = (coeff_div[i].sr << 2) |
232 (coeff_div[i].bosr << 1) | coeff_div[i].usb;
40e0aa64 233
17a52fd6 234 snd_soc_write(codec, WM8731_SRATE, srate);
b36d61d4
FM
235
236 /* bit size */
237 switch (params_format(params)) {
238 case SNDRV_PCM_FORMAT_S16_LE:
239 break;
240 case SNDRV_PCM_FORMAT_S20_3LE:
241 iface |= 0x0004;
242 break;
243 case SNDRV_PCM_FORMAT_S24_LE:
244 iface |= 0x0008;
245 break;
246 }
40e0aa64 247
17a52fd6 248 snd_soc_write(codec, WM8731_IFACE, iface);
b36d61d4 249 return 0;
40e0aa64
RP
250}
251
dee89c4d
MB
252static int wm8731_pcm_prepare(struct snd_pcm_substream *substream,
253 struct snd_soc_dai *dai)
40e0aa64
RP
254{
255 struct snd_soc_pcm_runtime *rtd = substream->private_data;
256 struct snd_soc_device *socdev = rtd->socdev;
6627a653 257 struct snd_soc_codec *codec = socdev->card->codec;
b36d61d4
FM
258
259 /* set active */
17a52fd6 260 snd_soc_write(codec, WM8731_ACTIVE, 0x0001);
b36d61d4
FM
261
262 return 0;
263}
264
dee89c4d
MB
265static void wm8731_shutdown(struct snd_pcm_substream *substream,
266 struct snd_soc_dai *dai)
b36d61d4
FM
267{
268 struct snd_soc_pcm_runtime *rtd = substream->private_data;
269 struct snd_soc_device *socdev = rtd->socdev;
6627a653 270 struct snd_soc_codec *codec = socdev->card->codec;
b36d61d4
FM
271
272 /* deactivate */
273 if (!codec->active) {
274 udelay(50);
17a52fd6 275 snd_soc_write(codec, WM8731_ACTIVE, 0x0);
b36d61d4
FM
276 }
277}
278
e550e17f 279static int wm8731_mute(struct snd_soc_dai *dai, int mute)
b36d61d4
FM
280{
281 struct snd_soc_codec *codec = dai->codec;
17a52fd6 282 u16 mute_reg = snd_soc_read(codec, WM8731_APDIGI) & 0xfff7;
b36d61d4
FM
283
284 if (mute)
17a52fd6 285 snd_soc_write(codec, WM8731_APDIGI, mute_reg | 0x8);
b36d61d4 286 else
17a52fd6 287 snd_soc_write(codec, WM8731_APDIGI, mute_reg);
b36d61d4
FM
288 return 0;
289}
290
e550e17f 291static int wm8731_set_dai_sysclk(struct snd_soc_dai *codec_dai,
b36d61d4
FM
292 int clk_id, unsigned int freq, int dir)
293{
294 struct snd_soc_codec *codec = codec_dai->codec;
295 struct wm8731_priv *wm8731 = codec->private_data;
296
297 switch (freq) {
298 case 11289600:
299 case 12000000:
300 case 12288000:
301 case 16934400:
302 case 18432000:
303 wm8731->sysclk = freq;
304 return 0;
305 }
306 return -EINVAL;
307}
308
309
e550e17f 310static int wm8731_set_dai_fmt(struct snd_soc_dai *codec_dai,
b36d61d4
FM
311 unsigned int fmt)
312{
313 struct snd_soc_codec *codec = codec_dai->codec;
314 u16 iface = 0;
40e0aa64
RP
315
316 /* set master/slave audio interface */
b36d61d4 317 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
40e0aa64
RP
318 case SND_SOC_DAIFMT_CBM_CFM:
319 iface |= 0x0040;
320 break;
321 case SND_SOC_DAIFMT_CBS_CFS:
322 break;
b36d61d4
FM
323 default:
324 return -EINVAL;
40e0aa64 325 }
40e0aa64
RP
326
327 /* interface format */
b36d61d4 328 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
40e0aa64
RP
329 case SND_SOC_DAIFMT_I2S:
330 iface |= 0x0002;
331 break;
332 case SND_SOC_DAIFMT_RIGHT_J:
333 break;
334 case SND_SOC_DAIFMT_LEFT_J:
335 iface |= 0x0001;
336 break;
337 case SND_SOC_DAIFMT_DSP_A:
338 iface |= 0x0003;
339 break;
340 case SND_SOC_DAIFMT_DSP_B:
341 iface |= 0x0013;
342 break;
b36d61d4
FM
343 default:
344 return -EINVAL;
40e0aa64
RP
345 }
346
347 /* clock inversion */
b36d61d4 348 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
40e0aa64
RP
349 case SND_SOC_DAIFMT_NB_NF:
350 break;
351 case SND_SOC_DAIFMT_IB_IF:
352 iface |= 0x0090;
353 break;
354 case SND_SOC_DAIFMT_IB_NF:
355 iface |= 0x0080;
356 break;
357 case SND_SOC_DAIFMT_NB_IF:
358 iface |= 0x0010;
359 break;
b36d61d4
FM
360 default:
361 return -EINVAL;
40e0aa64
RP
362 }
363
364 /* set iface */
17a52fd6 365 snd_soc_write(codec, WM8731_IFACE, iface);
40e0aa64
RP
366 return 0;
367}
368
0be9898a
MB
369static int wm8731_set_bias_level(struct snd_soc_codec *codec,
370 enum snd_soc_bias_level level)
40e0aa64 371{
22d22ee5 372 u16 reg;
40e0aa64 373
0be9898a
MB
374 switch (level) {
375 case SND_SOC_BIAS_ON:
40e0aa64 376 break;
0be9898a 377 case SND_SOC_BIAS_PREPARE:
40e0aa64 378 break;
0be9898a 379 case SND_SOC_BIAS_STANDBY:
22d22ee5 380 /* Clear PWROFF, gate CLKOUT, everything else as-is */
17a52fd6
MB
381 reg = snd_soc_read(codec, WM8731_PWR) & 0xff7f;
382 snd_soc_write(codec, WM8731_PWR, reg | 0x0040);
40e0aa64 383 break;
0be9898a 384 case SND_SOC_BIAS_OFF:
17a52fd6
MB
385 snd_soc_write(codec, WM8731_ACTIVE, 0x0);
386 snd_soc_write(codec, WM8731_PWR, 0xffff);
40e0aa64
RP
387 break;
388 }
0be9898a 389 codec->bias_level = level;
40e0aa64
RP
390 return 0;
391}
392
b36d61d4
FM
393#define WM8731_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
394 SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
395 SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 |\
396 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 |\
397 SNDRV_PCM_RATE_96000)
398
399#define WM8731_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
400 SNDRV_PCM_FMTBIT_S24_LE)
401
6335d055
EM
402static struct snd_soc_dai_ops wm8731_dai_ops = {
403 .prepare = wm8731_pcm_prepare,
404 .hw_params = wm8731_hw_params,
405 .shutdown = wm8731_shutdown,
406 .digital_mute = wm8731_mute,
407 .set_sysclk = wm8731_set_dai_sysclk,
408 .set_fmt = wm8731_set_dai_fmt,
409};
410
e550e17f 411struct snd_soc_dai wm8731_dai = {
40e0aa64
RP
412 .name = "WM8731",
413 .playback = {
414 .stream_name = "Playback",
415 .channels_min = 1,
416 .channels_max = 2,
b36d61d4
FM
417 .rates = WM8731_RATES,
418 .formats = WM8731_FORMATS,},
40e0aa64
RP
419 .capture = {
420 .stream_name = "Capture",
421 .channels_min = 1,
422 .channels_max = 2,
b36d61d4
FM
423 .rates = WM8731_RATES,
424 .formats = WM8731_FORMATS,},
6335d055 425 .ops = &wm8731_dai_ops,
4934482d 426 .symmetric_rates = 1,
40e0aa64
RP
427};
428EXPORT_SYMBOL_GPL(wm8731_dai);
429
b3b50b3f 430#ifdef CONFIG_PM
40e0aa64
RP
431static int wm8731_suspend(struct platform_device *pdev, pm_message_t state)
432{
433 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 434 struct snd_soc_codec *codec = socdev->card->codec;
7dea7c01 435 struct wm8731_priv *wm8731 = codec->private_data;
40e0aa64 436
17a52fd6 437 snd_soc_write(codec, WM8731_ACTIVE, 0x0);
0be9898a 438 wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);
7dea7c01
MB
439 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies),
440 wm8731->supplies);
40e0aa64
RP
441 return 0;
442}
443
444static int wm8731_resume(struct platform_device *pdev)
445{
446 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 447 struct snd_soc_codec *codec = socdev->card->codec;
7dea7c01
MB
448 struct wm8731_priv *wm8731 = codec->private_data;
449 int i, ret;
40e0aa64
RP
450 u8 data[2];
451 u16 *cache = codec->reg_cache;
452
7dea7c01
MB
453 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies),
454 wm8731->supplies);
455 if (ret != 0)
456 return ret;
457
40e0aa64
RP
458 /* Sync reg_cache with the hardware */
459 for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) {
d11c5ab1
MB
460 if (cache[i] == wm8731_reg[i])
461 continue;
462
40e0aa64
RP
463 data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
464 data[1] = cache[i] & 0x00ff;
465 codec->hw_write(codec->control_data, data, 2);
466 }
0be9898a
MB
467 wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
468 wm8731_set_bias_level(codec, codec->suspend_bias_level);
7dea7c01 469
40e0aa64
RP
470 return 0;
471}
b3b50b3f
MB
472#else
473#define wm8731_suspend NULL
474#define wm8731_resume NULL
475#endif
40e0aa64 476
5998102b 477static int wm8731_probe(struct platform_device *pdev)
40e0aa64 478{
5998102b
MB
479 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
480 struct snd_soc_codec *codec;
481 int ret = 0;
40e0aa64 482
5998102b
MB
483 if (wm8731_codec == NULL) {
484 dev_err(&pdev->dev, "Codec device not registered\n");
485 return -ENODEV;
486 }
40e0aa64 487
5998102b
MB
488 socdev->card->codec = wm8731_codec;
489 codec = wm8731_codec;
40e0aa64
RP
490
491 /* register pcms */
492 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
493 if (ret < 0) {
5998102b 494 dev_err(codec->dev, "failed to create pcms: %d\n", ret);
e35115a5 495 goto pcm_err;
40e0aa64
RP
496 }
497
3e8e1952 498 snd_soc_add_controls(codec, wm8731_snd_controls,
5998102b 499 ARRAY_SIZE(wm8731_snd_controls));
40e0aa64 500 wm8731_add_widgets(codec);
40e0aa64
RP
501
502 return ret;
e35115a5 503
e35115a5 504pcm_err:
40e0aa64
RP
505 return ret;
506}
507
508/* power down chip */
509static int wm8731_remove(struct platform_device *pdev)
510{
511 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
40e0aa64
RP
512
513 snd_soc_free_pcms(socdev);
514 snd_soc_dapm_free(socdev);
40e0aa64
RP
515
516 return 0;
517}
518
519struct snd_soc_codec_device soc_codec_dev_wm8731 = {
520 .probe = wm8731_probe,
521 .remove = wm8731_remove,
522 .suspend = wm8731_suspend,
523 .resume = wm8731_resume,
524};
40e0aa64
RP
525EXPORT_SYMBOL_GPL(soc_codec_dev_wm8731);
526
7084a42b
MB
527static int wm8731_register(struct wm8731_priv *wm8731,
528 enum snd_soc_control_type control)
a8035c8f 529{
7dea7c01 530 int ret, i;
5998102b 531 struct snd_soc_codec *codec = &wm8731->codec;
a8035c8f 532
5998102b
MB
533 if (wm8731_codec) {
534 dev_err(codec->dev, "Another WM8731 is registered\n");
fe5422fc
MB
535 ret = -EINVAL;
536 goto err;
5998102b 537 }
a8035c8f 538
5998102b
MB
539 mutex_init(&codec->mutex);
540 INIT_LIST_HEAD(&codec->dapm_widgets);
541 INIT_LIST_HEAD(&codec->dapm_paths);
a8035c8f 542
5998102b
MB
543 codec->private_data = wm8731;
544 codec->name = "WM8731";
545 codec->owner = THIS_MODULE;
5998102b
MB
546 codec->bias_level = SND_SOC_BIAS_OFF;
547 codec->set_bias_level = wm8731_set_bias_level;
548 codec->dai = &wm8731_dai;
549 codec->num_dai = 1;
550 codec->reg_cache_size = WM8731_CACHEREGNUM;
551 codec->reg_cache = &wm8731->reg_cache;
552
553 memcpy(codec->reg_cache, wm8731_reg, sizeof(wm8731_reg));
554
7084a42b 555 ret = snd_soc_codec_set_cache_io(codec, 7, 9, control);
17a52fd6
MB
556 if (ret < 0) {
557 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
558 goto err;
559 }
560
7dea7c01
MB
561 for (i = 0; i < ARRAY_SIZE(wm8731->supplies); i++)
562 wm8731->supplies[i].supply = wm8731_supply_names[i];
563
564 ret = regulator_bulk_get(codec->dev, ARRAY_SIZE(wm8731->supplies),
565 wm8731->supplies);
566 if (ret != 0) {
567 dev_err(codec->dev, "Failed to request supplies: %d\n", ret);
568 goto err;
569 }
570
571 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies),
572 wm8731->supplies);
573 if (ret != 0) {
574 dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
575 goto err_regulator_get;
576 }
577
519cf2df
MB
578 ret = wm8731_reset(codec);
579 if (ret < 0) {
fe5422fc 580 dev_err(codec->dev, "Failed to issue reset: %d\n", ret);
7dea7c01 581 goto err_regulator_enable;
519cf2df
MB
582 }
583
5998102b
MB
584 wm8731_dai.dev = codec->dev;
585
5998102b
MB
586 wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
587
588 /* Latch the update bits */
17a52fd6
MB
589 snd_soc_update_bits(codec, WM8731_LOUT1V, 0x100, 0);
590 snd_soc_update_bits(codec, WM8731_ROUT1V, 0x100, 0);
591 snd_soc_update_bits(codec, WM8731_LINVOL, 0x100, 0);
592 snd_soc_update_bits(codec, WM8731_RINVOL, 0x100, 0);
5998102b 593
ce3bdaa8 594 /* Disable bypass path by default */
17a52fd6 595 snd_soc_update_bits(codec, WM8731_APANA, 0x4, 0);
ce3bdaa8 596
5998102b
MB
597 wm8731_codec = codec;
598
599 ret = snd_soc_register_codec(codec);
600 if (ret != 0) {
601 dev_err(codec->dev, "Failed to register codec: %d\n", ret);
7dea7c01 602 goto err_regulator_enable;
5998102b
MB
603 }
604
605 ret = snd_soc_register_dai(&wm8731_dai);
606 if (ret != 0) {
607 dev_err(codec->dev, "Failed to register DAI: %d\n", ret);
608 snd_soc_unregister_codec(codec);
fe5422fc 609 goto err_codec;
5998102b 610 }
a8035c8f 611
a8035c8f 612 return 0;
fe5422fc
MB
613
614err_codec:
615 snd_soc_unregister_codec(codec);
7dea7c01
MB
616err_regulator_enable:
617 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
618err_regulator_get:
619 regulator_bulk_free(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
fe5422fc
MB
620err:
621 kfree(wm8731);
622 return ret;
a8035c8f
MB
623}
624
5998102b
MB
625static void wm8731_unregister(struct wm8731_priv *wm8731)
626{
627 wm8731_set_bias_level(&wm8731->codec, SND_SOC_BIAS_OFF);
628 snd_soc_unregister_dai(&wm8731_dai);
629 snd_soc_unregister_codec(&wm8731->codec);
7dea7c01
MB
630 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
631 regulator_bulk_free(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);
5998102b
MB
632 kfree(wm8731);
633 wm8731_codec = NULL;
634}
a8035c8f 635
5998102b 636#if defined(CONFIG_SPI_MASTER)
5998102b
MB
637static int __devinit wm8731_spi_probe(struct spi_device *spi)
638{
639 struct snd_soc_codec *codec;
640 struct wm8731_priv *wm8731;
641
642 wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
643 if (wm8731 == NULL)
644 return -ENOMEM;
645
646 codec = &wm8731->codec;
647 codec->control_data = spi;
5998102b
MB
648 codec->dev = &spi->dev;
649
ae31c1fb 650 dev_set_drvdata(&spi->dev, wm8731);
93b760b7 651
7084a42b 652 return wm8731_register(wm8731, SND_SOC_SPI);
5998102b
MB
653}
654
655static int __devexit wm8731_spi_remove(struct spi_device *spi)
656{
ae31c1fb 657 struct wm8731_priv *wm8731 = dev_get_drvdata(&spi->dev);
93b760b7
MB
658
659 wm8731_unregister(wm8731);
660
5998102b
MB
661 return 0;
662}
663
664static struct spi_driver wm8731_spi_driver = {
665 .driver = {
666 .name = "wm8731",
667 .bus = &spi_bus_type,
668 .owner = THIS_MODULE,
669 },
670 .probe = wm8731_spi_probe,
671 .remove = __devexit_p(wm8731_spi_remove),
672};
a8035c8f
MB
673#endif /* CONFIG_SPI_MASTER */
674
675#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
c6f29811
MB
676static __devinit int wm8731_i2c_probe(struct i2c_client *i2c,
677 const struct i2c_device_id *id)
a8035c8f 678{
5998102b
MB
679 struct wm8731_priv *wm8731;
680 struct snd_soc_codec *codec;
a8035c8f 681
5998102b
MB
682 wm8731 = kzalloc(sizeof(struct wm8731_priv), GFP_KERNEL);
683 if (wm8731 == NULL)
684 return -ENOMEM;
685
686 codec = &wm8731->codec;
5998102b
MB
687
688 i2c_set_clientdata(i2c, wm8731);
a8035c8f
MB
689 codec->control_data = i2c;
690
5998102b 691 codec->dev = &i2c->dev;
a8035c8f 692
7084a42b 693 return wm8731_register(wm8731, SND_SOC_I2C);
a8035c8f
MB
694}
695
c6f29811 696static __devexit int wm8731_i2c_remove(struct i2c_client *client)
a8035c8f 697{
5998102b
MB
698 struct wm8731_priv *wm8731 = i2c_get_clientdata(client);
699 wm8731_unregister(wm8731);
a8035c8f
MB
700 return 0;
701}
702
703static const struct i2c_device_id wm8731_i2c_id[] = {
704 { "wm8731", 0 },
705 { }
706};
707MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id);
708
709static struct i2c_driver wm8731_i2c_driver = {
710 .driver = {
711 .name = "WM8731 I2C Codec",
712 .owner = THIS_MODULE,
713 },
714 .probe = wm8731_i2c_probe,
c6f29811 715 .remove = __devexit_p(wm8731_i2c_remove),
a8035c8f
MB
716 .id_table = wm8731_i2c_id,
717};
718#endif
719
c9b3a40f 720static int __init wm8731_modinit(void)
64089b84 721{
5998102b
MB
722 int ret;
723#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
724 ret = i2c_add_driver(&wm8731_i2c_driver);
725 if (ret != 0) {
726 printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n",
727 ret);
728 }
729#endif
730#if defined(CONFIG_SPI_MASTER)
731 ret = spi_register_driver(&wm8731_spi_driver);
732 if (ret != 0) {
733 printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n",
734 ret);
735 }
736#endif
737 return 0;
64089b84
MB
738}
739module_init(wm8731_modinit);
740
741static void __exit wm8731_exit(void)
742{
5998102b
MB
743#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
744 i2c_del_driver(&wm8731_i2c_driver);
745#endif
746#if defined(CONFIG_SPI_MASTER)
747 spi_unregister_driver(&wm8731_spi_driver);
748#endif
64089b84
MB
749}
750module_exit(wm8731_exit);
751
40e0aa64
RP
752MODULE_DESCRIPTION("ASoC WM8731 driver");
753MODULE_AUTHOR("Richard Purdie");
754MODULE_LICENSE("GPL");