27c8b94c0551c3579c69f75161f482546ebb06b0
[sfrench/cifs-2.6.git] / sound / soc / codecs / wm8903.c
1 /*
2  * wm8903.c  --  WM8903 ALSA SoC Audio driver
3  *
4  * Copyright 2008 Wolfson Microelectronics
5  *
6  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
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  * TODO:
13  *  - TDM mode configuration.
14  *  - Mic detect.
15  *  - Digital microphone support.
16  *  - Interrupt support (mic detect and sequencer).
17  */
18
19 #include <linux/module.h>
20 #include <linux/moduleparam.h>
21 #include <linux/init.h>
22 #include <linux/delay.h>
23 #include <linux/pm.h>
24 #include <linux/i2c.h>
25 #include <linux/platform_device.h>
26 #include <sound/core.h>
27 #include <sound/pcm.h>
28 #include <sound/pcm_params.h>
29 #include <sound/tlv.h>
30 #include <sound/soc.h>
31 #include <sound/soc-dapm.h>
32 #include <sound/initval.h>
33
34 #include "wm8903.h"
35
36 /* Register defaults at reset */
37 static u16 wm8903_reg_defaults[] = {
38         0x8903,     /* R0   - SW Reset and ID */
39         0x0000,     /* R1   - Revision Number */
40         0x0000,     /* R2 */
41         0x0000,     /* R3 */
42         0x0018,     /* R4   - Bias Control 0 */
43         0x0000,     /* R5   - VMID Control 0 */
44         0x0000,     /* R6   - Mic Bias Control 0 */
45         0x0000,     /* R7 */
46         0x0001,     /* R8   - Analogue DAC 0 */
47         0x0000,     /* R9 */
48         0x0001,     /* R10  - Analogue ADC 0 */
49         0x0000,     /* R11 */
50         0x0000,     /* R12  - Power Management 0 */
51         0x0000,     /* R13  - Power Management 1 */
52         0x0000,     /* R14  - Power Management 2 */
53         0x0000,     /* R15  - Power Management 3 */
54         0x0000,     /* R16  - Power Management 4 */
55         0x0000,     /* R17  - Power Management 5 */
56         0x0000,     /* R18  - Power Management 6 */
57         0x0000,     /* R19 */
58         0x0400,     /* R20  - Clock Rates 0 */
59         0x0D07,     /* R21  - Clock Rates 1 */
60         0x0000,     /* R22  - Clock Rates 2 */
61         0x0000,     /* R23 */
62         0x0050,     /* R24  - Audio Interface 0 */
63         0x0242,     /* R25  - Audio Interface 1 */
64         0x0008,     /* R26  - Audio Interface 2 */
65         0x0022,     /* R27  - Audio Interface 3 */
66         0x0000,     /* R28 */
67         0x0000,     /* R29 */
68         0x00C0,     /* R30  - DAC Digital Volume Left */
69         0x00C0,     /* R31  - DAC Digital Volume Right */
70         0x0000,     /* R32  - DAC Digital 0 */
71         0x0000,     /* R33  - DAC Digital 1 */
72         0x0000,     /* R34 */
73         0x0000,     /* R35 */
74         0x00C0,     /* R36  - ADC Digital Volume Left */
75         0x00C0,     /* R37  - ADC Digital Volume Right */
76         0x0000,     /* R38  - ADC Digital 0 */
77         0x0073,     /* R39  - Digital Microphone 0 */
78         0x09BF,     /* R40  - DRC 0 */
79         0x3241,     /* R41  - DRC 1 */
80         0x0020,     /* R42  - DRC 2 */
81         0x0000,     /* R43  - DRC 3 */
82         0x0085,     /* R44  - Analogue Left Input 0 */
83         0x0085,     /* R45  - Analogue Right Input 0 */
84         0x0044,     /* R46  - Analogue Left Input 1 */
85         0x0044,     /* R47  - Analogue Right Input 1 */
86         0x0000,     /* R48 */
87         0x0000,     /* R49 */
88         0x0008,     /* R50  - Analogue Left Mix 0 */
89         0x0004,     /* R51  - Analogue Right Mix 0 */
90         0x0000,     /* R52  - Analogue Spk Mix Left 0 */
91         0x0000,     /* R53  - Analogue Spk Mix Left 1 */
92         0x0000,     /* R54  - Analogue Spk Mix Right 0 */
93         0x0000,     /* R55  - Analogue Spk Mix Right 1 */
94         0x0000,     /* R56 */
95         0x002D,     /* R57  - Analogue OUT1 Left */
96         0x002D,     /* R58  - Analogue OUT1 Right */
97         0x0039,     /* R59  - Analogue OUT2 Left */
98         0x0039,     /* R60  - Analogue OUT2 Right */
99         0x0100,     /* R61 */
100         0x0139,     /* R62  - Analogue OUT3 Left */
101         0x0139,     /* R63  - Analogue OUT3 Right */
102         0x0000,     /* R64 */
103         0x0000,     /* R65  - Analogue SPK Output Control 0 */
104         0x0000,     /* R66 */
105         0x0010,     /* R67  - DC Servo 0 */
106         0x0100,     /* R68 */
107         0x00A4,     /* R69  - DC Servo 2 */
108         0x0807,     /* R70 */
109         0x0000,     /* R71 */
110         0x0000,     /* R72 */
111         0x0000,     /* R73 */
112         0x0000,     /* R74 */
113         0x0000,     /* R75 */
114         0x0000,     /* R76 */
115         0x0000,     /* R77 */
116         0x0000,     /* R78 */
117         0x000E,     /* R79 */
118         0x0000,     /* R80 */
119         0x0000,     /* R81 */
120         0x0000,     /* R82 */
121         0x0000,     /* R83 */
122         0x0000,     /* R84 */
123         0x0000,     /* R85 */
124         0x0000,     /* R86 */
125         0x0006,     /* R87 */
126         0x0000,     /* R88 */
127         0x0000,     /* R89 */
128         0x0000,     /* R90  - Analogue HP 0 */
129         0x0060,     /* R91 */
130         0x0000,     /* R92 */
131         0x0000,     /* R93 */
132         0x0000,     /* R94  - Analogue Lineout 0 */
133         0x0060,     /* R95 */
134         0x0000,     /* R96 */
135         0x0000,     /* R97 */
136         0x0000,     /* R98  - Charge Pump 0 */
137         0x1F25,     /* R99 */
138         0x2B19,     /* R100 */
139         0x01C0,     /* R101 */
140         0x01EF,     /* R102 */
141         0x2B00,     /* R103 */
142         0x0000,     /* R104 - Class W 0 */
143         0x01C0,     /* R105 */
144         0x1C10,     /* R106 */
145         0x0000,     /* R107 */
146         0x0000,     /* R108 - Write Sequencer 0 */
147         0x0000,     /* R109 - Write Sequencer 1 */
148         0x0000,     /* R110 - Write Sequencer 2 */
149         0x0000,     /* R111 - Write Sequencer 3 */
150         0x0000,     /* R112 - Write Sequencer 4 */
151         0x0000,     /* R113 */
152         0x0000,     /* R114 - Control Interface */
153         0x0000,     /* R115 */
154         0x00A8,     /* R116 - GPIO Control 1 */
155         0x00A8,     /* R117 - GPIO Control 2 */
156         0x00A8,     /* R118 - GPIO Control 3 */
157         0x0220,     /* R119 - GPIO Control 4 */
158         0x01A0,     /* R120 - GPIO Control 5 */
159         0x0000,     /* R121 - Interrupt Status 1 */
160         0xFFFF,     /* R122 - Interrupt Status 1 Mask */
161         0x0000,     /* R123 - Interrupt Polarity 1 */
162         0x0000,     /* R124 */
163         0x0003,     /* R125 */
164         0x0000,     /* R126 - Interrupt Control */
165         0x0000,     /* R127 */
166         0x0005,     /* R128 */
167         0x0000,     /* R129 - Control Interface Test 1 */
168         0x0000,     /* R130 */
169         0x0000,     /* R131 */
170         0x0000,     /* R132 */
171         0x0000,     /* R133 */
172         0x0000,     /* R134 */
173         0x03FF,     /* R135 */
174         0x0007,     /* R136 */
175         0x0040,     /* R137 */
176         0x0000,     /* R138 */
177         0x0000,     /* R139 */
178         0x0000,     /* R140 */
179         0x0000,     /* R141 */
180         0x0000,     /* R142 */
181         0x0000,     /* R143 */
182         0x0000,     /* R144 */
183         0x0000,     /* R145 */
184         0x0000,     /* R146 */
185         0x0000,     /* R147 */
186         0x4000,     /* R148 */
187         0x6810,     /* R149 - Charge Pump Test 1 */
188         0x0004,     /* R150 */
189         0x0000,     /* R151 */
190         0x0000,     /* R152 */
191         0x0000,     /* R153 */
192         0x0000,     /* R154 */
193         0x0000,     /* R155 */
194         0x0000,     /* R156 */
195         0x0000,     /* R157 */
196         0x0000,     /* R158 */
197         0x0000,     /* R159 */
198         0x0000,     /* R160 */
199         0x0000,     /* R161 */
200         0x0000,     /* R162 */
201         0x0000,     /* R163 */
202         0x0028,     /* R164 - Clock Rate Test 4 */
203         0x0004,     /* R165 */
204         0x0000,     /* R166 */
205         0x0060,     /* R167 */
206         0x0000,     /* R168 */
207         0x0000,     /* R169 */
208         0x0000,     /* R170 */
209         0x0000,     /* R171 */
210         0x0000,     /* R172 - Analogue Output Bias 0 */
211 };
212
213 struct wm8903_priv {
214         struct snd_soc_codec codec;
215         u16 reg_cache[ARRAY_SIZE(wm8903_reg_defaults)];
216
217         int sysclk;
218
219         /* Reference counts */
220         int class_w_users;
221         int playback_active;
222         int capture_active;
223
224         struct snd_pcm_substream *master_substream;
225         struct snd_pcm_substream *slave_substream;
226 };
227
228
229 static unsigned int wm8903_read_reg_cache(struct snd_soc_codec *codec,
230                                                  unsigned int reg)
231 {
232         u16 *cache = codec->reg_cache;
233
234         BUG_ON(reg >= ARRAY_SIZE(wm8903_reg_defaults));
235
236         return cache[reg];
237 }
238
239 static unsigned int wm8903_hw_read(struct snd_soc_codec *codec, u8 reg)
240 {
241         struct i2c_msg xfer[2];
242         u16 data;
243         int ret;
244         struct i2c_client *client = codec->control_data;
245
246         /* Write register */
247         xfer[0].addr = client->addr;
248         xfer[0].flags = 0;
249         xfer[0].len = 1;
250         xfer[0].buf = &reg;
251
252         /* Read data */
253         xfer[1].addr = client->addr;
254         xfer[1].flags = I2C_M_RD;
255         xfer[1].len = 2;
256         xfer[1].buf = (u8 *)&data;
257
258         ret = i2c_transfer(client->adapter, xfer, 2);
259         if (ret != 2) {
260                 pr_err("i2c_transfer returned %d\n", ret);
261                 return 0;
262         }
263
264         return (data >> 8) | ((data & 0xff) << 8);
265 }
266
267 static unsigned int wm8903_read(struct snd_soc_codec *codec,
268                                 unsigned int reg)
269 {
270         switch (reg) {
271         case WM8903_SW_RESET_AND_ID:
272         case WM8903_REVISION_NUMBER:
273         case WM8903_INTERRUPT_STATUS_1:
274         case WM8903_WRITE_SEQUENCER_4:
275                 return wm8903_hw_read(codec, reg);
276
277         default:
278                 return wm8903_read_reg_cache(codec, reg);
279         }
280 }
281
282 static void wm8903_write_reg_cache(struct snd_soc_codec *codec,
283                                    u16 reg, unsigned int value)
284 {
285         u16 *cache = codec->reg_cache;
286
287         BUG_ON(reg >= ARRAY_SIZE(wm8903_reg_defaults));
288
289         switch (reg) {
290         case WM8903_SW_RESET_AND_ID:
291         case WM8903_REVISION_NUMBER:
292                 break;
293
294         default:
295                 cache[reg] = value;
296                 break;
297         }
298 }
299
300 static int wm8903_write(struct snd_soc_codec *codec, unsigned int reg,
301                         unsigned int value)
302 {
303         u8 data[3];
304
305         wm8903_write_reg_cache(codec, reg, value);
306
307         /* Data format is 1 byte of address followed by 2 bytes of data */
308         data[0] = reg;
309         data[1] = (value >> 8) & 0xff;
310         data[2] = value & 0xff;
311
312         if (codec->hw_write(codec->control_data, data, 3) == 2)
313                 return 0;
314         else
315                 return -EIO;
316 }
317
318 static int wm8903_run_sequence(struct snd_soc_codec *codec, unsigned int start)
319 {
320         u16 reg[5];
321         struct i2c_client *i2c = codec->control_data;
322
323         BUG_ON(start > 48);
324
325         /* Enable the sequencer */
326         reg[0] = wm8903_read(codec, WM8903_WRITE_SEQUENCER_0);
327         reg[0] |= WM8903_WSEQ_ENA;
328         wm8903_write(codec, WM8903_WRITE_SEQUENCER_0, reg[0]);
329
330         dev_dbg(&i2c->dev, "Starting sequence at %d\n", start);
331
332         wm8903_write(codec, WM8903_WRITE_SEQUENCER_3,
333                      start | WM8903_WSEQ_START);
334
335         /* Wait for it to complete.  If we have the interrupt wired up then
336          * we could block waiting for an interrupt, though polling may still
337          * be desirable for diagnostic purposes.
338          */
339         do {
340                 msleep(10);
341
342                 reg[4] = wm8903_read(codec, WM8903_WRITE_SEQUENCER_4);
343         } while (reg[4] & WM8903_WSEQ_BUSY);
344
345         dev_dbg(&i2c->dev, "Sequence complete\n");
346
347         /* Disable the sequencer again */
348         wm8903_write(codec, WM8903_WRITE_SEQUENCER_0,
349                      reg[0] & ~WM8903_WSEQ_ENA);
350
351         return 0;
352 }
353
354 static void wm8903_sync_reg_cache(struct snd_soc_codec *codec, u16 *cache)
355 {
356         int i;
357
358         /* There really ought to be something better we can do here :/ */
359         for (i = 0; i < ARRAY_SIZE(wm8903_reg_defaults); i++)
360                 cache[i] = wm8903_hw_read(codec, i);
361 }
362
363 static void wm8903_reset(struct snd_soc_codec *codec)
364 {
365         wm8903_write(codec, WM8903_SW_RESET_AND_ID, 0);
366         memcpy(codec->reg_cache, wm8903_reg_defaults,
367                sizeof(wm8903_reg_defaults));
368 }
369
370 #define WM8903_OUTPUT_SHORT 0x8
371 #define WM8903_OUTPUT_OUT   0x4
372 #define WM8903_OUTPUT_INT   0x2
373 #define WM8903_OUTPUT_IN    0x1
374
375 static int wm8903_cp_event(struct snd_soc_dapm_widget *w,
376                            struct snd_kcontrol *kcontrol, int event)
377 {
378         WARN_ON(event != SND_SOC_DAPM_POST_PMU);
379         mdelay(4);
380
381         return 0;
382 }
383
384 /*
385  * Event for headphone and line out amplifier power changes.  Special
386  * power up/down sequences are required in order to maximise pop/click
387  * performance.
388  */
389 static int wm8903_output_event(struct snd_soc_dapm_widget *w,
390                                struct snd_kcontrol *kcontrol, int event)
391 {
392         struct snd_soc_codec *codec = w->codec;
393         u16 val;
394         u16 reg;
395         int shift;
396
397         switch (w->reg) {
398         case WM8903_POWER_MANAGEMENT_2:
399                 reg = WM8903_ANALOGUE_HP_0;
400                 break;
401         case WM8903_POWER_MANAGEMENT_3:
402                 reg = WM8903_ANALOGUE_LINEOUT_0;
403                 break;
404         default:
405                 BUG();
406                 return -EINVAL;  /* Spurious warning from some compilers */
407         }
408
409         switch (w->shift) {
410         case 0:
411                 shift = 0;
412                 break;
413         case 1:
414                 shift = 4;
415                 break;
416         default:
417                 BUG();
418                 return -EINVAL;  /* Spurious warning from some compilers */
419         }
420
421         if (event & SND_SOC_DAPM_PRE_PMU) {
422                 val = wm8903_read(codec, reg);
423
424                 /* Short the output */
425                 val &= ~(WM8903_OUTPUT_SHORT << shift);
426                 wm8903_write(codec, reg, val);
427         }
428
429         if (event & SND_SOC_DAPM_POST_PMU) {
430                 val = wm8903_read(codec, reg);
431
432                 val |= (WM8903_OUTPUT_IN << shift);
433                 wm8903_write(codec, reg, val);
434
435                 val |= (WM8903_OUTPUT_INT << shift);
436                 wm8903_write(codec, reg, val);
437
438                 /* Turn on the output ENA_OUTP */
439                 val |= (WM8903_OUTPUT_OUT << shift);
440                 wm8903_write(codec, reg, val);
441
442                 /* Remove the short */
443                 val |= (WM8903_OUTPUT_SHORT << shift);
444                 wm8903_write(codec, reg, val);
445         }
446
447         if (event & SND_SOC_DAPM_PRE_PMD) {
448                 val = wm8903_read(codec, reg);
449
450                 /* Short the output */
451                 val &= ~(WM8903_OUTPUT_SHORT << shift);
452                 wm8903_write(codec, reg, val);
453
454                 /* Then disable the intermediate and output stages */
455                 val &= ~((WM8903_OUTPUT_OUT | WM8903_OUTPUT_INT |
456                           WM8903_OUTPUT_IN) << shift);
457                 wm8903_write(codec, reg, val);
458         }
459
460         return 0;
461 }
462
463 /*
464  * When used with DAC outputs only the WM8903 charge pump supports
465  * operation in class W mode, providing very low power consumption
466  * when used with digital sources.  Enable and disable this mode
467  * automatically depending on the mixer configuration.
468  *
469  * All the relevant controls are simple switches.
470  */
471 static int wm8903_class_w_put(struct snd_kcontrol *kcontrol,
472                               struct snd_ctl_elem_value *ucontrol)
473 {
474         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
475         struct snd_soc_codec *codec = widget->codec;
476         struct wm8903_priv *wm8903 = codec->private_data;
477         struct i2c_client *i2c = codec->control_data;
478         u16 reg;
479         int ret;
480
481         reg = wm8903_read(codec, WM8903_CLASS_W_0);
482
483         /* Turn it off if we're about to enable bypass */
484         if (ucontrol->value.integer.value[0]) {
485                 if (wm8903->class_w_users == 0) {
486                         dev_dbg(&i2c->dev, "Disabling Class W\n");
487                         wm8903_write(codec, WM8903_CLASS_W_0, reg &
488                                      ~(WM8903_CP_DYN_FREQ | WM8903_CP_DYN_V));
489                 }
490                 wm8903->class_w_users++;
491         }
492
493         /* Implement the change */
494         ret = snd_soc_dapm_put_volsw(kcontrol, ucontrol);
495
496         /* If we've just disabled the last bypass path turn Class W on */
497         if (!ucontrol->value.integer.value[0]) {
498                 if (wm8903->class_w_users == 1) {
499                         dev_dbg(&i2c->dev, "Enabling Class W\n");
500                         wm8903_write(codec, WM8903_CLASS_W_0, reg |
501                                      WM8903_CP_DYN_FREQ | WM8903_CP_DYN_V);
502                 }
503                 wm8903->class_w_users--;
504         }
505
506         dev_dbg(&i2c->dev, "Bypass use count now %d\n",
507                 wm8903->class_w_users);
508
509         return ret;
510 }
511
512 #define SOC_DAPM_SINGLE_W(xname, reg, shift, max, invert) \
513 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
514         .info = snd_soc_info_volsw, \
515         .get = snd_soc_dapm_get_volsw, .put = wm8903_class_w_put, \
516         .private_value =  SOC_SINGLE_VALUE(reg, shift, max, invert) }
517
518
519 /* ALSA can only do steps of .01dB */
520 static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1);
521
522 static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
523
524 static const DECLARE_TLV_DB_SCALE(drc_tlv_thresh, 0, 75, 0);
525 static const DECLARE_TLV_DB_SCALE(drc_tlv_amp, -2250, 75, 0);
526 static const DECLARE_TLV_DB_SCALE(drc_tlv_min, 0, 600, 0);
527 static const DECLARE_TLV_DB_SCALE(drc_tlv_max, 1200, 600, 0);
528 static const DECLARE_TLV_DB_SCALE(drc_tlv_startup, -300, 50, 0);
529
530 static const char *drc_slope_text[] = {
531         "1", "1/2", "1/4", "1/8", "1/16", "0"
532 };
533
534 static const struct soc_enum drc_slope_r0 =
535         SOC_ENUM_SINGLE(WM8903_DRC_2, 3, 6, drc_slope_text);
536
537 static const struct soc_enum drc_slope_r1 =
538         SOC_ENUM_SINGLE(WM8903_DRC_2, 0, 6, drc_slope_text);
539
540 static const char *drc_attack_text[] = {
541         "instantaneous",
542         "363us", "762us", "1.45ms", "2.9ms", "5.8ms", "11.6ms", "23.2ms",
543         "46.4ms", "92.8ms", "185.6ms"
544 };
545
546 static const struct soc_enum drc_attack =
547         SOC_ENUM_SINGLE(WM8903_DRC_1, 12, 11, drc_attack_text);
548
549 static const char *drc_decay_text[] = {
550         "186ms", "372ms", "743ms", "1.49s", "2.97s", "5.94s", "11.89s",
551         "23.87s", "47.56s"
552 };
553
554 static const struct soc_enum drc_decay =
555         SOC_ENUM_SINGLE(WM8903_DRC_1, 8, 9, drc_decay_text);
556
557 static const char *drc_ff_delay_text[] = {
558         "5 samples", "9 samples"
559 };
560
561 static const struct soc_enum drc_ff_delay =
562         SOC_ENUM_SINGLE(WM8903_DRC_0, 5, 2, drc_ff_delay_text);
563
564 static const char *drc_qr_decay_text[] = {
565         "0.725ms", "1.45ms", "5.8ms"
566 };
567
568 static const struct soc_enum drc_qr_decay =
569         SOC_ENUM_SINGLE(WM8903_DRC_1, 4, 3, drc_qr_decay_text);
570
571 static const char *drc_smoothing_text[] = {
572         "Low", "Medium", "High"
573 };
574
575 static const struct soc_enum drc_smoothing =
576         SOC_ENUM_SINGLE(WM8903_DRC_0, 11, 3, drc_smoothing_text);
577
578 static const char *soft_mute_text[] = {
579         "Fast (fs/2)", "Slow (fs/32)"
580 };
581
582 static const struct soc_enum soft_mute =
583         SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_1, 10, 2, soft_mute_text);
584
585 static const char *mute_mode_text[] = {
586         "Hard", "Soft"
587 };
588
589 static const struct soc_enum mute_mode =
590         SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_1, 9, 2, mute_mode_text);
591
592 static const char *dac_deemphasis_text[] = {
593         "Disabled", "32kHz", "44.1kHz", "48kHz"
594 };
595
596 static const struct soc_enum dac_deemphasis =
597         SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_1, 1, 4, dac_deemphasis_text);
598
599 static const char *companding_text[] = {
600         "ulaw", "alaw"
601 };
602
603 static const struct soc_enum dac_companding =
604         SOC_ENUM_SINGLE(WM8903_AUDIO_INTERFACE_0, 0, 2, companding_text);
605
606 static const struct soc_enum adc_companding =
607         SOC_ENUM_SINGLE(WM8903_AUDIO_INTERFACE_0, 2, 2, companding_text);
608
609 static const char *input_mode_text[] = {
610         "Single-Ended", "Differential Line", "Differential Mic"
611 };
612
613 static const struct soc_enum linput_mode_enum =
614         SOC_ENUM_SINGLE(WM8903_ANALOGUE_LEFT_INPUT_1, 0, 3, input_mode_text);
615
616 static const struct soc_enum rinput_mode_enum =
617         SOC_ENUM_SINGLE(WM8903_ANALOGUE_RIGHT_INPUT_1, 0, 3, input_mode_text);
618
619 static const char *linput_mux_text[] = {
620         "IN1L", "IN2L", "IN3L"
621 };
622
623 static const struct soc_enum linput_enum =
624         SOC_ENUM_SINGLE(WM8903_ANALOGUE_LEFT_INPUT_1, 2, 3, linput_mux_text);
625
626 static const struct soc_enum linput_inv_enum =
627         SOC_ENUM_SINGLE(WM8903_ANALOGUE_LEFT_INPUT_1, 4, 3, linput_mux_text);
628
629 static const char *rinput_mux_text[] = {
630         "IN1R", "IN2R", "IN3R"
631 };
632
633 static const struct soc_enum rinput_enum =
634         SOC_ENUM_SINGLE(WM8903_ANALOGUE_RIGHT_INPUT_1, 2, 3, rinput_mux_text);
635
636 static const struct soc_enum rinput_inv_enum =
637         SOC_ENUM_SINGLE(WM8903_ANALOGUE_RIGHT_INPUT_1, 4, 3, rinput_mux_text);
638
639
640 static const struct snd_kcontrol_new wm8903_snd_controls[] = {
641
642 /* Input PGAs - No TLV since the scale depends on PGA mode */
643 SOC_SINGLE("Left Input PGA Switch", WM8903_ANALOGUE_LEFT_INPUT_0,
644            7, 1, 1),
645 SOC_SINGLE("Left Input PGA Volume", WM8903_ANALOGUE_LEFT_INPUT_0,
646            0, 31, 0),
647 SOC_SINGLE("Left Input PGA Common Mode Switch", WM8903_ANALOGUE_LEFT_INPUT_1,
648            6, 1, 0),
649
650 SOC_SINGLE("Right Input PGA Switch", WM8903_ANALOGUE_RIGHT_INPUT_0,
651            7, 1, 1),
652 SOC_SINGLE("Right Input PGA Volume", WM8903_ANALOGUE_RIGHT_INPUT_0,
653            0, 31, 0),
654 SOC_SINGLE("Right Input PGA Common Mode Switch", WM8903_ANALOGUE_RIGHT_INPUT_1,
655            6, 1, 0),
656
657 /* ADCs */
658 SOC_SINGLE("DRC Switch", WM8903_DRC_0, 15, 1, 0),
659 SOC_ENUM("DRC Compressor Slope R0", drc_slope_r0),
660 SOC_ENUM("DRC Compressor Slope R1", drc_slope_r1),
661 SOC_SINGLE_TLV("DRC Compressor Threashold Volume", WM8903_DRC_3, 5, 124, 1,
662                drc_tlv_thresh),
663 SOC_SINGLE_TLV("DRC Volume", WM8903_DRC_3, 0, 30, 1, drc_tlv_amp),
664 SOC_SINGLE_TLV("DRC Minimum Gain Volume", WM8903_DRC_1, 2, 3, 1, drc_tlv_min),
665 SOC_SINGLE_TLV("DRC Maximum Gain Volume", WM8903_DRC_1, 0, 3, 0, drc_tlv_max),
666 SOC_ENUM("DRC Attack Rate", drc_attack),
667 SOC_ENUM("DRC Decay Rate", drc_decay),
668 SOC_ENUM("DRC FF Delay", drc_ff_delay),
669 SOC_SINGLE("DRC Anticlip Switch", WM8903_DRC_0, 1, 1, 0),
670 SOC_SINGLE("DRC QR Switch", WM8903_DRC_0, 2, 1, 0),
671 SOC_SINGLE_TLV("DRC QR Threashold Volume", WM8903_DRC_0, 6, 3, 0, drc_tlv_max),
672 SOC_ENUM("DRC QR Decay Rate", drc_qr_decay),
673 SOC_SINGLE("DRC Smoothing Switch", WM8903_DRC_0, 3, 1, 0),
674 SOC_SINGLE("DRC Smoothing Hysteresis Switch", WM8903_DRC_0, 0, 1, 0),
675 SOC_ENUM("DRC Smoothing Threashold", drc_smoothing),
676 SOC_SINGLE_TLV("DRC Startup Volume", WM8903_DRC_0, 6, 18, 0, drc_tlv_startup),
677
678 SOC_DOUBLE_R_TLV("Digital Capture Volume", WM8903_ADC_DIGITAL_VOLUME_LEFT,
679                  WM8903_ADC_DIGITAL_VOLUME_RIGHT, 1, 96, 0, digital_tlv),
680 SOC_ENUM("ADC Companding Mode", adc_companding),
681 SOC_SINGLE("ADC Companding Switch", WM8903_AUDIO_INTERFACE_0, 3, 1, 0),
682
683 /* DAC */
684 SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8903_DAC_DIGITAL_VOLUME_LEFT,
685                  WM8903_DAC_DIGITAL_VOLUME_RIGHT, 1, 120, 0, digital_tlv),
686 SOC_ENUM("DAC Soft Mute Rate", soft_mute),
687 SOC_ENUM("DAC Mute Mode", mute_mode),
688 SOC_SINGLE("DAC Mono Switch", WM8903_DAC_DIGITAL_1, 12, 1, 0),
689 SOC_ENUM("DAC De-emphasis", dac_deemphasis),
690 SOC_SINGLE("DAC Sloping Stopband Filter Switch",
691            WM8903_DAC_DIGITAL_1, 11, 1, 0),
692 SOC_ENUM("DAC Companding Mode", dac_companding),
693 SOC_SINGLE("DAC Companding Switch", WM8903_AUDIO_INTERFACE_0, 1, 1, 0),
694
695 /* Headphones */
696 SOC_DOUBLE_R("Headphone Switch",
697              WM8903_ANALOGUE_OUT1_LEFT, WM8903_ANALOGUE_OUT1_RIGHT,
698              8, 1, 1),
699 SOC_DOUBLE_R("Headphone ZC Switch",
700              WM8903_ANALOGUE_OUT1_LEFT, WM8903_ANALOGUE_OUT1_RIGHT,
701              6, 1, 0),
702 SOC_DOUBLE_R_TLV("Headphone Volume",
703                  WM8903_ANALOGUE_OUT1_LEFT, WM8903_ANALOGUE_OUT1_RIGHT,
704                  0, 63, 0, out_tlv),
705
706 /* Line out */
707 SOC_DOUBLE_R("Line Out Switch",
708              WM8903_ANALOGUE_OUT2_LEFT, WM8903_ANALOGUE_OUT2_RIGHT,
709              8, 1, 1),
710 SOC_DOUBLE_R("Line Out ZC Switch",
711              WM8903_ANALOGUE_OUT2_LEFT, WM8903_ANALOGUE_OUT2_RIGHT,
712              6, 1, 0),
713 SOC_DOUBLE_R_TLV("Line Out Volume",
714                  WM8903_ANALOGUE_OUT2_LEFT, WM8903_ANALOGUE_OUT2_RIGHT,
715                  0, 63, 0, out_tlv),
716
717 /* Speaker */
718 SOC_DOUBLE_R("Speaker Switch",
719              WM8903_ANALOGUE_OUT3_LEFT, WM8903_ANALOGUE_OUT3_RIGHT, 8, 1, 1),
720 SOC_DOUBLE_R("Speaker ZC Switch",
721              WM8903_ANALOGUE_OUT3_LEFT, WM8903_ANALOGUE_OUT3_RIGHT, 6, 1, 0),
722 SOC_DOUBLE_R_TLV("Speaker Volume",
723                  WM8903_ANALOGUE_OUT3_LEFT, WM8903_ANALOGUE_OUT3_RIGHT,
724                  0, 63, 0, out_tlv),
725 };
726
727 static const struct snd_kcontrol_new linput_mode_mux =
728         SOC_DAPM_ENUM("Left Input Mode Mux", linput_mode_enum);
729
730 static const struct snd_kcontrol_new rinput_mode_mux =
731         SOC_DAPM_ENUM("Right Input Mode Mux", rinput_mode_enum);
732
733 static const struct snd_kcontrol_new linput_mux =
734         SOC_DAPM_ENUM("Left Input Mux", linput_enum);
735
736 static const struct snd_kcontrol_new linput_inv_mux =
737         SOC_DAPM_ENUM("Left Inverting Input Mux", linput_inv_enum);
738
739 static const struct snd_kcontrol_new rinput_mux =
740         SOC_DAPM_ENUM("Right Input Mux", rinput_enum);
741
742 static const struct snd_kcontrol_new rinput_inv_mux =
743         SOC_DAPM_ENUM("Right Inverting Input Mux", rinput_inv_enum);
744
745 static const struct snd_kcontrol_new left_output_mixer[] = {
746 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_LEFT_MIX_0, 3, 1, 0),
747 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_LEFT_MIX_0, 2, 1, 0),
748 SOC_DAPM_SINGLE_W("Left Bypass Switch", WM8903_ANALOGUE_LEFT_MIX_0, 1, 1, 0),
749 SOC_DAPM_SINGLE_W("Right Bypass Switch", WM8903_ANALOGUE_LEFT_MIX_0, 0, 1, 0),
750 };
751
752 static const struct snd_kcontrol_new right_output_mixer[] = {
753 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 3, 1, 0),
754 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 2, 1, 0),
755 SOC_DAPM_SINGLE_W("Left Bypass Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 1, 1, 0),
756 SOC_DAPM_SINGLE_W("Right Bypass Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 0, 1, 0),
757 };
758
759 static const struct snd_kcontrol_new left_speaker_mixer[] = {
760 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0, 3, 1, 0),
761 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0, 2, 1, 0),
762 SOC_DAPM_SINGLE("Left Bypass Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0, 1, 1, 0),
763 SOC_DAPM_SINGLE("Right Bypass Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0,
764                 0, 1, 0),
765 };
766
767 static const struct snd_kcontrol_new right_speaker_mixer[] = {
768 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0, 3, 1, 0),
769 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0, 2, 1, 0),
770 SOC_DAPM_SINGLE("Left Bypass Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0,
771                 1, 1, 0),
772 SOC_DAPM_SINGLE("Right Bypass Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0,
773                 0, 1, 0),
774 };
775
776 static const struct snd_soc_dapm_widget wm8903_dapm_widgets[] = {
777 SND_SOC_DAPM_INPUT("IN1L"),
778 SND_SOC_DAPM_INPUT("IN1R"),
779 SND_SOC_DAPM_INPUT("IN2L"),
780 SND_SOC_DAPM_INPUT("IN2R"),
781 SND_SOC_DAPM_INPUT("IN3L"),
782 SND_SOC_DAPM_INPUT("IN3R"),
783
784 SND_SOC_DAPM_OUTPUT("HPOUTL"),
785 SND_SOC_DAPM_OUTPUT("HPOUTR"),
786 SND_SOC_DAPM_OUTPUT("LINEOUTL"),
787 SND_SOC_DAPM_OUTPUT("LINEOUTR"),
788 SND_SOC_DAPM_OUTPUT("LOP"),
789 SND_SOC_DAPM_OUTPUT("LON"),
790 SND_SOC_DAPM_OUTPUT("ROP"),
791 SND_SOC_DAPM_OUTPUT("RON"),
792
793 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8903_MIC_BIAS_CONTROL_0, 0, 0),
794
795 SND_SOC_DAPM_MUX("Left Input Mux", SND_SOC_NOPM, 0, 0, &linput_mux),
796 SND_SOC_DAPM_MUX("Left Input Inverting Mux", SND_SOC_NOPM, 0, 0,
797                  &linput_inv_mux),
798 SND_SOC_DAPM_MUX("Left Input Mode Mux", SND_SOC_NOPM, 0, 0, &linput_mode_mux),
799
800 SND_SOC_DAPM_MUX("Right Input Mux", SND_SOC_NOPM, 0, 0, &rinput_mux),
801 SND_SOC_DAPM_MUX("Right Input Inverting Mux", SND_SOC_NOPM, 0, 0,
802                  &rinput_inv_mux),
803 SND_SOC_DAPM_MUX("Right Input Mode Mux", SND_SOC_NOPM, 0, 0, &rinput_mode_mux),
804
805 SND_SOC_DAPM_PGA("Left Input PGA", WM8903_POWER_MANAGEMENT_0, 1, 0, NULL, 0),
806 SND_SOC_DAPM_PGA("Right Input PGA", WM8903_POWER_MANAGEMENT_0, 0, 0, NULL, 0),
807
808 SND_SOC_DAPM_ADC("ADCL", "Left HiFi Capture", WM8903_POWER_MANAGEMENT_6, 1, 0),
809 SND_SOC_DAPM_ADC("ADCR", "Right HiFi Capture", WM8903_POWER_MANAGEMENT_6, 0, 0),
810
811 SND_SOC_DAPM_DAC("DACL", "Left Playback", WM8903_POWER_MANAGEMENT_6, 3, 0),
812 SND_SOC_DAPM_DAC("DACR", "Right Playback", WM8903_POWER_MANAGEMENT_6, 2, 0),
813
814 SND_SOC_DAPM_MIXER("Left Output Mixer", WM8903_POWER_MANAGEMENT_1, 1, 0,
815                    left_output_mixer, ARRAY_SIZE(left_output_mixer)),
816 SND_SOC_DAPM_MIXER("Right Output Mixer", WM8903_POWER_MANAGEMENT_1, 0, 0,
817                    right_output_mixer, ARRAY_SIZE(right_output_mixer)),
818
819 SND_SOC_DAPM_MIXER("Left Speaker Mixer", WM8903_POWER_MANAGEMENT_4, 1, 0,
820                    left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer)),
821 SND_SOC_DAPM_MIXER("Right Speaker Mixer", WM8903_POWER_MANAGEMENT_4, 0, 0,
822                    right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer)),
823
824 SND_SOC_DAPM_PGA_E("Left Headphone Output PGA", WM8903_POWER_MANAGEMENT_2,
825                    1, 0, NULL, 0, wm8903_output_event,
826                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
827                    SND_SOC_DAPM_PRE_PMD),
828 SND_SOC_DAPM_PGA_E("Right Headphone Output PGA", WM8903_POWER_MANAGEMENT_2,
829                    0, 0, NULL, 0, wm8903_output_event,
830                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
831                    SND_SOC_DAPM_PRE_PMD),
832
833 SND_SOC_DAPM_PGA_E("Left Line Output PGA", WM8903_POWER_MANAGEMENT_3, 1, 0,
834                    NULL, 0, wm8903_output_event,
835                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
836                    SND_SOC_DAPM_PRE_PMD),
837 SND_SOC_DAPM_PGA_E("Right Line Output PGA", WM8903_POWER_MANAGEMENT_3, 0, 0,
838                    NULL, 0, wm8903_output_event,
839                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
840                    SND_SOC_DAPM_PRE_PMD),
841
842 SND_SOC_DAPM_PGA("Left Speaker PGA", WM8903_POWER_MANAGEMENT_5, 1, 0,
843                  NULL, 0),
844 SND_SOC_DAPM_PGA("Right Speaker PGA", WM8903_POWER_MANAGEMENT_5, 0, 0,
845                  NULL, 0),
846
847 SND_SOC_DAPM_SUPPLY("Charge Pump", WM8903_CHARGE_PUMP_0, 0, 0,
848                     wm8903_cp_event, SND_SOC_DAPM_POST_PMU),
849 SND_SOC_DAPM_SUPPLY("CLK_DSP", WM8903_CLOCK_RATES_2, 1, 0, NULL, 0),
850 };
851
852 static const struct snd_soc_dapm_route intercon[] = {
853
854         { "Left Input Mux", "IN1L", "IN1L" },
855         { "Left Input Mux", "IN2L", "IN2L" },
856         { "Left Input Mux", "IN3L", "IN3L" },
857
858         { "Left Input Inverting Mux", "IN1L", "IN1L" },
859         { "Left Input Inverting Mux", "IN2L", "IN2L" },
860         { "Left Input Inverting Mux", "IN3L", "IN3L" },
861
862         { "Right Input Mux", "IN1R", "IN1R" },
863         { "Right Input Mux", "IN2R", "IN2R" },
864         { "Right Input Mux", "IN3R", "IN3R" },
865
866         { "Right Input Inverting Mux", "IN1R", "IN1R" },
867         { "Right Input Inverting Mux", "IN2R", "IN2R" },
868         { "Right Input Inverting Mux", "IN3R", "IN3R" },
869
870         { "Left Input Mode Mux", "Single-Ended", "Left Input Inverting Mux" },
871         { "Left Input Mode Mux", "Differential Line",
872           "Left Input Mux" },
873         { "Left Input Mode Mux", "Differential Line",
874           "Left Input Inverting Mux" },
875         { "Left Input Mode Mux", "Differential Mic",
876           "Left Input Mux" },
877         { "Left Input Mode Mux", "Differential Mic",
878           "Left Input Inverting Mux" },
879
880         { "Right Input Mode Mux", "Single-Ended",
881           "Right Input Inverting Mux" },
882         { "Right Input Mode Mux", "Differential Line",
883           "Right Input Mux" },
884         { "Right Input Mode Mux", "Differential Line",
885           "Right Input Inverting Mux" },
886         { "Right Input Mode Mux", "Differential Mic",
887           "Right Input Mux" },
888         { "Right Input Mode Mux", "Differential Mic",
889           "Right Input Inverting Mux" },
890
891         { "Left Input PGA", NULL, "Left Input Mode Mux" },
892         { "Right Input PGA", NULL, "Right Input Mode Mux" },
893
894         { "ADCL", NULL, "Left Input PGA" },
895         { "ADCL", NULL, "CLK_DSP" },
896         { "ADCR", NULL, "Right Input PGA" },
897         { "ADCR", NULL, "CLK_DSP" },
898
899         { "DACL", NULL, "CLK_DSP" },
900         { "DACR", NULL, "CLK_DSP" },
901
902         { "Left Output Mixer", "Left Bypass Switch", "Left Input PGA" },
903         { "Left Output Mixer", "Right Bypass Switch", "Right Input PGA" },
904         { "Left Output Mixer", "DACL Switch", "DACL" },
905         { "Left Output Mixer", "DACR Switch", "DACR" },
906
907         { "Right Output Mixer", "Left Bypass Switch", "Left Input PGA" },
908         { "Right Output Mixer", "Right Bypass Switch", "Right Input PGA" },
909         { "Right Output Mixer", "DACL Switch", "DACL" },
910         { "Right Output Mixer", "DACR Switch", "DACR" },
911
912         { "Left Speaker Mixer", "Left Bypass Switch", "Left Input PGA" },
913         { "Left Speaker Mixer", "Right Bypass Switch", "Right Input PGA" },
914         { "Left Speaker Mixer", "DACL Switch", "DACL" },
915         { "Left Speaker Mixer", "DACR Switch", "DACR" },
916
917         { "Right Speaker Mixer", "Left Bypass Switch", "Left Input PGA" },
918         { "Right Speaker Mixer", "Right Bypass Switch", "Right Input PGA" },
919         { "Right Speaker Mixer", "DACL Switch", "DACL" },
920         { "Right Speaker Mixer", "DACR Switch", "DACR" },
921
922         { "Left Line Output PGA", NULL, "Left Output Mixer" },
923         { "Right Line Output PGA", NULL, "Right Output Mixer" },
924
925         { "Left Headphone Output PGA", NULL, "Left Output Mixer" },
926         { "Right Headphone Output PGA", NULL, "Right Output Mixer" },
927
928         { "Left Speaker PGA", NULL, "Left Speaker Mixer" },
929         { "Right Speaker PGA", NULL, "Right Speaker Mixer" },
930
931         { "HPOUTL", NULL, "Left Headphone Output PGA" },
932         { "HPOUTR", NULL, "Right Headphone Output PGA" },
933
934         { "LINEOUTL", NULL, "Left Line Output PGA" },
935         { "LINEOUTR", NULL, "Right Line Output PGA" },
936
937         { "LOP", NULL, "Left Speaker PGA" },
938         { "LON", NULL, "Left Speaker PGA" },
939
940         { "ROP", NULL, "Right Speaker PGA" },
941         { "RON", NULL, "Right Speaker PGA" },
942
943         { "Left Headphone Output PGA", NULL, "Charge Pump" },
944         { "Right Headphone Output PGA", NULL, "Charge Pump" },
945         { "Left Line Output PGA", NULL, "Charge Pump" },
946         { "Right Line Output PGA", NULL, "Charge Pump" },
947 };
948
949 static int wm8903_add_widgets(struct snd_soc_codec *codec)
950 {
951         snd_soc_dapm_new_controls(codec, wm8903_dapm_widgets,
952                                   ARRAY_SIZE(wm8903_dapm_widgets));
953
954         snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
955
956         snd_soc_dapm_new_widgets(codec);
957
958         return 0;
959 }
960
961 static int wm8903_set_bias_level(struct snd_soc_codec *codec,
962                                  enum snd_soc_bias_level level)
963 {
964         struct i2c_client *i2c = codec->control_data;
965         u16 reg, reg2;
966
967         switch (level) {
968         case SND_SOC_BIAS_ON:
969         case SND_SOC_BIAS_PREPARE:
970                 reg = wm8903_read(codec, WM8903_VMID_CONTROL_0);
971                 reg &= ~(WM8903_VMID_RES_MASK);
972                 reg |= WM8903_VMID_RES_50K;
973                 wm8903_write(codec, WM8903_VMID_CONTROL_0, reg);
974                 break;
975
976         case SND_SOC_BIAS_STANDBY:
977                 if (codec->bias_level == SND_SOC_BIAS_OFF) {
978                         wm8903_write(codec, WM8903_CLOCK_RATES_2,
979                                      WM8903_CLK_SYS_ENA);
980
981                         wm8903_run_sequence(codec, 0);
982                         wm8903_sync_reg_cache(codec, codec->reg_cache);
983
984                         /* Enable low impedence charge pump output */
985                         reg = wm8903_read(codec,
986                                           WM8903_CONTROL_INTERFACE_TEST_1);
987                         wm8903_write(codec, WM8903_CONTROL_INTERFACE_TEST_1,
988                                      reg | WM8903_TEST_KEY);
989                         reg2 = wm8903_read(codec, WM8903_CHARGE_PUMP_TEST_1);
990                         wm8903_write(codec, WM8903_CHARGE_PUMP_TEST_1,
991                                      reg2 | WM8903_CP_SW_KELVIN_MODE_MASK);
992                         wm8903_write(codec, WM8903_CONTROL_INTERFACE_TEST_1,
993                                      reg);
994
995                         /* By default no bypass paths are enabled so
996                          * enable Class W support.
997                          */
998                         dev_dbg(&i2c->dev, "Enabling Class W\n");
999                         wm8903_write(codec, WM8903_CLASS_W_0, reg |
1000                                      WM8903_CP_DYN_FREQ | WM8903_CP_DYN_V);
1001                 }
1002
1003                 reg = wm8903_read(codec, WM8903_VMID_CONTROL_0);
1004                 reg &= ~(WM8903_VMID_RES_MASK);
1005                 reg |= WM8903_VMID_RES_250K;
1006                 wm8903_write(codec, WM8903_VMID_CONTROL_0, reg);
1007                 break;
1008
1009         case SND_SOC_BIAS_OFF:
1010                 wm8903_run_sequence(codec, 32);
1011                 reg = wm8903_read(codec, WM8903_CLOCK_RATES_2);
1012                 reg &= ~WM8903_CLK_SYS_ENA;
1013                 wm8903_write(codec, WM8903_CLOCK_RATES_2, reg);
1014                 break;
1015         }
1016
1017         codec->bias_level = level;
1018
1019         return 0;
1020 }
1021
1022 static int wm8903_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1023                                  int clk_id, unsigned int freq, int dir)
1024 {
1025         struct snd_soc_codec *codec = codec_dai->codec;
1026         struct wm8903_priv *wm8903 = codec->private_data;
1027
1028         wm8903->sysclk = freq;
1029
1030         return 0;
1031 }
1032
1033 static int wm8903_set_dai_fmt(struct snd_soc_dai *codec_dai,
1034                               unsigned int fmt)
1035 {
1036         struct snd_soc_codec *codec = codec_dai->codec;
1037         u16 aif1 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_1);
1038
1039         aif1 &= ~(WM8903_LRCLK_DIR | WM8903_BCLK_DIR | WM8903_AIF_FMT_MASK |
1040                   WM8903_AIF_LRCLK_INV | WM8903_AIF_BCLK_INV);
1041
1042         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1043         case SND_SOC_DAIFMT_CBS_CFS:
1044                 break;
1045         case SND_SOC_DAIFMT_CBS_CFM:
1046                 aif1 |= WM8903_LRCLK_DIR;
1047                 break;
1048         case SND_SOC_DAIFMT_CBM_CFM:
1049                 aif1 |= WM8903_LRCLK_DIR | WM8903_BCLK_DIR;
1050                 break;
1051         case SND_SOC_DAIFMT_CBM_CFS:
1052                 aif1 |= WM8903_BCLK_DIR;
1053                 break;
1054         default:
1055                 return -EINVAL;
1056         }
1057
1058         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1059         case SND_SOC_DAIFMT_DSP_A:
1060                 aif1 |= 0x3;
1061                 break;
1062         case SND_SOC_DAIFMT_DSP_B:
1063                 aif1 |= 0x3 | WM8903_AIF_LRCLK_INV;
1064                 break;
1065         case SND_SOC_DAIFMT_I2S:
1066                 aif1 |= 0x2;
1067                 break;
1068         case SND_SOC_DAIFMT_RIGHT_J:
1069                 aif1 |= 0x1;
1070                 break;
1071         case SND_SOC_DAIFMT_LEFT_J:
1072                 break;
1073         default:
1074                 return -EINVAL;
1075         }
1076
1077         /* Clock inversion */
1078         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1079         case SND_SOC_DAIFMT_DSP_A:
1080         case SND_SOC_DAIFMT_DSP_B:
1081                 /* frame inversion not valid for DSP modes */
1082                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1083                 case SND_SOC_DAIFMT_NB_NF:
1084                         break;
1085                 case SND_SOC_DAIFMT_IB_NF:
1086                         aif1 |= WM8903_AIF_BCLK_INV;
1087                         break;
1088                 default:
1089                         return -EINVAL;
1090                 }
1091                 break;
1092         case SND_SOC_DAIFMT_I2S:
1093         case SND_SOC_DAIFMT_RIGHT_J:
1094         case SND_SOC_DAIFMT_LEFT_J:
1095                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1096                 case SND_SOC_DAIFMT_NB_NF:
1097                         break;
1098                 case SND_SOC_DAIFMT_IB_IF:
1099                         aif1 |= WM8903_AIF_BCLK_INV | WM8903_AIF_LRCLK_INV;
1100                         break;
1101                 case SND_SOC_DAIFMT_IB_NF:
1102                         aif1 |= WM8903_AIF_BCLK_INV;
1103                         break;
1104                 case SND_SOC_DAIFMT_NB_IF:
1105                         aif1 |= WM8903_AIF_LRCLK_INV;
1106                         break;
1107                 default:
1108                         return -EINVAL;
1109                 }
1110                 break;
1111         default:
1112                 return -EINVAL;
1113         }
1114
1115         wm8903_write(codec, WM8903_AUDIO_INTERFACE_1, aif1);
1116
1117         return 0;
1118 }
1119
1120 static int wm8903_digital_mute(struct snd_soc_dai *codec_dai, int mute)
1121 {
1122         struct snd_soc_codec *codec = codec_dai->codec;
1123         u16 reg;
1124
1125         reg = wm8903_read(codec, WM8903_DAC_DIGITAL_1);
1126
1127         if (mute)
1128                 reg |= WM8903_DAC_MUTE;
1129         else
1130                 reg &= ~WM8903_DAC_MUTE;
1131
1132         wm8903_write(codec, WM8903_DAC_DIGITAL_1, reg);
1133
1134         return 0;
1135 }
1136
1137 /* Lookup table for CLK_SYS/fs ratio.  256fs or more is recommended
1138  * for optimal performance so we list the lower rates first and match
1139  * on the last match we find. */
1140 static struct {
1141         int div;
1142         int rate;
1143         int mode;
1144         int mclk_div;
1145 } clk_sys_ratios[] = {
1146         {   64, 0x0, 0x0, 1 },
1147         {   68, 0x0, 0x1, 1 },
1148         {  125, 0x0, 0x2, 1 },
1149         {  128, 0x1, 0x0, 1 },
1150         {  136, 0x1, 0x1, 1 },
1151         {  192, 0x2, 0x0, 1 },
1152         {  204, 0x2, 0x1, 1 },
1153
1154         {   64, 0x0, 0x0, 2 },
1155         {   68, 0x0, 0x1, 2 },
1156         {  125, 0x0, 0x2, 2 },
1157         {  128, 0x1, 0x0, 2 },
1158         {  136, 0x1, 0x1, 2 },
1159         {  192, 0x2, 0x0, 2 },
1160         {  204, 0x2, 0x1, 2 },
1161
1162         {  250, 0x2, 0x2, 1 },
1163         {  256, 0x3, 0x0, 1 },
1164         {  272, 0x3, 0x1, 1 },
1165         {  384, 0x4, 0x0, 1 },
1166         {  408, 0x4, 0x1, 1 },
1167         {  375, 0x4, 0x2, 1 },
1168         {  512, 0x5, 0x0, 1 },
1169         {  544, 0x5, 0x1, 1 },
1170         {  500, 0x5, 0x2, 1 },
1171         {  768, 0x6, 0x0, 1 },
1172         {  816, 0x6, 0x1, 1 },
1173         {  750, 0x6, 0x2, 1 },
1174         { 1024, 0x7, 0x0, 1 },
1175         { 1088, 0x7, 0x1, 1 },
1176         { 1000, 0x7, 0x2, 1 },
1177         { 1408, 0x8, 0x0, 1 },
1178         { 1496, 0x8, 0x1, 1 },
1179         { 1536, 0x9, 0x0, 1 },
1180         { 1632, 0x9, 0x1, 1 },
1181         { 1500, 0x9, 0x2, 1 },
1182
1183         {  250, 0x2, 0x2, 2 },
1184         {  256, 0x3, 0x0, 2 },
1185         {  272, 0x3, 0x1, 2 },
1186         {  384, 0x4, 0x0, 2 },
1187         {  408, 0x4, 0x1, 2 },
1188         {  375, 0x4, 0x2, 2 },
1189         {  512, 0x5, 0x0, 2 },
1190         {  544, 0x5, 0x1, 2 },
1191         {  500, 0x5, 0x2, 2 },
1192         {  768, 0x6, 0x0, 2 },
1193         {  816, 0x6, 0x1, 2 },
1194         {  750, 0x6, 0x2, 2 },
1195         { 1024, 0x7, 0x0, 2 },
1196         { 1088, 0x7, 0x1, 2 },
1197         { 1000, 0x7, 0x2, 2 },
1198         { 1408, 0x8, 0x0, 2 },
1199         { 1496, 0x8, 0x1, 2 },
1200         { 1536, 0x9, 0x0, 2 },
1201         { 1632, 0x9, 0x1, 2 },
1202         { 1500, 0x9, 0x2, 2 },
1203 };
1204
1205 /* CLK_SYS/BCLK ratios - multiplied by 10 due to .5s */
1206 static struct {
1207         int ratio;
1208         int div;
1209 } bclk_divs[] = {
1210         {  10,  0 },
1211         {  15,  1 },
1212         {  20,  2 },
1213         {  30,  3 },
1214         {  40,  4 },
1215         {  50,  5 },
1216         {  55,  6 },
1217         {  60,  7 },
1218         {  80,  8 },
1219         { 100,  9 },
1220         { 110, 10 },
1221         { 120, 11 },
1222         { 160, 12 },
1223         { 200, 13 },
1224         { 220, 14 },
1225         { 240, 15 },
1226         { 250, 16 },
1227         { 300, 17 },
1228         { 320, 18 },
1229         { 440, 19 },
1230         { 480, 20 },
1231 };
1232
1233 /* Sample rates for DSP */
1234 static struct {
1235         int rate;
1236         int value;
1237 } sample_rates[] = {
1238         {  8000,  0 },
1239         { 11025,  1 },
1240         { 12000,  2 },
1241         { 16000,  3 },
1242         { 22050,  4 },
1243         { 24000,  5 },
1244         { 32000,  6 },
1245         { 44100,  7 },
1246         { 48000,  8 },
1247         { 88200,  9 },
1248         { 96000, 10 },
1249         { 0,      0 },
1250 };
1251
1252 static int wm8903_startup(struct snd_pcm_substream *substream,
1253                           struct snd_soc_dai *dai)
1254 {
1255         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1256         struct snd_soc_device *socdev = rtd->socdev;
1257         struct snd_soc_codec *codec = socdev->card->codec;
1258         struct wm8903_priv *wm8903 = codec->private_data;
1259         struct i2c_client *i2c = codec->control_data;
1260         struct snd_pcm_runtime *master_runtime;
1261
1262         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1263                 wm8903->playback_active++;
1264         else
1265                 wm8903->capture_active++;
1266
1267         /* The DAI has shared clocks so if we already have a playback or
1268          * capture going then constrain this substream to match it.
1269          */
1270         if (wm8903->master_substream) {
1271                 master_runtime = wm8903->master_substream->runtime;
1272
1273                 dev_dbg(&i2c->dev, "Constraining to %d bits at %dHz\n",
1274                         master_runtime->sample_bits,
1275                         master_runtime->rate);
1276
1277                 snd_pcm_hw_constraint_minmax(substream->runtime,
1278                                              SNDRV_PCM_HW_PARAM_RATE,
1279                                              master_runtime->rate,
1280                                              master_runtime->rate);
1281
1282                 snd_pcm_hw_constraint_minmax(substream->runtime,
1283                                              SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1284                                              master_runtime->sample_bits,
1285                                              master_runtime->sample_bits);
1286
1287                 wm8903->slave_substream = substream;
1288         } else
1289                 wm8903->master_substream = substream;
1290
1291         return 0;
1292 }
1293
1294 static void wm8903_shutdown(struct snd_pcm_substream *substream,
1295                             struct snd_soc_dai *dai)
1296 {
1297         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1298         struct snd_soc_device *socdev = rtd->socdev;
1299         struct snd_soc_codec *codec = socdev->card->codec;
1300         struct wm8903_priv *wm8903 = codec->private_data;
1301
1302         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1303                 wm8903->playback_active--;
1304         else
1305                 wm8903->capture_active--;
1306
1307         if (wm8903->master_substream == substream)
1308                 wm8903->master_substream = wm8903->slave_substream;
1309
1310         wm8903->slave_substream = NULL;
1311 }
1312
1313 static int wm8903_hw_params(struct snd_pcm_substream *substream,
1314                             struct snd_pcm_hw_params *params,
1315                             struct snd_soc_dai *dai)
1316 {
1317         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1318         struct snd_soc_device *socdev = rtd->socdev;
1319         struct snd_soc_codec *codec = socdev->card->codec;
1320         struct wm8903_priv *wm8903 = codec->private_data;
1321         struct i2c_client *i2c = codec->control_data;
1322         int fs = params_rate(params);
1323         int bclk;
1324         int bclk_div;
1325         int i;
1326         int dsp_config;
1327         int clk_config;
1328         int best_val;
1329         int cur_val;
1330         int clk_sys;
1331
1332         u16 aif1 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_1);
1333         u16 aif2 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_2);
1334         u16 aif3 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_3);
1335         u16 clock0 = wm8903_read(codec, WM8903_CLOCK_RATES_0);
1336         u16 clock1 = wm8903_read(codec, WM8903_CLOCK_RATES_1);
1337
1338         if (substream == wm8903->slave_substream) {
1339                 dev_dbg(&i2c->dev, "Ignoring hw_params for slave substream\n");
1340                 return 0;
1341         }
1342
1343         /* Configure sample rate logic for DSP - choose nearest rate */
1344         dsp_config = 0;
1345         best_val = abs(sample_rates[dsp_config].rate - fs);
1346         for (i = 1; i < ARRAY_SIZE(sample_rates); i++) {
1347                 cur_val = abs(sample_rates[i].rate - fs);
1348                 if (cur_val <= best_val) {
1349                         dsp_config = i;
1350                         best_val = cur_val;
1351                 }
1352         }
1353
1354         /* Constraints should stop us hitting this but let's make sure */
1355         if (wm8903->capture_active)
1356                 switch (sample_rates[dsp_config].rate) {
1357                 case 88200:
1358                 case 96000:
1359                         dev_err(&i2c->dev, "%dHz unsupported by ADC\n",
1360                                 fs);
1361                         return -EINVAL;
1362
1363                 default:
1364                         break;
1365                 }
1366
1367         dev_dbg(&i2c->dev, "DSP fs = %dHz\n", sample_rates[dsp_config].rate);
1368         clock1 &= ~WM8903_SAMPLE_RATE_MASK;
1369         clock1 |= sample_rates[dsp_config].value;
1370
1371         aif1 &= ~WM8903_AIF_WL_MASK;
1372         bclk = 2 * fs;
1373         switch (params_format(params)) {
1374         case SNDRV_PCM_FORMAT_S16_LE:
1375                 bclk *= 16;
1376                 break;
1377         case SNDRV_PCM_FORMAT_S20_3LE:
1378                 bclk *= 20;
1379                 aif1 |= 0x4;
1380                 break;
1381         case SNDRV_PCM_FORMAT_S24_LE:
1382                 bclk *= 24;
1383                 aif1 |= 0x8;
1384                 break;
1385         case SNDRV_PCM_FORMAT_S32_LE:
1386                 bclk *= 32;
1387                 aif1 |= 0xc;
1388                 break;
1389         default:
1390                 return -EINVAL;
1391         }
1392
1393         dev_dbg(&i2c->dev, "MCLK = %dHz, target sample rate = %dHz\n",
1394                 wm8903->sysclk, fs);
1395
1396         /* We may not have an MCLK which allows us to generate exactly
1397          * the clock we want, particularly with USB derived inputs, so
1398          * approximate.
1399          */
1400         clk_config = 0;
1401         best_val = abs((wm8903->sysclk /
1402                         (clk_sys_ratios[0].mclk_div *
1403                          clk_sys_ratios[0].div)) - fs);
1404         for (i = 1; i < ARRAY_SIZE(clk_sys_ratios); i++) {
1405                 cur_val = abs((wm8903->sysclk /
1406                                (clk_sys_ratios[i].mclk_div *
1407                                 clk_sys_ratios[i].div)) - fs);
1408
1409                 if (cur_val <= best_val) {
1410                         clk_config = i;
1411                         best_val = cur_val;
1412                 }
1413         }
1414
1415         if (clk_sys_ratios[clk_config].mclk_div == 2) {
1416                 clock0 |= WM8903_MCLKDIV2;
1417                 clk_sys = wm8903->sysclk / 2;
1418         } else {
1419                 clock0 &= ~WM8903_MCLKDIV2;
1420                 clk_sys = wm8903->sysclk;
1421         }
1422
1423         clock1 &= ~(WM8903_CLK_SYS_RATE_MASK |
1424                     WM8903_CLK_SYS_MODE_MASK);
1425         clock1 |= clk_sys_ratios[clk_config].rate << WM8903_CLK_SYS_RATE_SHIFT;
1426         clock1 |= clk_sys_ratios[clk_config].mode << WM8903_CLK_SYS_MODE_SHIFT;
1427
1428         dev_dbg(&i2c->dev, "CLK_SYS_RATE=%x, CLK_SYS_MODE=%x div=%d\n",
1429                 clk_sys_ratios[clk_config].rate,
1430                 clk_sys_ratios[clk_config].mode,
1431                 clk_sys_ratios[clk_config].div);
1432
1433         dev_dbg(&i2c->dev, "Actual CLK_SYS = %dHz\n", clk_sys);
1434
1435         /* We may not get quite the right frequency if using
1436          * approximate clocks so look for the closest match that is
1437          * higher than the target (we need to ensure that there enough
1438          * BCLKs to clock out the samples).
1439          */
1440         bclk_div = 0;
1441         best_val = ((clk_sys * 10) / bclk_divs[0].ratio) - bclk;
1442         i = 1;
1443         while (i < ARRAY_SIZE(bclk_divs)) {
1444                 cur_val = ((clk_sys * 10) / bclk_divs[i].ratio) - bclk;
1445                 if (cur_val < 0) /* BCLK table is sorted */
1446                         break;
1447                 bclk_div = i;
1448                 best_val = cur_val;
1449                 i++;
1450         }
1451
1452         aif2 &= ~WM8903_BCLK_DIV_MASK;
1453         aif3 &= ~WM8903_LRCLK_RATE_MASK;
1454
1455         dev_dbg(&i2c->dev, "BCLK ratio %d for %dHz - actual BCLK = %dHz\n",
1456                 bclk_divs[bclk_div].ratio / 10, bclk,
1457                 (clk_sys * 10) / bclk_divs[bclk_div].ratio);
1458
1459         aif2 |= bclk_divs[bclk_div].div;
1460         aif3 |= bclk / fs;
1461
1462         wm8903_write(codec, WM8903_CLOCK_RATES_0, clock0);
1463         wm8903_write(codec, WM8903_CLOCK_RATES_1, clock1);
1464         wm8903_write(codec, WM8903_AUDIO_INTERFACE_1, aif1);
1465         wm8903_write(codec, WM8903_AUDIO_INTERFACE_2, aif2);
1466         wm8903_write(codec, WM8903_AUDIO_INTERFACE_3, aif3);
1467
1468         return 0;
1469 }
1470
1471 #define WM8903_PLAYBACK_RATES (SNDRV_PCM_RATE_8000 |\
1472                                SNDRV_PCM_RATE_11025 |   \
1473                                SNDRV_PCM_RATE_16000 |   \
1474                                SNDRV_PCM_RATE_22050 |   \
1475                                SNDRV_PCM_RATE_32000 |   \
1476                                SNDRV_PCM_RATE_44100 |   \
1477                                SNDRV_PCM_RATE_48000 |   \
1478                                SNDRV_PCM_RATE_88200 |   \
1479                                SNDRV_PCM_RATE_96000)
1480
1481 #define WM8903_CAPTURE_RATES (SNDRV_PCM_RATE_8000 |\
1482                               SNDRV_PCM_RATE_11025 |    \
1483                               SNDRV_PCM_RATE_16000 |    \
1484                               SNDRV_PCM_RATE_22050 |    \
1485                               SNDRV_PCM_RATE_32000 |    \
1486                               SNDRV_PCM_RATE_44100 |    \
1487                               SNDRV_PCM_RATE_48000)
1488
1489 #define WM8903_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
1490                         SNDRV_PCM_FMTBIT_S20_3LE |\
1491                         SNDRV_PCM_FMTBIT_S24_LE)
1492
1493 static struct snd_soc_dai_ops wm8903_dai_ops = {
1494         .startup        = wm8903_startup,
1495         .shutdown       = wm8903_shutdown,
1496         .hw_params      = wm8903_hw_params,
1497         .digital_mute   = wm8903_digital_mute,
1498         .set_fmt        = wm8903_set_dai_fmt,
1499         .set_sysclk     = wm8903_set_dai_sysclk,
1500 };
1501
1502 struct snd_soc_dai wm8903_dai = {
1503         .name = "WM8903",
1504         .playback = {
1505                 .stream_name = "Playback",
1506                 .channels_min = 2,
1507                 .channels_max = 2,
1508                 .rates = WM8903_PLAYBACK_RATES,
1509                 .formats = WM8903_FORMATS,
1510         },
1511         .capture = {
1512                  .stream_name = "Capture",
1513                  .channels_min = 2,
1514                  .channels_max = 2,
1515                  .rates = WM8903_CAPTURE_RATES,
1516                  .formats = WM8903_FORMATS,
1517          },
1518         .ops = &wm8903_dai_ops,
1519         .symmetric_rates = 1,
1520 };
1521 EXPORT_SYMBOL_GPL(wm8903_dai);
1522
1523 static int wm8903_suspend(struct platform_device *pdev, pm_message_t state)
1524 {
1525         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1526         struct snd_soc_codec *codec = socdev->card->codec;
1527
1528         wm8903_set_bias_level(codec, SND_SOC_BIAS_OFF);
1529
1530         return 0;
1531 }
1532
1533 static int wm8903_resume(struct platform_device *pdev)
1534 {
1535         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1536         struct snd_soc_codec *codec = socdev->card->codec;
1537         struct i2c_client *i2c = codec->control_data;
1538         int i;
1539         u16 *reg_cache = codec->reg_cache;
1540         u16 *tmp_cache = kmemdup(codec->reg_cache, sizeof(wm8903_reg_defaults),
1541                                  GFP_KERNEL);
1542
1543         /* Bring the codec back up to standby first to minimise pop/clicks */
1544         wm8903_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1545         wm8903_set_bias_level(codec, codec->suspend_bias_level);
1546
1547         /* Sync back everything else */
1548         if (tmp_cache) {
1549                 for (i = 2; i < ARRAY_SIZE(wm8903_reg_defaults); i++)
1550                         if (tmp_cache[i] != reg_cache[i])
1551                                 wm8903_write(codec, i, tmp_cache[i]);
1552         } else {
1553                 dev_err(&i2c->dev, "Failed to allocate temporary cache\n");
1554         }
1555
1556         return 0;
1557 }
1558
1559 static struct snd_soc_codec *wm8903_codec;
1560
1561 static __devinit int wm8903_i2c_probe(struct i2c_client *i2c,
1562                                       const struct i2c_device_id *id)
1563 {
1564         struct wm8903_priv *wm8903;
1565         struct snd_soc_codec *codec;
1566         int ret;
1567         u16 val;
1568
1569         wm8903 = kzalloc(sizeof(struct wm8903_priv), GFP_KERNEL);
1570         if (wm8903 == NULL)
1571                 return -ENOMEM;
1572
1573         codec = &wm8903->codec;
1574
1575         mutex_init(&codec->mutex);
1576         INIT_LIST_HEAD(&codec->dapm_widgets);
1577         INIT_LIST_HEAD(&codec->dapm_paths);
1578
1579         codec->dev = &i2c->dev;
1580         codec->name = "WM8903";
1581         codec->owner = THIS_MODULE;
1582         codec->read = wm8903_read;
1583         codec->write = wm8903_write;
1584         codec->hw_write = (hw_write_t)i2c_master_send;
1585         codec->bias_level = SND_SOC_BIAS_OFF;
1586         codec->set_bias_level = wm8903_set_bias_level;
1587         codec->dai = &wm8903_dai;
1588         codec->num_dai = 1;
1589         codec->reg_cache_size = ARRAY_SIZE(wm8903->reg_cache);
1590         codec->reg_cache = &wm8903->reg_cache[0];
1591         codec->private_data = wm8903;
1592
1593         i2c_set_clientdata(i2c, codec);
1594         codec->control_data = i2c;
1595
1596         val = wm8903_hw_read(codec, WM8903_SW_RESET_AND_ID);
1597         if (val != wm8903_reg_defaults[WM8903_SW_RESET_AND_ID]) {
1598                 dev_err(&i2c->dev,
1599                         "Device with ID register %x is not a WM8903\n", val);
1600                 return -ENODEV;
1601         }
1602
1603         val = wm8903_read(codec, WM8903_REVISION_NUMBER);
1604         dev_info(&i2c->dev, "WM8903 revision %d\n",
1605                  val & WM8903_CHIP_REV_MASK);
1606
1607         wm8903_reset(codec);
1608
1609         /* power on device */
1610         wm8903_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1611
1612         /* Latch volume update bits */
1613         val = wm8903_read(codec, WM8903_ADC_DIGITAL_VOLUME_LEFT);
1614         val |= WM8903_ADCVU;
1615         wm8903_write(codec, WM8903_ADC_DIGITAL_VOLUME_LEFT, val);
1616         wm8903_write(codec, WM8903_ADC_DIGITAL_VOLUME_RIGHT, val);
1617
1618         val = wm8903_read(codec, WM8903_DAC_DIGITAL_VOLUME_LEFT);
1619         val |= WM8903_DACVU;
1620         wm8903_write(codec, WM8903_DAC_DIGITAL_VOLUME_LEFT, val);
1621         wm8903_write(codec, WM8903_DAC_DIGITAL_VOLUME_RIGHT, val);
1622
1623         val = wm8903_read(codec, WM8903_ANALOGUE_OUT1_LEFT);
1624         val |= WM8903_HPOUTVU;
1625         wm8903_write(codec, WM8903_ANALOGUE_OUT1_LEFT, val);
1626         wm8903_write(codec, WM8903_ANALOGUE_OUT1_RIGHT, val);
1627
1628         val = wm8903_read(codec, WM8903_ANALOGUE_OUT2_LEFT);
1629         val |= WM8903_LINEOUTVU;
1630         wm8903_write(codec, WM8903_ANALOGUE_OUT2_LEFT, val);
1631         wm8903_write(codec, WM8903_ANALOGUE_OUT2_RIGHT, val);
1632
1633         val = wm8903_read(codec, WM8903_ANALOGUE_OUT3_LEFT);
1634         val |= WM8903_SPKVU;
1635         wm8903_write(codec, WM8903_ANALOGUE_OUT3_LEFT, val);
1636         wm8903_write(codec, WM8903_ANALOGUE_OUT3_RIGHT, val);
1637
1638         /* Enable DAC soft mute by default */
1639         val = wm8903_read(codec, WM8903_DAC_DIGITAL_1);
1640         val |= WM8903_DAC_MUTEMODE;
1641         wm8903_write(codec, WM8903_DAC_DIGITAL_1, val);
1642
1643         wm8903_dai.dev = &i2c->dev;
1644         wm8903_codec = codec;
1645
1646         ret = snd_soc_register_codec(codec);
1647         if (ret != 0) {
1648                 dev_err(&i2c->dev, "Failed to register codec: %d\n", ret);
1649                 goto err;
1650         }
1651
1652         ret = snd_soc_register_dai(&wm8903_dai);
1653         if (ret != 0) {
1654                 dev_err(&i2c->dev, "Failed to register DAI: %d\n", ret);
1655                 goto err_codec;
1656         }
1657
1658         return ret;
1659
1660 err_codec:
1661         snd_soc_unregister_codec(codec);
1662 err:
1663         wm8903_codec = NULL;
1664         kfree(wm8903);
1665         return ret;
1666 }
1667
1668 static __devexit int wm8903_i2c_remove(struct i2c_client *client)
1669 {
1670         struct snd_soc_codec *codec = i2c_get_clientdata(client);
1671
1672         snd_soc_unregister_dai(&wm8903_dai);
1673         snd_soc_unregister_codec(codec);
1674
1675         wm8903_set_bias_level(codec, SND_SOC_BIAS_OFF);
1676
1677         kfree(codec->private_data);
1678
1679         wm8903_codec = NULL;
1680         wm8903_dai.dev = NULL;
1681
1682         return 0;
1683 }
1684
1685 /* i2c codec control layer */
1686 static const struct i2c_device_id wm8903_i2c_id[] = {
1687        { "wm8903", 0 },
1688        { }
1689 };
1690 MODULE_DEVICE_TABLE(i2c, wm8903_i2c_id);
1691
1692 static struct i2c_driver wm8903_i2c_driver = {
1693         .driver = {
1694                 .name = "WM8903",
1695                 .owner = THIS_MODULE,
1696         },
1697         .probe    = wm8903_i2c_probe,
1698         .remove   = __devexit_p(wm8903_i2c_remove),
1699         .id_table = wm8903_i2c_id,
1700 };
1701
1702 static int wm8903_probe(struct platform_device *pdev)
1703 {
1704         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1705         int ret = 0;
1706
1707         if (!wm8903_codec) {
1708                 dev_err(&pdev->dev, "I2C device not yet probed\n");
1709                 goto err;
1710         }
1711
1712         socdev->card->codec = wm8903_codec;
1713
1714         /* register pcms */
1715         ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
1716         if (ret < 0) {
1717                 dev_err(&pdev->dev, "failed to create pcms\n");
1718                 goto err;
1719         }
1720
1721         snd_soc_add_controls(socdev->card->codec, wm8903_snd_controls,
1722                                 ARRAY_SIZE(wm8903_snd_controls));
1723         wm8903_add_widgets(socdev->card->codec);
1724
1725         ret = snd_soc_init_card(socdev);
1726         if (ret < 0) {
1727                 dev_err(&pdev->dev, "wm8903: failed to register card\n");
1728                 goto card_err;
1729         }
1730
1731         return ret;
1732
1733 card_err:
1734         snd_soc_free_pcms(socdev);
1735         snd_soc_dapm_free(socdev);
1736 err:
1737         return ret;
1738 }
1739
1740 /* power down chip */
1741 static int wm8903_remove(struct platform_device *pdev)
1742 {
1743         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1744         struct snd_soc_codec *codec = socdev->card->codec;
1745
1746         if (codec->control_data)
1747                 wm8903_set_bias_level(codec, SND_SOC_BIAS_OFF);
1748
1749         snd_soc_free_pcms(socdev);
1750         snd_soc_dapm_free(socdev);
1751
1752         return 0;
1753 }
1754
1755 struct snd_soc_codec_device soc_codec_dev_wm8903 = {
1756         .probe =        wm8903_probe,
1757         .remove =       wm8903_remove,
1758         .suspend =      wm8903_suspend,
1759         .resume =       wm8903_resume,
1760 };
1761 EXPORT_SYMBOL_GPL(soc_codec_dev_wm8903);
1762
1763 static int __init wm8903_modinit(void)
1764 {
1765         return i2c_add_driver(&wm8903_i2c_driver);
1766 }
1767 module_init(wm8903_modinit);
1768
1769 static void __exit wm8903_exit(void)
1770 {
1771         i2c_del_driver(&wm8903_i2c_driver);
1772 }
1773 module_exit(wm8903_exit);
1774
1775 MODULE_DESCRIPTION("ASoC WM8903 driver");
1776 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.cm>");
1777 MODULE_LICENSE("GPL");