Merge branch 'for-3.5-fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/tj...
[firefly-linux-kernel-4.4.55.git] / sound / soc / codecs / wm8510.c
1 /*
2  * wm8510.c  --  WM8510 ALSA Soc Audio driver
3  *
4  * Copyright 2006 Wolfson Microelectronics PLC.
5  *
6  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/kernel.h>
16 #include <linux/init.h>
17 #include <linux/delay.h>
18 #include <linux/pm.h>
19 #include <linux/i2c.h>
20 #include <linux/spi/spi.h>
21 #include <linux/slab.h>
22 #include <linux/of_device.h>
23 #include <sound/core.h>
24 #include <sound/pcm.h>
25 #include <sound/pcm_params.h>
26 #include <sound/soc.h>
27 #include <sound/initval.h>
28
29 #include "wm8510.h"
30
31 /*
32  * wm8510 register cache
33  * We can't read the WM8510 register space when we are
34  * using 2 wire for device control, so we cache them instead.
35  */
36 static const u16 wm8510_reg[WM8510_CACHEREGNUM] = {
37         0x0000, 0x0000, 0x0000, 0x0000,
38         0x0050, 0x0000, 0x0140, 0x0000,
39         0x0000, 0x0000, 0x0000, 0x00ff,
40         0x0000, 0x0000, 0x0100, 0x00ff,
41         0x0000, 0x0000, 0x012c, 0x002c,
42         0x002c, 0x002c, 0x002c, 0x0000,
43         0x0032, 0x0000, 0x0000, 0x0000,
44         0x0000, 0x0000, 0x0000, 0x0000,
45         0x0038, 0x000b, 0x0032, 0x0000,
46         0x0008, 0x000c, 0x0093, 0x00e9,
47         0x0000, 0x0000, 0x0000, 0x0000,
48         0x0003, 0x0010, 0x0000, 0x0000,
49         0x0000, 0x0002, 0x0001, 0x0000,
50         0x0000, 0x0000, 0x0039, 0x0000,
51         0x0001,
52 };
53
54 #define WM8510_POWER1_BIASEN  0x08
55 #define WM8510_POWER1_BUFIOEN 0x10
56
57 #define wm8510_reset(c) snd_soc_write(c, WM8510_RESET, 0)
58
59 /* codec private data */
60 struct wm8510_priv {
61         enum snd_soc_control_type control_type;
62 };
63
64 static const char *wm8510_companding[] = { "Off", "NC", "u-law", "A-law" };
65 static const char *wm8510_deemp[] = { "None", "32kHz", "44.1kHz", "48kHz" };
66 static const char *wm8510_alc[] = { "ALC", "Limiter" };
67
68 static const struct soc_enum wm8510_enum[] = {
69         SOC_ENUM_SINGLE(WM8510_COMP, 1, 4, wm8510_companding), /* adc */
70         SOC_ENUM_SINGLE(WM8510_COMP, 3, 4, wm8510_companding), /* dac */
71         SOC_ENUM_SINGLE(WM8510_DAC,  4, 4, wm8510_deemp),
72         SOC_ENUM_SINGLE(WM8510_ALC3,  8, 2, wm8510_alc),
73 };
74
75 static const struct snd_kcontrol_new wm8510_snd_controls[] = {
76
77 SOC_SINGLE("Digital Loopback Switch", WM8510_COMP, 0, 1, 0),
78
79 SOC_ENUM("DAC Companding", wm8510_enum[1]),
80 SOC_ENUM("ADC Companding", wm8510_enum[0]),
81
82 SOC_ENUM("Playback De-emphasis", wm8510_enum[2]),
83 SOC_SINGLE("DAC Inversion Switch", WM8510_DAC, 0, 1, 0),
84
85 SOC_SINGLE("Master Playback Volume", WM8510_DACVOL, 0, 127, 0),
86
87 SOC_SINGLE("High Pass Filter Switch", WM8510_ADC, 8, 1, 0),
88 SOC_SINGLE("High Pass Cut Off", WM8510_ADC, 4, 7, 0),
89 SOC_SINGLE("ADC Inversion Switch", WM8510_COMP, 0, 1, 0),
90
91 SOC_SINGLE("Capture Volume", WM8510_ADCVOL,  0, 127, 0),
92
93 SOC_SINGLE("DAC Playback Limiter Switch", WM8510_DACLIM1,  8, 1, 0),
94 SOC_SINGLE("DAC Playback Limiter Decay", WM8510_DACLIM1,  4, 15, 0),
95 SOC_SINGLE("DAC Playback Limiter Attack", WM8510_DACLIM1,  0, 15, 0),
96
97 SOC_SINGLE("DAC Playback Limiter Threshold", WM8510_DACLIM2,  4, 7, 0),
98 SOC_SINGLE("DAC Playback Limiter Boost", WM8510_DACLIM2,  0, 15, 0),
99
100 SOC_SINGLE("ALC Enable Switch", WM8510_ALC1,  8, 1, 0),
101 SOC_SINGLE("ALC Capture Max Gain", WM8510_ALC1,  3, 7, 0),
102 SOC_SINGLE("ALC Capture Min Gain", WM8510_ALC1,  0, 7, 0),
103
104 SOC_SINGLE("ALC Capture ZC Switch", WM8510_ALC2,  8, 1, 0),
105 SOC_SINGLE("ALC Capture Hold", WM8510_ALC2,  4, 7, 0),
106 SOC_SINGLE("ALC Capture Target", WM8510_ALC2,  0, 15, 0),
107
108 SOC_ENUM("ALC Capture Mode", wm8510_enum[3]),
109 SOC_SINGLE("ALC Capture Decay", WM8510_ALC3,  4, 15, 0),
110 SOC_SINGLE("ALC Capture Attack", WM8510_ALC3,  0, 15, 0),
111
112 SOC_SINGLE("ALC Capture Noise Gate Switch", WM8510_NGATE,  3, 1, 0),
113 SOC_SINGLE("ALC Capture Noise Gate Threshold", WM8510_NGATE,  0, 7, 0),
114
115 SOC_SINGLE("Capture PGA ZC Switch", WM8510_INPPGA,  7, 1, 0),
116 SOC_SINGLE("Capture PGA Volume", WM8510_INPPGA,  0, 63, 0),
117
118 SOC_SINGLE("Speaker Playback ZC Switch", WM8510_SPKVOL,  7, 1, 0),
119 SOC_SINGLE("Speaker Playback Switch", WM8510_SPKVOL,  6, 1, 1),
120 SOC_SINGLE("Speaker Playback Volume", WM8510_SPKVOL,  0, 63, 0),
121 SOC_SINGLE("Speaker Boost", WM8510_OUTPUT, 2, 1, 0),
122
123 SOC_SINGLE("Capture Boost(+20dB)", WM8510_ADCBOOST,  8, 1, 0),
124 SOC_SINGLE("Mono Playback Switch", WM8510_MONOMIX, 6, 1, 1),
125 };
126
127 /* Speaker Output Mixer */
128 static const struct snd_kcontrol_new wm8510_speaker_mixer_controls[] = {
129 SOC_DAPM_SINGLE("Line Bypass Switch", WM8510_SPKMIX, 1, 1, 0),
130 SOC_DAPM_SINGLE("Aux Playback Switch", WM8510_SPKMIX, 5, 1, 0),
131 SOC_DAPM_SINGLE("PCM Playback Switch", WM8510_SPKMIX, 0, 1, 0),
132 };
133
134 /* Mono Output Mixer */
135 static const struct snd_kcontrol_new wm8510_mono_mixer_controls[] = {
136 SOC_DAPM_SINGLE("Line Bypass Switch", WM8510_MONOMIX, 1, 1, 0),
137 SOC_DAPM_SINGLE("Aux Playback Switch", WM8510_MONOMIX, 2, 1, 0),
138 SOC_DAPM_SINGLE("PCM Playback Switch", WM8510_MONOMIX, 0, 1, 0),
139 };
140
141 static const struct snd_kcontrol_new wm8510_boost_controls[] = {
142 SOC_DAPM_SINGLE("Mic PGA Switch", WM8510_INPPGA,  6, 1, 1),
143 SOC_DAPM_SINGLE("Aux Volume", WM8510_ADCBOOST, 0, 7, 0),
144 SOC_DAPM_SINGLE("Mic Volume", WM8510_ADCBOOST, 4, 7, 0),
145 };
146
147 static const struct snd_kcontrol_new wm8510_micpga_controls[] = {
148 SOC_DAPM_SINGLE("MICP Switch", WM8510_INPUT, 0, 1, 0),
149 SOC_DAPM_SINGLE("MICN Switch", WM8510_INPUT, 1, 1, 0),
150 SOC_DAPM_SINGLE("AUX Switch", WM8510_INPUT, 2, 1, 0),
151 };
152
153 static const struct snd_soc_dapm_widget wm8510_dapm_widgets[] = {
154 SND_SOC_DAPM_MIXER("Speaker Mixer", WM8510_POWER3, 2, 0,
155         &wm8510_speaker_mixer_controls[0],
156         ARRAY_SIZE(wm8510_speaker_mixer_controls)),
157 SND_SOC_DAPM_MIXER("Mono Mixer", WM8510_POWER3, 3, 0,
158         &wm8510_mono_mixer_controls[0],
159         ARRAY_SIZE(wm8510_mono_mixer_controls)),
160 SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8510_POWER3, 0, 0),
161 SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8510_POWER2, 0, 0),
162 SND_SOC_DAPM_PGA("Aux Input", WM8510_POWER1, 6, 0, NULL, 0),
163 SND_SOC_DAPM_PGA("SpkN Out", WM8510_POWER3, 5, 0, NULL, 0),
164 SND_SOC_DAPM_PGA("SpkP Out", WM8510_POWER3, 6, 0, NULL, 0),
165 SND_SOC_DAPM_PGA("Mono Out", WM8510_POWER3, 7, 0, NULL, 0),
166
167 SND_SOC_DAPM_MIXER("Mic PGA", WM8510_POWER2, 2, 0,
168                    &wm8510_micpga_controls[0],
169                    ARRAY_SIZE(wm8510_micpga_controls)),
170 SND_SOC_DAPM_MIXER("Boost Mixer", WM8510_POWER2, 4, 0,
171         &wm8510_boost_controls[0],
172         ARRAY_SIZE(wm8510_boost_controls)),
173
174 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8510_POWER1, 4, 0),
175
176 SND_SOC_DAPM_INPUT("MICN"),
177 SND_SOC_DAPM_INPUT("MICP"),
178 SND_SOC_DAPM_INPUT("AUX"),
179 SND_SOC_DAPM_OUTPUT("MONOOUT"),
180 SND_SOC_DAPM_OUTPUT("SPKOUTP"),
181 SND_SOC_DAPM_OUTPUT("SPKOUTN"),
182 };
183
184 static const struct snd_soc_dapm_route wm8510_dapm_routes[] = {
185         /* Mono output mixer */
186         {"Mono Mixer", "PCM Playback Switch", "DAC"},
187         {"Mono Mixer", "Aux Playback Switch", "Aux Input"},
188         {"Mono Mixer", "Line Bypass Switch", "Boost Mixer"},
189
190         /* Speaker output mixer */
191         {"Speaker Mixer", "PCM Playback Switch", "DAC"},
192         {"Speaker Mixer", "Aux Playback Switch", "Aux Input"},
193         {"Speaker Mixer", "Line Bypass Switch", "Boost Mixer"},
194
195         /* Outputs */
196         {"Mono Out", NULL, "Mono Mixer"},
197         {"MONOOUT", NULL, "Mono Out"},
198         {"SpkN Out", NULL, "Speaker Mixer"},
199         {"SpkP Out", NULL, "Speaker Mixer"},
200         {"SPKOUTN", NULL, "SpkN Out"},
201         {"SPKOUTP", NULL, "SpkP Out"},
202
203         /* Microphone PGA */
204         {"Mic PGA", "MICN Switch", "MICN"},
205         {"Mic PGA", "MICP Switch", "MICP"},
206         { "Mic PGA", "AUX Switch", "Aux Input" },
207
208         /* Boost Mixer */
209         {"Boost Mixer", "Mic PGA Switch", "Mic PGA"},
210         {"Boost Mixer", "Mic Volume", "MICP"},
211         {"Boost Mixer", "Aux Volume", "Aux Input"},
212
213         {"ADC", NULL, "Boost Mixer"},
214 };
215
216 struct pll_ {
217         unsigned int pre_div:4; /* prescale - 1 */
218         unsigned int n:4;
219         unsigned int k;
220 };
221
222 static struct pll_ pll_div;
223
224 /* The size in bits of the pll divide multiplied by 10
225  * to allow rounding later */
226 #define FIXED_PLL_SIZE ((1 << 24) * 10)
227
228 static void pll_factors(unsigned int target, unsigned int source)
229 {
230         unsigned long long Kpart;
231         unsigned int K, Ndiv, Nmod;
232
233         Ndiv = target / source;
234         if (Ndiv < 6) {
235                 source >>= 1;
236                 pll_div.pre_div = 1;
237                 Ndiv = target / source;
238         } else
239                 pll_div.pre_div = 0;
240
241         if ((Ndiv < 6) || (Ndiv > 12))
242                 printk(KERN_WARNING
243                         "WM8510 N value %u outwith recommended range!d\n",
244                         Ndiv);
245
246         pll_div.n = Ndiv;
247         Nmod = target % source;
248         Kpart = FIXED_PLL_SIZE * (long long)Nmod;
249
250         do_div(Kpart, source);
251
252         K = Kpart & 0xFFFFFFFF;
253
254         /* Check if we need to round */
255         if ((K % 10) >= 5)
256                 K += 5;
257
258         /* Move down to proper range now rounding is done */
259         K /= 10;
260
261         pll_div.k = K;
262 }
263
264 static int wm8510_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
265                 int source, unsigned int freq_in, unsigned int freq_out)
266 {
267         struct snd_soc_codec *codec = codec_dai->codec;
268         u16 reg;
269
270         if (freq_in == 0 || freq_out == 0) {
271                 /* Clock CODEC directly from MCLK */
272                 reg = snd_soc_read(codec, WM8510_CLOCK);
273                 snd_soc_write(codec, WM8510_CLOCK, reg & 0x0ff);
274
275                 /* Turn off PLL */
276                 reg = snd_soc_read(codec, WM8510_POWER1);
277                 snd_soc_write(codec, WM8510_POWER1, reg & 0x1df);
278                 return 0;
279         }
280
281         pll_factors(freq_out*4, freq_in);
282
283         snd_soc_write(codec, WM8510_PLLN, (pll_div.pre_div << 4) | pll_div.n);
284         snd_soc_write(codec, WM8510_PLLK1, pll_div.k >> 18);
285         snd_soc_write(codec, WM8510_PLLK2, (pll_div.k >> 9) & 0x1ff);
286         snd_soc_write(codec, WM8510_PLLK3, pll_div.k & 0x1ff);
287         reg = snd_soc_read(codec, WM8510_POWER1);
288         snd_soc_write(codec, WM8510_POWER1, reg | 0x020);
289
290         /* Run CODEC from PLL instead of MCLK */
291         reg = snd_soc_read(codec, WM8510_CLOCK);
292         snd_soc_write(codec, WM8510_CLOCK, reg | 0x100);
293
294         return 0;
295 }
296
297 /*
298  * Configure WM8510 clock dividers.
299  */
300 static int wm8510_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
301                 int div_id, int div)
302 {
303         struct snd_soc_codec *codec = codec_dai->codec;
304         u16 reg;
305
306         switch (div_id) {
307         case WM8510_OPCLKDIV:
308                 reg = snd_soc_read(codec, WM8510_GPIO) & 0x1cf;
309                 snd_soc_write(codec, WM8510_GPIO, reg | div);
310                 break;
311         case WM8510_MCLKDIV:
312                 reg = snd_soc_read(codec, WM8510_CLOCK) & 0x11f;
313                 snd_soc_write(codec, WM8510_CLOCK, reg | div);
314                 break;
315         case WM8510_ADCCLK:
316                 reg = snd_soc_read(codec, WM8510_ADC) & 0x1f7;
317                 snd_soc_write(codec, WM8510_ADC, reg | div);
318                 break;
319         case WM8510_DACCLK:
320                 reg = snd_soc_read(codec, WM8510_DAC) & 0x1f7;
321                 snd_soc_write(codec, WM8510_DAC, reg | div);
322                 break;
323         case WM8510_BCLKDIV:
324                 reg = snd_soc_read(codec, WM8510_CLOCK) & 0x1e3;
325                 snd_soc_write(codec, WM8510_CLOCK, reg | div);
326                 break;
327         default:
328                 return -EINVAL;
329         }
330
331         return 0;
332 }
333
334 static int wm8510_set_dai_fmt(struct snd_soc_dai *codec_dai,
335                 unsigned int fmt)
336 {
337         struct snd_soc_codec *codec = codec_dai->codec;
338         u16 iface = 0;
339         u16 clk = snd_soc_read(codec, WM8510_CLOCK) & 0x1fe;
340
341         /* set master/slave audio interface */
342         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
343         case SND_SOC_DAIFMT_CBM_CFM:
344                 clk |= 0x0001;
345                 break;
346         case SND_SOC_DAIFMT_CBS_CFS:
347                 break;
348         default:
349                 return -EINVAL;
350         }
351
352         /* interface format */
353         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
354         case SND_SOC_DAIFMT_I2S:
355                 iface |= 0x0010;
356                 break;
357         case SND_SOC_DAIFMT_RIGHT_J:
358                 break;
359         case SND_SOC_DAIFMT_LEFT_J:
360                 iface |= 0x0008;
361                 break;
362         case SND_SOC_DAIFMT_DSP_A:
363                 iface |= 0x00018;
364                 break;
365         default:
366                 return -EINVAL;
367         }
368
369         /* clock inversion */
370         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
371         case SND_SOC_DAIFMT_NB_NF:
372                 break;
373         case SND_SOC_DAIFMT_IB_IF:
374                 iface |= 0x0180;
375                 break;
376         case SND_SOC_DAIFMT_IB_NF:
377                 iface |= 0x0100;
378                 break;
379         case SND_SOC_DAIFMT_NB_IF:
380                 iface |= 0x0080;
381                 break;
382         default:
383                 return -EINVAL;
384         }
385
386         snd_soc_write(codec, WM8510_IFACE, iface);
387         snd_soc_write(codec, WM8510_CLOCK, clk);
388         return 0;
389 }
390
391 static int wm8510_pcm_hw_params(struct snd_pcm_substream *substream,
392                                 struct snd_pcm_hw_params *params,
393                                 struct snd_soc_dai *dai)
394 {
395         struct snd_soc_codec *codec = dai->codec;
396         u16 iface = snd_soc_read(codec, WM8510_IFACE) & 0x19f;
397         u16 adn = snd_soc_read(codec, WM8510_ADD) & 0x1f1;
398
399         /* bit size */
400         switch (params_format(params)) {
401         case SNDRV_PCM_FORMAT_S16_LE:
402                 break;
403         case SNDRV_PCM_FORMAT_S20_3LE:
404                 iface |= 0x0020;
405                 break;
406         case SNDRV_PCM_FORMAT_S24_LE:
407                 iface |= 0x0040;
408                 break;
409         case SNDRV_PCM_FORMAT_S32_LE:
410                 iface |= 0x0060;
411                 break;
412         }
413
414         /* filter coefficient */
415         switch (params_rate(params)) {
416         case 8000:
417                 adn |= 0x5 << 1;
418                 break;
419         case 11025:
420                 adn |= 0x4 << 1;
421                 break;
422         case 16000:
423                 adn |= 0x3 << 1;
424                 break;
425         case 22050:
426                 adn |= 0x2 << 1;
427                 break;
428         case 32000:
429                 adn |= 0x1 << 1;
430                 break;
431         case 44100:
432         case 48000:
433                 break;
434         }
435
436         snd_soc_write(codec, WM8510_IFACE, iface);
437         snd_soc_write(codec, WM8510_ADD, adn);
438         return 0;
439 }
440
441 static int wm8510_mute(struct snd_soc_dai *dai, int mute)
442 {
443         struct snd_soc_codec *codec = dai->codec;
444         u16 mute_reg = snd_soc_read(codec, WM8510_DAC) & 0xffbf;
445
446         if (mute)
447                 snd_soc_write(codec, WM8510_DAC, mute_reg | 0x40);
448         else
449                 snd_soc_write(codec, WM8510_DAC, mute_reg);
450         return 0;
451 }
452
453 /* liam need to make this lower power with dapm */
454 static int wm8510_set_bias_level(struct snd_soc_codec *codec,
455         enum snd_soc_bias_level level)
456 {
457         u16 power1 = snd_soc_read(codec, WM8510_POWER1) & ~0x3;
458
459         switch (level) {
460         case SND_SOC_BIAS_ON:
461         case SND_SOC_BIAS_PREPARE:
462                 power1 |= 0x1;  /* VMID 50k */
463                 snd_soc_write(codec, WM8510_POWER1, power1);
464                 break;
465
466         case SND_SOC_BIAS_STANDBY:
467                 power1 |= WM8510_POWER1_BIASEN | WM8510_POWER1_BUFIOEN;
468
469                 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
470                         snd_soc_cache_sync(codec);
471
472                         /* Initial cap charge at VMID 5k */
473                         snd_soc_write(codec, WM8510_POWER1, power1 | 0x3);
474                         mdelay(100);
475                 }
476
477                 power1 |= 0x2;  /* VMID 500k */
478                 snd_soc_write(codec, WM8510_POWER1, power1);
479                 break;
480
481         case SND_SOC_BIAS_OFF:
482                 snd_soc_write(codec, WM8510_POWER1, 0);
483                 snd_soc_write(codec, WM8510_POWER2, 0);
484                 snd_soc_write(codec, WM8510_POWER3, 0);
485                 break;
486         }
487
488         codec->dapm.bias_level = level;
489         return 0;
490 }
491
492 #define WM8510_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
493                 SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
494                 SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000)
495
496 #define WM8510_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
497         SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
498
499 static const struct snd_soc_dai_ops wm8510_dai_ops = {
500         .hw_params      = wm8510_pcm_hw_params,
501         .digital_mute   = wm8510_mute,
502         .set_fmt        = wm8510_set_dai_fmt,
503         .set_clkdiv     = wm8510_set_dai_clkdiv,
504         .set_pll        = wm8510_set_dai_pll,
505 };
506
507 static struct snd_soc_dai_driver wm8510_dai = {
508         .name = "wm8510-hifi",
509         .playback = {
510                 .stream_name = "Playback",
511                 .channels_min = 2,
512                 .channels_max = 2,
513                 .rates = WM8510_RATES,
514                 .formats = WM8510_FORMATS,},
515         .capture = {
516                 .stream_name = "Capture",
517                 .channels_min = 2,
518                 .channels_max = 2,
519                 .rates = WM8510_RATES,
520                 .formats = WM8510_FORMATS,},
521         .ops = &wm8510_dai_ops,
522         .symmetric_rates = 1,
523 };
524
525 static int wm8510_suspend(struct snd_soc_codec *codec)
526 {
527         wm8510_set_bias_level(codec, SND_SOC_BIAS_OFF);
528         return 0;
529 }
530
531 static int wm8510_resume(struct snd_soc_codec *codec)
532 {
533         wm8510_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
534         return 0;
535 }
536
537 static int wm8510_probe(struct snd_soc_codec *codec)
538 {
539         struct wm8510_priv *wm8510 = snd_soc_codec_get_drvdata(codec);
540         int ret;
541
542         ret = snd_soc_codec_set_cache_io(codec, 7, 9,  wm8510->control_type);
543         if (ret < 0) {
544                 printk(KERN_ERR "wm8510: failed to set cache I/O: %d\n", ret);
545                 return ret;
546         }
547
548         wm8510_reset(codec);
549
550         /* power on device */
551         wm8510_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
552
553         return ret;
554 }
555
556 /* power down chip */
557 static int wm8510_remove(struct snd_soc_codec *codec)
558 {
559         struct wm8510_priv *wm8510 = snd_soc_codec_get_drvdata(codec);
560
561         wm8510_set_bias_level(codec, SND_SOC_BIAS_OFF);
562         kfree(wm8510);
563         return 0;
564 }
565
566 static struct snd_soc_codec_driver soc_codec_dev_wm8510 = {
567         .probe =        wm8510_probe,
568         .remove =       wm8510_remove,
569         .suspend =      wm8510_suspend,
570         .resume =       wm8510_resume,
571         .set_bias_level = wm8510_set_bias_level,
572         .reg_cache_size = ARRAY_SIZE(wm8510_reg),
573         .reg_word_size = sizeof(u16),
574         .reg_cache_default =wm8510_reg,
575
576         .controls = wm8510_snd_controls,
577         .num_controls = ARRAY_SIZE(wm8510_snd_controls),
578         .dapm_widgets = wm8510_dapm_widgets,
579         .num_dapm_widgets = ARRAY_SIZE(wm8510_dapm_widgets),
580         .dapm_routes = wm8510_dapm_routes,
581         .num_dapm_routes = ARRAY_SIZE(wm8510_dapm_routes),
582 };
583
584 static const struct of_device_id wm8510_of_match[] = {
585         { .compatible = "wlf,wm8510" },
586         { },
587 };
588
589 #if defined(CONFIG_SPI_MASTER)
590 static int __devinit wm8510_spi_probe(struct spi_device *spi)
591 {
592         struct wm8510_priv *wm8510;
593         int ret;
594
595         wm8510 = kzalloc(sizeof(struct wm8510_priv), GFP_KERNEL);
596         if (wm8510 == NULL)
597                 return -ENOMEM;
598
599         wm8510->control_type = SND_SOC_SPI;
600         spi_set_drvdata(spi, wm8510);
601
602         ret = snd_soc_register_codec(&spi->dev,
603                         &soc_codec_dev_wm8510, &wm8510_dai, 1);
604         if (ret < 0)
605                 kfree(wm8510);
606         return ret;
607 }
608
609 static int __devexit wm8510_spi_remove(struct spi_device *spi)
610 {
611         snd_soc_unregister_codec(&spi->dev);
612         return 0;
613 }
614
615 static struct spi_driver wm8510_spi_driver = {
616         .driver = {
617                 .name   = "wm8510",
618                 .owner  = THIS_MODULE,
619                 .of_match_table = wm8510_of_match,
620         },
621         .probe          = wm8510_spi_probe,
622         .remove         = __devexit_p(wm8510_spi_remove),
623 };
624 #endif /* CONFIG_SPI_MASTER */
625
626 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
627 static __devinit int wm8510_i2c_probe(struct i2c_client *i2c,
628                                       const struct i2c_device_id *id)
629 {
630         struct wm8510_priv *wm8510;
631         int ret;
632
633         wm8510 = kzalloc(sizeof(struct wm8510_priv), GFP_KERNEL);
634         if (wm8510 == NULL)
635                 return -ENOMEM;
636
637         i2c_set_clientdata(i2c, wm8510);
638         wm8510->control_type = SND_SOC_I2C;
639
640         ret =  snd_soc_register_codec(&i2c->dev,
641                         &soc_codec_dev_wm8510, &wm8510_dai, 1);
642         if (ret < 0)
643                 kfree(wm8510);
644         return ret;
645 }
646
647 static __devexit int wm8510_i2c_remove(struct i2c_client *client)
648 {
649         snd_soc_unregister_codec(&client->dev);
650         return 0;
651 }
652
653 static const struct i2c_device_id wm8510_i2c_id[] = {
654         { "wm8510", 0 },
655         { }
656 };
657 MODULE_DEVICE_TABLE(i2c, wm8510_i2c_id);
658
659 static struct i2c_driver wm8510_i2c_driver = {
660         .driver = {
661                 .name = "wm8510",
662                 .owner = THIS_MODULE,
663                 .of_match_table = wm8510_of_match,
664         },
665         .probe =    wm8510_i2c_probe,
666         .remove =   __devexit_p(wm8510_i2c_remove),
667         .id_table = wm8510_i2c_id,
668 };
669 #endif
670
671 static int __init wm8510_modinit(void)
672 {
673         int ret = 0;
674 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
675         ret = i2c_add_driver(&wm8510_i2c_driver);
676         if (ret != 0) {
677                 printk(KERN_ERR "Failed to register WM8510 I2C driver: %d\n",
678                        ret);
679         }
680 #endif
681 #if defined(CONFIG_SPI_MASTER)
682         ret = spi_register_driver(&wm8510_spi_driver);
683         if (ret != 0) {
684                 printk(KERN_ERR "Failed to register WM8510 SPI driver: %d\n",
685                        ret);
686         }
687 #endif
688         return ret;
689 }
690 module_init(wm8510_modinit);
691
692 static void __exit wm8510_exit(void)
693 {
694 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
695         i2c_del_driver(&wm8510_i2c_driver);
696 #endif
697 #if defined(CONFIG_SPI_MASTER)
698         spi_unregister_driver(&wm8510_spi_driver);
699 #endif
700 }
701 module_exit(wm8510_exit);
702
703 MODULE_DESCRIPTION("ASoC WM8510 driver");
704 MODULE_AUTHOR("Liam Girdwood");
705 MODULE_LICENSE("GPL");