projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ASoC: Fix leaks in WM8988 registration error handling
[deliverable/linux.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 u16 dcs_reg;
396 u16 dcs_bit;
397 int shift;
398
399 switch (w->reg) {
400 case WM8903_POWER_MANAGEMENT_2:
401 reg = WM8903_ANALOGUE_HP_0;
402 dcs_bit = 0 + w->shift;
403 break;
404 case WM8903_POWER_MANAGEMENT_3:
405 reg = WM8903_ANALOGUE_LINEOUT_0;
406 dcs_bit = 2 + w->shift;
407 break;
408 default:
409 BUG();
410 return -EINVAL; /* Spurious warning from some compilers */
411 }
412
413 switch (w->shift) {
414 case 0:
415 shift = 0;
416 break;
417 case 1:
418 shift = 4;
419 break;
420 default:
421 BUG();
422 return -EINVAL; /* Spurious warning from some compilers */
423 }
424
425 if (event & SND_SOC_DAPM_PRE_PMU) {
426 val = wm8903_read(codec, reg);
427
428 /* Short the output */
429 val &= ~(WM8903_OUTPUT_SHORT << shift);
430 wm8903_write(codec, reg, val);
431 }
432
433 if (event & SND_SOC_DAPM_POST_PMU) {
434 val = wm8903_read(codec, reg);
435
436 val |= (WM8903_OUTPUT_IN << shift);
437 wm8903_write(codec, reg, val);
438
439 val |= (WM8903_OUTPUT_INT << shift);
440 wm8903_write(codec, reg, val);
441
442 /* Turn on the output ENA_OUTP */
443 val |= (WM8903_OUTPUT_OUT << shift);
444 wm8903_write(codec, reg, val);
445
446 /* Enable the DC servo */
447 dcs_reg = wm8903_read(codec, WM8903_DC_SERVO_0);
448 dcs_reg |= dcs_bit;
449 wm8903_write(codec, WM8903_DC_SERVO_0, dcs_reg);
450
451 /* Remove the short */
452 val |= (WM8903_OUTPUT_SHORT << shift);
453 wm8903_write(codec, reg, val);
454 }
455
456 if (event & SND_SOC_DAPM_PRE_PMD) {
457 val = wm8903_read(codec, reg);
458
459 /* Short the output */
460 val &= ~(WM8903_OUTPUT_SHORT << shift);
461 wm8903_write(codec, reg, val);
462
463 /* Disable the DC servo */
464 dcs_reg = wm8903_read(codec, WM8903_DC_SERVO_0);
465 dcs_reg &= ~dcs_bit;
466 wm8903_write(codec, WM8903_DC_SERVO_0, dcs_reg);
467
468 /* Then disable the intermediate and output stages */
469 val &= ~((WM8903_OUTPUT_OUT | WM8903_OUTPUT_INT |
470 WM8903_OUTPUT_IN) << shift);
471 wm8903_write(codec, reg, val);
472 }
473
474 return 0;
475 }
476
477 /*
478 * When used with DAC outputs only the WM8903 charge pump supports
479 * operation in class W mode, providing very low power consumption
480 * when used with digital sources. Enable and disable this mode
481 * automatically depending on the mixer configuration.
482 *
483 * All the relevant controls are simple switches.
484 */
485 static int wm8903_class_w_put(struct snd_kcontrol *kcontrol,
486 struct snd_ctl_elem_value *ucontrol)
487 {
488 struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
489 struct snd_soc_codec *codec = widget->codec;
490 struct wm8903_priv *wm8903 = codec->private_data;
491 struct i2c_client *i2c = codec->control_data;
492 u16 reg;
493 int ret;
494
495 reg = wm8903_read(codec, WM8903_CLASS_W_0);
496
497 /* Turn it off if we're about to enable bypass */
498 if (ucontrol->value.integer.value[0]) {
499 if (wm8903->class_w_users == 0) {
500 dev_dbg(&i2c->dev, "Disabling Class W\n");
501 wm8903_write(codec, WM8903_CLASS_W_0, reg &
502 ~(WM8903_CP_DYN_FREQ | WM8903_CP_DYN_V));
503 }
504 wm8903->class_w_users++;
505 }
506
507 /* Implement the change */
508 ret = snd_soc_dapm_put_volsw(kcontrol, ucontrol);
509
510 /* If we've just disabled the last bypass path turn Class W on */
511 if (!ucontrol->value.integer.value[0]) {
512 if (wm8903->class_w_users == 1) {
513 dev_dbg(&i2c->dev, "Enabling Class W\n");
514 wm8903_write(codec, WM8903_CLASS_W_0, reg |
515 WM8903_CP_DYN_FREQ | WM8903_CP_DYN_V);
516 }
517 wm8903->class_w_users--;
518 }
519
520 dev_dbg(&i2c->dev, "Bypass use count now %d\n",
521 wm8903->class_w_users);
522
523 return ret;
524 }
525
526 #define SOC_DAPM_SINGLE_W(xname, reg, shift, max, invert) \
527 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
528 .info = snd_soc_info_volsw, \
529 .get = snd_soc_dapm_get_volsw, .put = wm8903_class_w_put, \
530 .private_value = SOC_SINGLE_VALUE(reg, shift, max, invert) }
531
532
533 /* ALSA can only do steps of .01dB */
534 static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1);
535
536 static const DECLARE_TLV_DB_SCALE(digital_sidetone_tlv, -3600, 300, 0);
537 static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
538
539 static const DECLARE_TLV_DB_SCALE(drc_tlv_thresh, 0, 75, 0);
540 static const DECLARE_TLV_DB_SCALE(drc_tlv_amp, -2250, 75, 0);
541 static const DECLARE_TLV_DB_SCALE(drc_tlv_min, 0, 600, 0);
542 static const DECLARE_TLV_DB_SCALE(drc_tlv_max, 1200, 600, 0);
543 static const DECLARE_TLV_DB_SCALE(drc_tlv_startup, -300, 50, 0);
544
545 static const char *drc_slope_text[] = {
546 "1", "1/2", "1/4", "1/8", "1/16", "0"
547 };
548
549 static const struct soc_enum drc_slope_r0 =
550 SOC_ENUM_SINGLE(WM8903_DRC_2, 3, 6, drc_slope_text);
551
552 static const struct soc_enum drc_slope_r1 =
553 SOC_ENUM_SINGLE(WM8903_DRC_2, 0, 6, drc_slope_text);
554
555 static const char *drc_attack_text[] = {
556 "instantaneous",
557 "363us", "762us", "1.45ms", "2.9ms", "5.8ms", "11.6ms", "23.2ms",
558 "46.4ms", "92.8ms", "185.6ms"
559 };
560
561 static const struct soc_enum drc_attack =
562 SOC_ENUM_SINGLE(WM8903_DRC_1, 12, 11, drc_attack_text);
563
564 static const char *drc_decay_text[] = {
565 "186ms", "372ms", "743ms", "1.49s", "2.97s", "5.94s", "11.89s",
566 "23.87s", "47.56s"
567 };
568
569 static const struct soc_enum drc_decay =
570 SOC_ENUM_SINGLE(WM8903_DRC_1, 8, 9, drc_decay_text);
571
572 static const char *drc_ff_delay_text[] = {
573 "5 samples", "9 samples"
574 };
575
576 static const struct soc_enum drc_ff_delay =
577 SOC_ENUM_SINGLE(WM8903_DRC_0, 5, 2, drc_ff_delay_text);
578
579 static const char *drc_qr_decay_text[] = {
580 "0.725ms", "1.45ms", "5.8ms"
581 };
582
583 static const struct soc_enum drc_qr_decay =
584 SOC_ENUM_SINGLE(WM8903_DRC_1, 4, 3, drc_qr_decay_text);
585
586 static const char *drc_smoothing_text[] = {
587 "Low", "Medium", "High"
588 };
589
590 static const struct soc_enum drc_smoothing =
591 SOC_ENUM_SINGLE(WM8903_DRC_0, 11, 3, drc_smoothing_text);
592
593 static const char *soft_mute_text[] = {
594 "Fast (fs/2)", "Slow (fs/32)"
595 };
596
597 static const struct soc_enum soft_mute =
598 SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_1, 10, 2, soft_mute_text);
599
600 static const char *mute_mode_text[] = {
601 "Hard", "Soft"
602 };
603
604 static const struct soc_enum mute_mode =
605 SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_1, 9, 2, mute_mode_text);
606
607 static const char *dac_deemphasis_text[] = {
608 "Disabled", "32kHz", "44.1kHz", "48kHz"
609 };
610
611 static const struct soc_enum dac_deemphasis =
612 SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_1, 1, 4, dac_deemphasis_text);
613
614 static const char *companding_text[] = {
615 "ulaw", "alaw"
616 };
617
618 static const struct soc_enum dac_companding =
619 SOC_ENUM_SINGLE(WM8903_AUDIO_INTERFACE_0, 0, 2, companding_text);
620
621 static const struct soc_enum adc_companding =
622 SOC_ENUM_SINGLE(WM8903_AUDIO_INTERFACE_0, 2, 2, companding_text);
623
624 static const char *input_mode_text[] = {
625 "Single-Ended", "Differential Line", "Differential Mic"
626 };
627
628 static const struct soc_enum linput_mode_enum =
629 SOC_ENUM_SINGLE(WM8903_ANALOGUE_LEFT_INPUT_1, 0, 3, input_mode_text);
630
631 static const struct soc_enum rinput_mode_enum =
632 SOC_ENUM_SINGLE(WM8903_ANALOGUE_RIGHT_INPUT_1, 0, 3, input_mode_text);
633
634 static const char *linput_mux_text[] = {
635 "IN1L", "IN2L", "IN3L"
636 };
637
638 static const struct soc_enum linput_enum =
639 SOC_ENUM_SINGLE(WM8903_ANALOGUE_LEFT_INPUT_1, 2, 3, linput_mux_text);
640
641 static const struct soc_enum linput_inv_enum =
642 SOC_ENUM_SINGLE(WM8903_ANALOGUE_LEFT_INPUT_1, 4, 3, linput_mux_text);
643
644 static const char *rinput_mux_text[] = {
645 "IN1R", "IN2R", "IN3R"
646 };
647
648 static const struct soc_enum rinput_enum =
649 SOC_ENUM_SINGLE(WM8903_ANALOGUE_RIGHT_INPUT_1, 2, 3, rinput_mux_text);
650
651 static const struct soc_enum rinput_inv_enum =
652 SOC_ENUM_SINGLE(WM8903_ANALOGUE_RIGHT_INPUT_1, 4, 3, rinput_mux_text);
653
654
655 static const char *sidetone_text[] = {
656 "None", "Left", "Right"
657 };
658
659 static const struct soc_enum lsidetone_enum =
660 SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_0, 2, 3, sidetone_text);
661
662 static const struct soc_enum rsidetone_enum =
663 SOC_ENUM_SINGLE(WM8903_DAC_DIGITAL_0, 0, 3, sidetone_text);
664
665 static const struct snd_kcontrol_new wm8903_snd_controls[] = {
666
667 /* Input PGAs - No TLV since the scale depends on PGA mode */
668 SOC_SINGLE("Left Input PGA Switch", WM8903_ANALOGUE_LEFT_INPUT_0,
669 7, 1, 1),
670 SOC_SINGLE("Left Input PGA Volume", WM8903_ANALOGUE_LEFT_INPUT_0,
671 0, 31, 0),
672 SOC_SINGLE("Left Input PGA Common Mode Switch", WM8903_ANALOGUE_LEFT_INPUT_1,
673 6, 1, 0),
674
675 SOC_SINGLE("Right Input PGA Switch", WM8903_ANALOGUE_RIGHT_INPUT_0,
676 7, 1, 1),
677 SOC_SINGLE("Right Input PGA Volume", WM8903_ANALOGUE_RIGHT_INPUT_0,
678 0, 31, 0),
679 SOC_SINGLE("Right Input PGA Common Mode Switch", WM8903_ANALOGUE_RIGHT_INPUT_1,
680 6, 1, 0),
681
682 /* ADCs */
683 SOC_SINGLE("DRC Switch", WM8903_DRC_0, 15, 1, 0),
684 SOC_ENUM("DRC Compressor Slope R0", drc_slope_r0),
685 SOC_ENUM("DRC Compressor Slope R1", drc_slope_r1),
686 SOC_SINGLE_TLV("DRC Compressor Threashold Volume", WM8903_DRC_3, 5, 124, 1,
687 drc_tlv_thresh),
688 SOC_SINGLE_TLV("DRC Volume", WM8903_DRC_3, 0, 30, 1, drc_tlv_amp),
689 SOC_SINGLE_TLV("DRC Minimum Gain Volume", WM8903_DRC_1, 2, 3, 1, drc_tlv_min),
690 SOC_SINGLE_TLV("DRC Maximum Gain Volume", WM8903_DRC_1, 0, 3, 0, drc_tlv_max),
691 SOC_ENUM("DRC Attack Rate", drc_attack),
692 SOC_ENUM("DRC Decay Rate", drc_decay),
693 SOC_ENUM("DRC FF Delay", drc_ff_delay),
694 SOC_SINGLE("DRC Anticlip Switch", WM8903_DRC_0, 1, 1, 0),
695 SOC_SINGLE("DRC QR Switch", WM8903_DRC_0, 2, 1, 0),
696 SOC_SINGLE_TLV("DRC QR Threashold Volume", WM8903_DRC_0, 6, 3, 0, drc_tlv_max),
697 SOC_ENUM("DRC QR Decay Rate", drc_qr_decay),
698 SOC_SINGLE("DRC Smoothing Switch", WM8903_DRC_0, 3, 1, 0),
699 SOC_SINGLE("DRC Smoothing Hysteresis Switch", WM8903_DRC_0, 0, 1, 0),
700 SOC_ENUM("DRC Smoothing Threashold", drc_smoothing),
701 SOC_SINGLE_TLV("DRC Startup Volume", WM8903_DRC_0, 6, 18, 0, drc_tlv_startup),
702
703 SOC_DOUBLE_R_TLV("Digital Capture Volume", WM8903_ADC_DIGITAL_VOLUME_LEFT,
704 WM8903_ADC_DIGITAL_VOLUME_RIGHT, 1, 96, 0, digital_tlv),
705 SOC_ENUM("ADC Companding Mode", adc_companding),
706 SOC_SINGLE("ADC Companding Switch", WM8903_AUDIO_INTERFACE_0, 3, 1, 0),
707
708 SOC_DOUBLE_TLV("Digital Sidetone Volume", WM8903_DAC_DIGITAL_0, 4, 8,
709 12, 0, digital_sidetone_tlv),
710
711 /* DAC */
712 SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8903_DAC_DIGITAL_VOLUME_LEFT,
713 WM8903_DAC_DIGITAL_VOLUME_RIGHT, 1, 120, 0, digital_tlv),
714 SOC_ENUM("DAC Soft Mute Rate", soft_mute),
715 SOC_ENUM("DAC Mute Mode", mute_mode),
716 SOC_SINGLE("DAC Mono Switch", WM8903_DAC_DIGITAL_1, 12, 1, 0),
717 SOC_ENUM("DAC De-emphasis", dac_deemphasis),
718 SOC_ENUM("DAC Companding Mode", dac_companding),
719 SOC_SINGLE("DAC Companding Switch", WM8903_AUDIO_INTERFACE_0, 1, 1, 0),
720
721 /* Headphones */
722 SOC_DOUBLE_R("Headphone Switch",
723 WM8903_ANALOGUE_OUT1_LEFT, WM8903_ANALOGUE_OUT1_RIGHT,
724 8, 1, 1),
725 SOC_DOUBLE_R("Headphone ZC Switch",
726 WM8903_ANALOGUE_OUT1_LEFT, WM8903_ANALOGUE_OUT1_RIGHT,
727 6, 1, 0),
728 SOC_DOUBLE_R_TLV("Headphone Volume",
729 WM8903_ANALOGUE_OUT1_LEFT, WM8903_ANALOGUE_OUT1_RIGHT,
730 0, 63, 0, out_tlv),
731
732 /* Line out */
733 SOC_DOUBLE_R("Line Out Switch",
734 WM8903_ANALOGUE_OUT2_LEFT, WM8903_ANALOGUE_OUT2_RIGHT,
735 8, 1, 1),
736 SOC_DOUBLE_R("Line Out ZC Switch",
737 WM8903_ANALOGUE_OUT2_LEFT, WM8903_ANALOGUE_OUT2_RIGHT,
738 6, 1, 0),
739 SOC_DOUBLE_R_TLV("Line Out Volume",
740 WM8903_ANALOGUE_OUT2_LEFT, WM8903_ANALOGUE_OUT2_RIGHT,
741 0, 63, 0, out_tlv),
742
743 /* Speaker */
744 SOC_DOUBLE_R("Speaker Switch",
745 WM8903_ANALOGUE_OUT3_LEFT, WM8903_ANALOGUE_OUT3_RIGHT, 8, 1, 1),
746 SOC_DOUBLE_R("Speaker ZC Switch",
747 WM8903_ANALOGUE_OUT3_LEFT, WM8903_ANALOGUE_OUT3_RIGHT, 6, 1, 0),
748 SOC_DOUBLE_R_TLV("Speaker Volume",
749 WM8903_ANALOGUE_OUT3_LEFT, WM8903_ANALOGUE_OUT3_RIGHT,
750 0, 63, 0, out_tlv),
751 };
752
753 static const struct snd_kcontrol_new linput_mode_mux =
754 SOC_DAPM_ENUM("Left Input Mode Mux", linput_mode_enum);
755
756 static const struct snd_kcontrol_new rinput_mode_mux =
757 SOC_DAPM_ENUM("Right Input Mode Mux", rinput_mode_enum);
758
759 static const struct snd_kcontrol_new linput_mux =
760 SOC_DAPM_ENUM("Left Input Mux", linput_enum);
761
762 static const struct snd_kcontrol_new linput_inv_mux =
763 SOC_DAPM_ENUM("Left Inverting Input Mux", linput_inv_enum);
764
765 static const struct snd_kcontrol_new rinput_mux =
766 SOC_DAPM_ENUM("Right Input Mux", rinput_enum);
767
768 static const struct snd_kcontrol_new rinput_inv_mux =
769 SOC_DAPM_ENUM("Right Inverting Input Mux", rinput_inv_enum);
770
771 static const struct snd_kcontrol_new lsidetone_mux =
772 SOC_DAPM_ENUM("DACL Sidetone Mux", lsidetone_enum);
773
774 static const struct snd_kcontrol_new rsidetone_mux =
775 SOC_DAPM_ENUM("DACR Sidetone Mux", rsidetone_enum);
776
777 static const struct snd_kcontrol_new left_output_mixer[] = {
778 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_LEFT_MIX_0, 3, 1, 0),
779 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_LEFT_MIX_0, 2, 1, 0),
780 SOC_DAPM_SINGLE_W("Left Bypass Switch", WM8903_ANALOGUE_LEFT_MIX_0, 1, 1, 0),
781 SOC_DAPM_SINGLE_W("Right Bypass Switch", WM8903_ANALOGUE_LEFT_MIX_0, 0, 1, 0),
782 };
783
784 static const struct snd_kcontrol_new right_output_mixer[] = {
785 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 3, 1, 0),
786 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 2, 1, 0),
787 SOC_DAPM_SINGLE_W("Left Bypass Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 1, 1, 0),
788 SOC_DAPM_SINGLE_W("Right Bypass Switch", WM8903_ANALOGUE_RIGHT_MIX_0, 0, 1, 0),
789 };
790
791 static const struct snd_kcontrol_new left_speaker_mixer[] = {
792 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0, 3, 1, 0),
793 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0, 2, 1, 0),
794 SOC_DAPM_SINGLE("Left Bypass Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0, 1, 1, 0),
795 SOC_DAPM_SINGLE("Right Bypass Switch", WM8903_ANALOGUE_SPK_MIX_LEFT_0,
796 0, 1, 0),
797 };
798
799 static const struct snd_kcontrol_new right_speaker_mixer[] = {
800 SOC_DAPM_SINGLE("DACL Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0, 3, 1, 0),
801 SOC_DAPM_SINGLE("DACR Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0, 2, 1, 0),
802 SOC_DAPM_SINGLE("Left Bypass Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0,
803 1, 1, 0),
804 SOC_DAPM_SINGLE("Right Bypass Switch", WM8903_ANALOGUE_SPK_MIX_RIGHT_0,
805 0, 1, 0),
806 };
807
808 static const struct snd_soc_dapm_widget wm8903_dapm_widgets[] = {
809 SND_SOC_DAPM_INPUT("IN1L"),
810 SND_SOC_DAPM_INPUT("IN1R"),
811 SND_SOC_DAPM_INPUT("IN2L"),
812 SND_SOC_DAPM_INPUT("IN2R"),
813 SND_SOC_DAPM_INPUT("IN3L"),
814 SND_SOC_DAPM_INPUT("IN3R"),
815
816 SND_SOC_DAPM_OUTPUT("HPOUTL"),
817 SND_SOC_DAPM_OUTPUT("HPOUTR"),
818 SND_SOC_DAPM_OUTPUT("LINEOUTL"),
819 SND_SOC_DAPM_OUTPUT("LINEOUTR"),
820 SND_SOC_DAPM_OUTPUT("LOP"),
821 SND_SOC_DAPM_OUTPUT("LON"),
822 SND_SOC_DAPM_OUTPUT("ROP"),
823 SND_SOC_DAPM_OUTPUT("RON"),
824
825 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8903_MIC_BIAS_CONTROL_0, 0, 0),
826
827 SND_SOC_DAPM_MUX("Left Input Mux", SND_SOC_NOPM, 0, 0, &linput_mux),
828 SND_SOC_DAPM_MUX("Left Input Inverting Mux", SND_SOC_NOPM, 0, 0,
829 &linput_inv_mux),
830 SND_SOC_DAPM_MUX("Left Input Mode Mux", SND_SOC_NOPM, 0, 0, &linput_mode_mux),
831
832 SND_SOC_DAPM_MUX("Right Input Mux", SND_SOC_NOPM, 0, 0, &rinput_mux),
833 SND_SOC_DAPM_MUX("Right Input Inverting Mux", SND_SOC_NOPM, 0, 0,
834 &rinput_inv_mux),
835 SND_SOC_DAPM_MUX("Right Input Mode Mux", SND_SOC_NOPM, 0, 0, &rinput_mode_mux),
836
837 SND_SOC_DAPM_PGA("Left Input PGA", WM8903_POWER_MANAGEMENT_0, 1, 0, NULL, 0),
838 SND_SOC_DAPM_PGA("Right Input PGA", WM8903_POWER_MANAGEMENT_0, 0, 0, NULL, 0),
839
840 SND_SOC_DAPM_ADC("ADCL", "Left HiFi Capture", WM8903_POWER_MANAGEMENT_6, 1, 0),
841 SND_SOC_DAPM_ADC("ADCR", "Right HiFi Capture", WM8903_POWER_MANAGEMENT_6, 0, 0),
842
843 SND_SOC_DAPM_MUX("DACL Sidetone", SND_SOC_NOPM, 0, 0, &lsidetone_mux),
844 SND_SOC_DAPM_MUX("DACR Sidetone", SND_SOC_NOPM, 0, 0, &rsidetone_mux),
845
846 SND_SOC_DAPM_DAC("DACL", "Left Playback", WM8903_POWER_MANAGEMENT_6, 3, 0),
847 SND_SOC_DAPM_DAC("DACR", "Right Playback", WM8903_POWER_MANAGEMENT_6, 2, 0),
848
849 SND_SOC_DAPM_MIXER("Left Output Mixer", WM8903_POWER_MANAGEMENT_1, 1, 0,
850 left_output_mixer, ARRAY_SIZE(left_output_mixer)),
851 SND_SOC_DAPM_MIXER("Right Output Mixer", WM8903_POWER_MANAGEMENT_1, 0, 0,
852 right_output_mixer, ARRAY_SIZE(right_output_mixer)),
853
854 SND_SOC_DAPM_MIXER("Left Speaker Mixer", WM8903_POWER_MANAGEMENT_4, 1, 0,
855 left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer)),
856 SND_SOC_DAPM_MIXER("Right Speaker Mixer", WM8903_POWER_MANAGEMENT_4, 0, 0,
857 right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer)),
858
859 SND_SOC_DAPM_PGA_E("Left Headphone Output PGA", WM8903_POWER_MANAGEMENT_2,
860 1, 0, NULL, 0, wm8903_output_event,
861 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
862 SND_SOC_DAPM_PRE_PMD),
863 SND_SOC_DAPM_PGA_E("Right Headphone Output PGA", WM8903_POWER_MANAGEMENT_2,
864 0, 0, NULL, 0, wm8903_output_event,
865 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
866 SND_SOC_DAPM_PRE_PMD),
867
868 SND_SOC_DAPM_PGA_E("Left Line Output PGA", WM8903_POWER_MANAGEMENT_3, 1, 0,
869 NULL, 0, wm8903_output_event,
870 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
871 SND_SOC_DAPM_PRE_PMD),
872 SND_SOC_DAPM_PGA_E("Right Line Output PGA", WM8903_POWER_MANAGEMENT_3, 0, 0,
873 NULL, 0, wm8903_output_event,
874 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
875 SND_SOC_DAPM_PRE_PMD),
876
877 SND_SOC_DAPM_PGA("Left Speaker PGA", WM8903_POWER_MANAGEMENT_5, 1, 0,
878 NULL, 0),
879 SND_SOC_DAPM_PGA("Right Speaker PGA", WM8903_POWER_MANAGEMENT_5, 0, 0,
880 NULL, 0),
881
882 SND_SOC_DAPM_SUPPLY("Charge Pump", WM8903_CHARGE_PUMP_0, 0, 0,
883 wm8903_cp_event, SND_SOC_DAPM_POST_PMU),
884 SND_SOC_DAPM_SUPPLY("CLK_DSP", WM8903_CLOCK_RATES_2, 1, 0, NULL, 0),
885 };
886
887 static const struct snd_soc_dapm_route intercon[] = {
888
889 { "Left Input Mux", "IN1L", "IN1L" },
890 { "Left Input Mux", "IN2L", "IN2L" },
891 { "Left Input Mux", "IN3L", "IN3L" },
892
893 { "Left Input Inverting Mux", "IN1L", "IN1L" },
894 { "Left Input Inverting Mux", "IN2L", "IN2L" },
895 { "Left Input Inverting Mux", "IN3L", "IN3L" },
896
897 { "Right Input Mux", "IN1R", "IN1R" },
898 { "Right Input Mux", "IN2R", "IN2R" },
899 { "Right Input Mux", "IN3R", "IN3R" },
900
901 { "Right Input Inverting Mux", "IN1R", "IN1R" },
902 { "Right Input Inverting Mux", "IN2R", "IN2R" },
903 { "Right Input Inverting Mux", "IN3R", "IN3R" },
904
905 { "Left Input Mode Mux", "Single-Ended", "Left Input Inverting Mux" },
906 { "Left Input Mode Mux", "Differential Line",
907 "Left Input Mux" },
908 { "Left Input Mode Mux", "Differential Line",
909 "Left Input Inverting Mux" },
910 { "Left Input Mode Mux", "Differential Mic",
911 "Left Input Mux" },
912 { "Left Input Mode Mux", "Differential Mic",
913 "Left Input Inverting Mux" },
914
915 { "Right Input Mode Mux", "Single-Ended",
916 "Right Input Inverting Mux" },
917 { "Right Input Mode Mux", "Differential Line",
918 "Right Input Mux" },
919 { "Right Input Mode Mux", "Differential Line",
920 "Right Input Inverting Mux" },
921 { "Right Input Mode Mux", "Differential Mic",
922 "Right Input Mux" },
923 { "Right Input Mode Mux", "Differential Mic",
924 "Right Input Inverting Mux" },
925
926 { "Left Input PGA", NULL, "Left Input Mode Mux" },
927 { "Right Input PGA", NULL, "Right Input Mode Mux" },
928
929 { "ADCL", NULL, "Left Input PGA" },
930 { "ADCL", NULL, "CLK_DSP" },
931 { "ADCR", NULL, "Right Input PGA" },
932 { "ADCR", NULL, "CLK_DSP" },
933
934 { "DACL Sidetone", "Left", "ADCL" },
935 { "DACL Sidetone", "Right", "ADCR" },
936 { "DACR Sidetone", "Left", "ADCL" },
937 { "DACR Sidetone", "Right", "ADCR" },
938
939 { "DACL", NULL, "DACL Sidetone" },
940 { "DACL", NULL, "CLK_DSP" },
941 { "DACR", NULL, "DACR Sidetone" },
942 { "DACR", NULL, "CLK_DSP" },
943
944 { "Left Output Mixer", "Left Bypass Switch", "Left Input PGA" },
945 { "Left Output Mixer", "Right Bypass Switch", "Right Input PGA" },
946 { "Left Output Mixer", "DACL Switch", "DACL" },
947 { "Left Output Mixer", "DACR Switch", "DACR" },
948
949 { "Right Output Mixer", "Left Bypass Switch", "Left Input PGA" },
950 { "Right Output Mixer", "Right Bypass Switch", "Right Input PGA" },
951 { "Right Output Mixer", "DACL Switch", "DACL" },
952 { "Right Output Mixer", "DACR Switch", "DACR" },
953
954 { "Left Speaker Mixer", "Left Bypass Switch", "Left Input PGA" },
955 { "Left Speaker Mixer", "Right Bypass Switch", "Right Input PGA" },
956 { "Left Speaker Mixer", "DACL Switch", "DACL" },
957 { "Left Speaker Mixer", "DACR Switch", "DACR" },
958
959 { "Right Speaker Mixer", "Left Bypass Switch", "Left Input PGA" },
960 { "Right Speaker Mixer", "Right Bypass Switch", "Right Input PGA" },
961 { "Right Speaker Mixer", "DACL Switch", "DACL" },
962 { "Right Speaker Mixer", "DACR Switch", "DACR" },
963
964 { "Left Line Output PGA", NULL, "Left Output Mixer" },
965 { "Right Line Output PGA", NULL, "Right Output Mixer" },
966
967 { "Left Headphone Output PGA", NULL, "Left Output Mixer" },
968 { "Right Headphone Output PGA", NULL, "Right Output Mixer" },
969
970 { "Left Speaker PGA", NULL, "Left Speaker Mixer" },
971 { "Right Speaker PGA", NULL, "Right Speaker Mixer" },
972
973 { "HPOUTL", NULL, "Left Headphone Output PGA" },
974 { "HPOUTR", NULL, "Right Headphone Output PGA" },
975
976 { "LINEOUTL", NULL, "Left Line Output PGA" },
977 { "LINEOUTR", NULL, "Right Line Output PGA" },
978
979 { "LOP", NULL, "Left Speaker PGA" },
980 { "LON", NULL, "Left Speaker PGA" },
981
982 { "ROP", NULL, "Right Speaker PGA" },
983 { "RON", NULL, "Right Speaker PGA" },
984
985 { "Left Headphone Output PGA", NULL, "Charge Pump" },
986 { "Right Headphone Output PGA", NULL, "Charge Pump" },
987 { "Left Line Output PGA", NULL, "Charge Pump" },
988 { "Right Line Output PGA", NULL, "Charge Pump" },
989 };
990
991 static int wm8903_add_widgets(struct snd_soc_codec *codec)
992 {
993 snd_soc_dapm_new_controls(codec, wm8903_dapm_widgets,
994 ARRAY_SIZE(wm8903_dapm_widgets));
995
996 snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
997
998 snd_soc_dapm_new_widgets(codec);
999
1000 return 0;
1001 }
1002
1003 static int wm8903_set_bias_level(struct snd_soc_codec *codec,
1004 enum snd_soc_bias_level level)
1005 {
1006 struct i2c_client *i2c = codec->control_data;
1007 u16 reg, reg2;
1008
1009 switch (level) {
1010 case SND_SOC_BIAS_ON:
1011 case SND_SOC_BIAS_PREPARE:
1012 reg = wm8903_read(codec, WM8903_VMID_CONTROL_0);
1013 reg &= ~(WM8903_VMID_RES_MASK);
1014 reg |= WM8903_VMID_RES_50K;
1015 wm8903_write(codec, WM8903_VMID_CONTROL_0, reg);
1016 break;
1017
1018 case SND_SOC_BIAS_STANDBY:
1019 if (codec->bias_level == SND_SOC_BIAS_OFF) {
1020 wm8903_write(codec, WM8903_CLOCK_RATES_2,
1021 WM8903_CLK_SYS_ENA);
1022
1023 /* Change DC servo dither level in startup sequence */
1024 wm8903_write(codec, WM8903_WRITE_SEQUENCER_0, 0x11);
1025 wm8903_write(codec, WM8903_WRITE_SEQUENCER_1, 0x1257);
1026 wm8903_write(codec, WM8903_WRITE_SEQUENCER_2, 0x2);
1027
1028 wm8903_run_sequence(codec, 0);
1029 wm8903_sync_reg_cache(codec, codec->reg_cache);
1030
1031 /* Enable low impedence charge pump output */
1032 reg = wm8903_read(codec,
1033 WM8903_CONTROL_INTERFACE_TEST_1);
1034 wm8903_write(codec, WM8903_CONTROL_INTERFACE_TEST_1,
1035 reg | WM8903_TEST_KEY);
1036 reg2 = wm8903_read(codec, WM8903_CHARGE_PUMP_TEST_1);
1037 wm8903_write(codec, WM8903_CHARGE_PUMP_TEST_1,
1038 reg2 | WM8903_CP_SW_KELVIN_MODE_MASK);
1039 wm8903_write(codec, WM8903_CONTROL_INTERFACE_TEST_1,
1040 reg);
1041
1042 /* By default no bypass paths are enabled so
1043 * enable Class W support.
1044 */
1045 dev_dbg(&i2c->dev, "Enabling Class W\n");
1046 wm8903_write(codec, WM8903_CLASS_W_0, reg |
1047 WM8903_CP_DYN_FREQ | WM8903_CP_DYN_V);
1048 }
1049
1050 reg = wm8903_read(codec, WM8903_VMID_CONTROL_0);
1051 reg &= ~(WM8903_VMID_RES_MASK);
1052 reg |= WM8903_VMID_RES_250K;
1053 wm8903_write(codec, WM8903_VMID_CONTROL_0, reg);
1054 break;
1055
1056 case SND_SOC_BIAS_OFF:
1057 wm8903_run_sequence(codec, 32);
1058 reg = wm8903_read(codec, WM8903_CLOCK_RATES_2);
1059 reg &= ~WM8903_CLK_SYS_ENA;
1060 wm8903_write(codec, WM8903_CLOCK_RATES_2, reg);
1061 break;
1062 }
1063
1064 codec->bias_level = level;
1065
1066 return 0;
1067 }
1068
1069 static int wm8903_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1070 int clk_id, unsigned int freq, int dir)
1071 {
1072 struct snd_soc_codec *codec = codec_dai->codec;
1073 struct wm8903_priv *wm8903 = codec->private_data;
1074
1075 wm8903->sysclk = freq;
1076
1077 return 0;
1078 }
1079
1080 static int wm8903_set_dai_fmt(struct snd_soc_dai *codec_dai,
1081 unsigned int fmt)
1082 {
1083 struct snd_soc_codec *codec = codec_dai->codec;
1084 u16 aif1 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_1);
1085
1086 aif1 &= ~(WM8903_LRCLK_DIR | WM8903_BCLK_DIR | WM8903_AIF_FMT_MASK |
1087 WM8903_AIF_LRCLK_INV | WM8903_AIF_BCLK_INV);
1088
1089 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1090 case SND_SOC_DAIFMT_CBS_CFS:
1091 break;
1092 case SND_SOC_DAIFMT_CBS_CFM:
1093 aif1 |= WM8903_LRCLK_DIR;
1094 break;
1095 case SND_SOC_DAIFMT_CBM_CFM:
1096 aif1 |= WM8903_LRCLK_DIR | WM8903_BCLK_DIR;
1097 break;
1098 case SND_SOC_DAIFMT_CBM_CFS:
1099 aif1 |= WM8903_BCLK_DIR;
1100 break;
1101 default:
1102 return -EINVAL;
1103 }
1104
1105 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1106 case SND_SOC_DAIFMT_DSP_A:
1107 aif1 |= 0x3;
1108 break;
1109 case SND_SOC_DAIFMT_DSP_B:
1110 aif1 |= 0x3 | WM8903_AIF_LRCLK_INV;
1111 break;
1112 case SND_SOC_DAIFMT_I2S:
1113 aif1 |= 0x2;
1114 break;
1115 case SND_SOC_DAIFMT_RIGHT_J:
1116 aif1 |= 0x1;
1117 break;
1118 case SND_SOC_DAIFMT_LEFT_J:
1119 break;
1120 default:
1121 return -EINVAL;
1122 }
1123
1124 /* Clock inversion */
1125 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1126 case SND_SOC_DAIFMT_DSP_A:
1127 case SND_SOC_DAIFMT_DSP_B:
1128 /* frame inversion not valid for DSP modes */
1129 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1130 case SND_SOC_DAIFMT_NB_NF:
1131 break;
1132 case SND_SOC_DAIFMT_IB_NF:
1133 aif1 |= WM8903_AIF_BCLK_INV;
1134 break;
1135 default:
1136 return -EINVAL;
1137 }
1138 break;
1139 case SND_SOC_DAIFMT_I2S:
1140 case SND_SOC_DAIFMT_RIGHT_J:
1141 case SND_SOC_DAIFMT_LEFT_J:
1142 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1143 case SND_SOC_DAIFMT_NB_NF:
1144 break;
1145 case SND_SOC_DAIFMT_IB_IF:
1146 aif1 |= WM8903_AIF_BCLK_INV | WM8903_AIF_LRCLK_INV;
1147 break;
1148 case SND_SOC_DAIFMT_IB_NF:
1149 aif1 |= WM8903_AIF_BCLK_INV;
1150 break;
1151 case SND_SOC_DAIFMT_NB_IF:
1152 aif1 |= WM8903_AIF_LRCLK_INV;
1153 break;
1154 default:
1155 return -EINVAL;
1156 }
1157 break;
1158 default:
1159 return -EINVAL;
1160 }
1161
1162 wm8903_write(codec, WM8903_AUDIO_INTERFACE_1, aif1);
1163
1164 return 0;
1165 }
1166
1167 static int wm8903_digital_mute(struct snd_soc_dai *codec_dai, int mute)
1168 {
1169 struct snd_soc_codec *codec = codec_dai->codec;
1170 u16 reg;
1171
1172 reg = wm8903_read(codec, WM8903_DAC_DIGITAL_1);
1173
1174 if (mute)
1175 reg |= WM8903_DAC_MUTE;
1176 else
1177 reg &= ~WM8903_DAC_MUTE;
1178
1179 wm8903_write(codec, WM8903_DAC_DIGITAL_1, reg);
1180
1181 return 0;
1182 }
1183
1184 /* Lookup table for CLK_SYS/fs ratio. 256fs or more is recommended
1185 * for optimal performance so we list the lower rates first and match
1186 * on the last match we find. */
1187 static struct {
1188 int div;
1189 int rate;
1190 int mode;
1191 int mclk_div;
1192 } clk_sys_ratios[] = {
1193 { 64, 0x0, 0x0, 1 },
1194 { 68, 0x0, 0x1, 1 },
1195 { 125, 0x0, 0x2, 1 },
1196 { 128, 0x1, 0x0, 1 },
1197 { 136, 0x1, 0x1, 1 },
1198 { 192, 0x2, 0x0, 1 },
1199 { 204, 0x2, 0x1, 1 },
1200
1201 { 64, 0x0, 0x0, 2 },
1202 { 68, 0x0, 0x1, 2 },
1203 { 125, 0x0, 0x2, 2 },
1204 { 128, 0x1, 0x0, 2 },
1205 { 136, 0x1, 0x1, 2 },
1206 { 192, 0x2, 0x0, 2 },
1207 { 204, 0x2, 0x1, 2 },
1208
1209 { 250, 0x2, 0x2, 1 },
1210 { 256, 0x3, 0x0, 1 },
1211 { 272, 0x3, 0x1, 1 },
1212 { 384, 0x4, 0x0, 1 },
1213 { 408, 0x4, 0x1, 1 },
1214 { 375, 0x4, 0x2, 1 },
1215 { 512, 0x5, 0x0, 1 },
1216 { 544, 0x5, 0x1, 1 },
1217 { 500, 0x5, 0x2, 1 },
1218 { 768, 0x6, 0x0, 1 },
1219 { 816, 0x6, 0x1, 1 },
1220 { 750, 0x6, 0x2, 1 },
1221 { 1024, 0x7, 0x0, 1 },
1222 { 1088, 0x7, 0x1, 1 },
1223 { 1000, 0x7, 0x2, 1 },
1224 { 1408, 0x8, 0x0, 1 },
1225 { 1496, 0x8, 0x1, 1 },
1226 { 1536, 0x9, 0x0, 1 },
1227 { 1632, 0x9, 0x1, 1 },
1228 { 1500, 0x9, 0x2, 1 },
1229
1230 { 250, 0x2, 0x2, 2 },
1231 { 256, 0x3, 0x0, 2 },
1232 { 272, 0x3, 0x1, 2 },
1233 { 384, 0x4, 0x0, 2 },
1234 { 408, 0x4, 0x1, 2 },
1235 { 375, 0x4, 0x2, 2 },
1236 { 512, 0x5, 0x0, 2 },
1237 { 544, 0x5, 0x1, 2 },
1238 { 500, 0x5, 0x2, 2 },
1239 { 768, 0x6, 0x0, 2 },
1240 { 816, 0x6, 0x1, 2 },
1241 { 750, 0x6, 0x2, 2 },
1242 { 1024, 0x7, 0x0, 2 },
1243 { 1088, 0x7, 0x1, 2 },
1244 { 1000, 0x7, 0x2, 2 },
1245 { 1408, 0x8, 0x0, 2 },
1246 { 1496, 0x8, 0x1, 2 },
1247 { 1536, 0x9, 0x0, 2 },
1248 { 1632, 0x9, 0x1, 2 },
1249 { 1500, 0x9, 0x2, 2 },
1250 };
1251
1252 /* CLK_SYS/BCLK ratios - multiplied by 10 due to .5s */
1253 static struct {
1254 int ratio;
1255 int div;
1256 } bclk_divs[] = {
1257 { 10, 0 },
1258 { 20, 2 },
1259 { 30, 3 },
1260 { 40, 4 },
1261 { 50, 5 },
1262 { 60, 7 },
1263 { 80, 8 },
1264 { 100, 9 },
1265 { 120, 11 },
1266 { 160, 12 },
1267 { 200, 13 },
1268 { 220, 14 },
1269 { 240, 15 },
1270 { 300, 17 },
1271 { 320, 18 },
1272 { 440, 19 },
1273 { 480, 20 },
1274 };
1275
1276 /* Sample rates for DSP */
1277 static struct {
1278 int rate;
1279 int value;
1280 } sample_rates[] = {
1281 { 8000, 0 },
1282 { 11025, 1 },
1283 { 12000, 2 },
1284 { 16000, 3 },
1285 { 22050, 4 },
1286 { 24000, 5 },
1287 { 32000, 6 },
1288 { 44100, 7 },
1289 { 48000, 8 },
1290 { 88200, 9 },
1291 { 96000, 10 },
1292 { 0, 0 },
1293 };
1294
1295 static int wm8903_startup(struct snd_pcm_substream *substream,
1296 struct snd_soc_dai *dai)
1297 {
1298 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1299 struct snd_soc_device *socdev = rtd->socdev;
1300 struct snd_soc_codec *codec = socdev->card->codec;
1301 struct wm8903_priv *wm8903 = codec->private_data;
1302 struct i2c_client *i2c = codec->control_data;
1303 struct snd_pcm_runtime *master_runtime;
1304
1305 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1306 wm8903->playback_active++;
1307 else
1308 wm8903->capture_active++;
1309
1310 /* The DAI has shared clocks so if we already have a playback or
1311 * capture going then constrain this substream to match it.
1312 */
1313 if (wm8903->master_substream) {
1314 master_runtime = wm8903->master_substream->runtime;
1315
1316 dev_dbg(&i2c->dev, "Constraining to %d bits\n",
1317 master_runtime->sample_bits);
1318
1319 snd_pcm_hw_constraint_minmax(substream->runtime,
1320 SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1321 master_runtime->sample_bits,
1322 master_runtime->sample_bits);
1323
1324 wm8903->slave_substream = substream;
1325 } else
1326 wm8903->master_substream = substream;
1327
1328 return 0;
1329 }
1330
1331 static void wm8903_shutdown(struct snd_pcm_substream *substream,
1332 struct snd_soc_dai *dai)
1333 {
1334 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1335 struct snd_soc_device *socdev = rtd->socdev;
1336 struct snd_soc_codec *codec = socdev->card->codec;
1337 struct wm8903_priv *wm8903 = codec->private_data;
1338
1339 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1340 wm8903->playback_active--;
1341 else
1342 wm8903->capture_active--;
1343
1344 if (wm8903->master_substream == substream)
1345 wm8903->master_substream = wm8903->slave_substream;
1346
1347 wm8903->slave_substream = NULL;
1348 }
1349
1350 static int wm8903_hw_params(struct snd_pcm_substream *substream,
1351 struct snd_pcm_hw_params *params,
1352 struct snd_soc_dai *dai)
1353 {
1354 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1355 struct snd_soc_device *socdev = rtd->socdev;
1356 struct snd_soc_codec *codec = socdev->card->codec;
1357 struct wm8903_priv *wm8903 = codec->private_data;
1358 struct i2c_client *i2c = codec->control_data;
1359 int fs = params_rate(params);
1360 int bclk;
1361 int bclk_div;
1362 int i;
1363 int dsp_config;
1364 int clk_config;
1365 int best_val;
1366 int cur_val;
1367 int clk_sys;
1368
1369 u16 aif1 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_1);
1370 u16 aif2 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_2);
1371 u16 aif3 = wm8903_read(codec, WM8903_AUDIO_INTERFACE_3);
1372 u16 clock0 = wm8903_read(codec, WM8903_CLOCK_RATES_0);
1373 u16 clock1 = wm8903_read(codec, WM8903_CLOCK_RATES_1);
1374 u16 dac_digital1 = wm8903_read(codec, WM8903_DAC_DIGITAL_1);
1375
1376 if (substream == wm8903->slave_substream) {
1377 dev_dbg(&i2c->dev, "Ignoring hw_params for slave substream\n");
1378 return 0;
1379 }
1380
1381 /* Enable sloping stopband filter for low sample rates */
1382 if (fs <= 24000)
1383 dac_digital1 |= WM8903_DAC_SB_FILT;
1384 else
1385 dac_digital1 &= ~WM8903_DAC_SB_FILT;
1386
1387 /* Configure sample rate logic for DSP - choose nearest rate */
1388 dsp_config = 0;
1389 best_val = abs(sample_rates[dsp_config].rate - fs);
1390 for (i = 1; i < ARRAY_SIZE(sample_rates); i++) {
1391 cur_val = abs(sample_rates[i].rate - fs);
1392 if (cur_val <= best_val) {
1393 dsp_config = i;
1394 best_val = cur_val;
1395 }
1396 }
1397
1398 /* Constraints should stop us hitting this but let's make sure */
1399 if (wm8903->capture_active)
1400 switch (sample_rates[dsp_config].rate) {
1401 case 88200:
1402 case 96000:
1403 dev_err(&i2c->dev, "%dHz unsupported by ADC\n",
1404 fs);
1405 return -EINVAL;
1406
1407 default:
1408 break;
1409 }
1410
1411 dev_dbg(&i2c->dev, "DSP fs = %dHz\n", sample_rates[dsp_config].rate);
1412 clock1 &= ~WM8903_SAMPLE_RATE_MASK;
1413 clock1 |= sample_rates[dsp_config].value;
1414
1415 aif1 &= ~WM8903_AIF_WL_MASK;
1416 bclk = 2 * fs;
1417 switch (params_format(params)) {
1418 case SNDRV_PCM_FORMAT_S16_LE:
1419 bclk *= 16;
1420 break;
1421 case SNDRV_PCM_FORMAT_S20_3LE:
1422 bclk *= 20;
1423 aif1 |= 0x4;
1424 break;
1425 case SNDRV_PCM_FORMAT_S24_LE:
1426 bclk *= 24;
1427 aif1 |= 0x8;
1428 break;
1429 case SNDRV_PCM_FORMAT_S32_LE:
1430 bclk *= 32;
1431 aif1 |= 0xc;
1432 break;
1433 default:
1434 return -EINVAL;
1435 }
1436
1437 dev_dbg(&i2c->dev, "MCLK = %dHz, target sample rate = %dHz\n",
1438 wm8903->sysclk, fs);
1439
1440 /* We may not have an MCLK which allows us to generate exactly
1441 * the clock we want, particularly with USB derived inputs, so
1442 * approximate.
1443 */
1444 clk_config = 0;
1445 best_val = abs((wm8903->sysclk /
1446 (clk_sys_ratios[0].mclk_div *
1447 clk_sys_ratios[0].div)) - fs);
1448 for (i = 1; i < ARRAY_SIZE(clk_sys_ratios); i++) {
1449 cur_val = abs((wm8903->sysclk /
1450 (clk_sys_ratios[i].mclk_div *
1451 clk_sys_ratios[i].div)) - fs);
1452
1453 if (cur_val <= best_val) {
1454 clk_config = i;
1455 best_val = cur_val;
1456 }
1457 }
1458
1459 if (clk_sys_ratios[clk_config].mclk_div == 2) {
1460 clock0 |= WM8903_MCLKDIV2;
1461 clk_sys = wm8903->sysclk / 2;
1462 } else {
1463 clock0 &= ~WM8903_MCLKDIV2;
1464 clk_sys = wm8903->sysclk;
1465 }
1466
1467 clock1 &= ~(WM8903_CLK_SYS_RATE_MASK |
1468 WM8903_CLK_SYS_MODE_MASK);
1469 clock1 |= clk_sys_ratios[clk_config].rate << WM8903_CLK_SYS_RATE_SHIFT;
1470 clock1 |= clk_sys_ratios[clk_config].mode << WM8903_CLK_SYS_MODE_SHIFT;
1471
1472 dev_dbg(&i2c->dev, "CLK_SYS_RATE=%x, CLK_SYS_MODE=%x div=%d\n",
1473 clk_sys_ratios[clk_config].rate,
1474 clk_sys_ratios[clk_config].mode,
1475 clk_sys_ratios[clk_config].div);
1476
1477 dev_dbg(&i2c->dev, "Actual CLK_SYS = %dHz\n", clk_sys);
1478
1479 /* We may not get quite the right frequency if using
1480 * approximate clocks so look for the closest match that is
1481 * higher than the target (we need to ensure that there enough
1482 * BCLKs to clock out the samples).
1483 */
1484 bclk_div = 0;
1485 best_val = ((clk_sys * 10) / bclk_divs[0].ratio) - bclk;
1486 i = 1;
1487 while (i < ARRAY_SIZE(bclk_divs)) {
1488 cur_val = ((clk_sys * 10) / bclk_divs[i].ratio) - bclk;
1489 if (cur_val < 0) /* BCLK table is sorted */
1490 break;
1491 bclk_div = i;
1492 best_val = cur_val;
1493 i++;
1494 }
1495
1496 aif2 &= ~WM8903_BCLK_DIV_MASK;
1497 aif3 &= ~WM8903_LRCLK_RATE_MASK;
1498
1499 dev_dbg(&i2c->dev, "BCLK ratio %d for %dHz - actual BCLK = %dHz\n",
1500 bclk_divs[bclk_div].ratio / 10, bclk,
1501 (clk_sys * 10) / bclk_divs[bclk_div].ratio);
1502
1503 aif2 |= bclk_divs[bclk_div].div;
1504 aif3 |= bclk / fs;
1505
1506 wm8903_write(codec, WM8903_CLOCK_RATES_0, clock0);
1507 wm8903_write(codec, WM8903_CLOCK_RATES_1, clock1);
1508 wm8903_write(codec, WM8903_AUDIO_INTERFACE_1, aif1);
1509 wm8903_write(codec, WM8903_AUDIO_INTERFACE_2, aif2);
1510 wm8903_write(codec, WM8903_AUDIO_INTERFACE_3, aif3);
1511 wm8903_write(codec, WM8903_DAC_DIGITAL_1, dac_digital1);
1512
1513 return 0;
1514 }
1515
1516 #define WM8903_PLAYBACK_RATES (SNDRV_PCM_RATE_8000 |\
1517 SNDRV_PCM_RATE_11025 | \
1518 SNDRV_PCM_RATE_16000 | \
1519 SNDRV_PCM_RATE_22050 | \
1520 SNDRV_PCM_RATE_32000 | \
1521 SNDRV_PCM_RATE_44100 | \
1522 SNDRV_PCM_RATE_48000 | \
1523 SNDRV_PCM_RATE_88200 | \
1524 SNDRV_PCM_RATE_96000)
1525
1526 #define WM8903_CAPTURE_RATES (SNDRV_PCM_RATE_8000 |\
1527 SNDRV_PCM_RATE_11025 | \
1528 SNDRV_PCM_RATE_16000 | \
1529 SNDRV_PCM_RATE_22050 | \
1530 SNDRV_PCM_RATE_32000 | \
1531 SNDRV_PCM_RATE_44100 | \
1532 SNDRV_PCM_RATE_48000)
1533
1534 #define WM8903_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
1535 SNDRV_PCM_FMTBIT_S20_3LE |\
1536 SNDRV_PCM_FMTBIT_S24_LE)
1537
1538 static struct snd_soc_dai_ops wm8903_dai_ops = {
1539 .startup = wm8903_startup,
1540 .shutdown = wm8903_shutdown,
1541 .hw_params = wm8903_hw_params,
1542 .digital_mute = wm8903_digital_mute,
1543 .set_fmt = wm8903_set_dai_fmt,
1544 .set_sysclk = wm8903_set_dai_sysclk,
1545 };
1546
1547 struct snd_soc_dai wm8903_dai = {
1548 .name = "WM8903",
1549 .playback = {
1550 .stream_name = "Playback",
1551 .channels_min = 2,
1552 .channels_max = 2,
1553 .rates = WM8903_PLAYBACK_RATES,
1554 .formats = WM8903_FORMATS,
1555 },
1556 .capture = {
1557 .stream_name = "Capture",
1558 .channels_min = 2,
1559 .channels_max = 2,
1560 .rates = WM8903_CAPTURE_RATES,
1561 .formats = WM8903_FORMATS,
1562 },
1563 .ops = &wm8903_dai_ops,
1564 .symmetric_rates = 1,
1565 };
1566 EXPORT_SYMBOL_GPL(wm8903_dai);
1567
1568 static int wm8903_suspend(struct platform_device *pdev, pm_message_t state)
1569 {
1570 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1571 struct snd_soc_codec *codec = socdev->card->codec;
1572
1573 wm8903_set_bias_level(codec, SND_SOC_BIAS_OFF);
1574
1575 return 0;
1576 }
1577
1578 static int wm8903_resume(struct platform_device *pdev)
1579 {
1580 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1581 struct snd_soc_codec *codec = socdev->card->codec;
1582 struct i2c_client *i2c = codec->control_data;
1583 int i;
1584 u16 *reg_cache = codec->reg_cache;
1585 u16 *tmp_cache = kmemdup(codec->reg_cache, sizeof(wm8903_reg_defaults),
1586 GFP_KERNEL);
1587
1588 /* Bring the codec back up to standby first to minimise pop/clicks */
1589 wm8903_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1590 wm8903_set_bias_level(codec, codec->suspend_bias_level);
1591
1592 /* Sync back everything else */
1593 if (tmp_cache) {
1594 for (i = 2; i < ARRAY_SIZE(wm8903_reg_defaults); i++)
1595 if (tmp_cache[i] != reg_cache[i])
1596 wm8903_write(codec, i, tmp_cache[i]);
1597 } else {
1598 dev_err(&i2c->dev, "Failed to allocate temporary cache\n");
1599 }
1600
1601 return 0;
1602 }
1603
1604 static struct snd_soc_codec *wm8903_codec;
1605
1606 static __devinit int wm8903_i2c_probe(struct i2c_client *i2c,
1607 const struct i2c_device_id *id)
1608 {
1609 struct wm8903_priv *wm8903;
1610 struct snd_soc_codec *codec;
1611 int ret;
1612 u16 val;
1613
1614 wm8903 = kzalloc(sizeof(struct wm8903_priv), GFP_KERNEL);
1615 if (wm8903 == NULL)
1616 return -ENOMEM;
1617
1618 codec = &wm8903->codec;
1619
1620 mutex_init(&codec->mutex);
1621 INIT_LIST_HEAD(&codec->dapm_widgets);
1622 INIT_LIST_HEAD(&codec->dapm_paths);
1623
1624 codec->dev = &i2c->dev;
1625 codec->name = "WM8903";
1626 codec->owner = THIS_MODULE;
1627 codec->read = wm8903_read;
1628 codec->write = wm8903_write;
1629 codec->hw_write = (hw_write_t)i2c_master_send;
1630 codec->bias_level = SND_SOC_BIAS_OFF;
1631 codec->set_bias_level = wm8903_set_bias_level;
1632 codec->dai = &wm8903_dai;
1633 codec->num_dai = 1;
1634 codec->reg_cache_size = ARRAY_SIZE(wm8903->reg_cache);
1635 codec->reg_cache = &wm8903->reg_cache[0];
1636 codec->private_data = wm8903;
1637
1638 i2c_set_clientdata(i2c, codec);
1639 codec->control_data = i2c;
1640
1641 val = wm8903_hw_read(codec, WM8903_SW_RESET_AND_ID);
1642 if (val != wm8903_reg_defaults[WM8903_SW_RESET_AND_ID]) {
1643 dev_err(&i2c->dev,
1644 "Device with ID register %x is not a WM8903\n", val);
1645 return -ENODEV;
1646 }
1647
1648 val = wm8903_read(codec, WM8903_REVISION_NUMBER);
1649 dev_info(&i2c->dev, "WM8903 revision %d\n",
1650 val & WM8903_CHIP_REV_MASK);
1651
1652 wm8903_reset(codec);
1653
1654 /* power on device */
1655 wm8903_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1656
1657 /* Latch volume update bits */
1658 val = wm8903_read(codec, WM8903_ADC_DIGITAL_VOLUME_LEFT);
1659 val |= WM8903_ADCVU;
1660 wm8903_write(codec, WM8903_ADC_DIGITAL_VOLUME_LEFT, val);
1661 wm8903_write(codec, WM8903_ADC_DIGITAL_VOLUME_RIGHT, val);
1662
1663 val = wm8903_read(codec, WM8903_DAC_DIGITAL_VOLUME_LEFT);
1664 val |= WM8903_DACVU;
1665 wm8903_write(codec, WM8903_DAC_DIGITAL_VOLUME_LEFT, val);
1666 wm8903_write(codec, WM8903_DAC_DIGITAL_VOLUME_RIGHT, val);
1667
1668 val = wm8903_read(codec, WM8903_ANALOGUE_OUT1_LEFT);
1669 val |= WM8903_HPOUTVU;
1670 wm8903_write(codec, WM8903_ANALOGUE_OUT1_LEFT, val);
1671 wm8903_write(codec, WM8903_ANALOGUE_OUT1_RIGHT, val);
1672
1673 val = wm8903_read(codec, WM8903_ANALOGUE_OUT2_LEFT);
1674 val |= WM8903_LINEOUTVU;
1675 wm8903_write(codec, WM8903_ANALOGUE_OUT2_LEFT, val);
1676 wm8903_write(codec, WM8903_ANALOGUE_OUT2_RIGHT, val);
1677
1678 val = wm8903_read(codec, WM8903_ANALOGUE_OUT3_LEFT);
1679 val |= WM8903_SPKVU;
1680 wm8903_write(codec, WM8903_ANALOGUE_OUT3_LEFT, val);
1681 wm8903_write(codec, WM8903_ANALOGUE_OUT3_RIGHT, val);
1682
1683 /* Enable DAC soft mute by default */
1684 val = wm8903_read(codec, WM8903_DAC_DIGITAL_1);
1685 val |= WM8903_DAC_MUTEMODE;
1686 wm8903_write(codec, WM8903_DAC_DIGITAL_1, val);
1687
1688 wm8903_dai.dev = &i2c->dev;
1689 wm8903_codec = codec;
1690
1691 ret = snd_soc_register_codec(codec);
1692 if (ret != 0) {
1693 dev_err(&i2c->dev, "Failed to register codec: %d\n", ret);
1694 goto err;
1695 }
1696
1697 ret = snd_soc_register_dai(&wm8903_dai);
1698 if (ret != 0) {
1699 dev_err(&i2c->dev, "Failed to register DAI: %d\n", ret);
1700 goto err_codec;
1701 }
1702
1703 return ret;
1704
1705 err_codec:
1706 snd_soc_unregister_codec(codec);
1707 err:
1708 wm8903_codec = NULL;
1709 kfree(wm8903);
1710 return ret;
1711 }
1712
1713 static __devexit int wm8903_i2c_remove(struct i2c_client *client)
1714 {
1715 struct snd_soc_codec *codec = i2c_get_clientdata(client);
1716
1717 snd_soc_unregister_dai(&wm8903_dai);
1718 snd_soc_unregister_codec(codec);
1719
1720 wm8903_set_bias_level(codec, SND_SOC_BIAS_OFF);
1721
1722 kfree(codec->private_data);
1723
1724 wm8903_codec = NULL;
1725 wm8903_dai.dev = NULL;
1726
1727 return 0;
1728 }
1729
1730 #ifdef CONFIG_PM
1731 static int wm8903_i2c_suspend(struct i2c_client *client, pm_message_t msg)
1732 {
1733 return snd_soc_suspend_device(&client->dev);
1734 }
1735
1736 static int wm8903_i2c_resume(struct i2c_client *client)
1737 {
1738 return snd_soc_resume_device(&client->dev);
1739 }
1740 #else
1741 #define wm8903_i2c_suspend NULL
1742 #define wm8903_i2c_resume NULL
1743 #endif
1744
1745 /* i2c codec control layer */
1746 static const struct i2c_device_id wm8903_i2c_id[] = {
1747 { "wm8903", 0 },
1748 { }
1749 };
1750 MODULE_DEVICE_TABLE(i2c, wm8903_i2c_id);
1751
1752 static struct i2c_driver wm8903_i2c_driver = {
1753 .driver = {
1754 .name = "WM8903",
1755 .owner = THIS_MODULE,
1756 },
1757 .probe = wm8903_i2c_probe,
1758 .remove = __devexit_p(wm8903_i2c_remove),
1759 .suspend = wm8903_i2c_suspend,
1760 .resume = wm8903_i2c_resume,
1761 .id_table = wm8903_i2c_id,
1762 };
1763
1764 static int wm8903_probe(struct platform_device *pdev)
1765 {
1766 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1767 int ret = 0;
1768
1769 if (!wm8903_codec) {
1770 dev_err(&pdev->dev, "I2C device not yet probed\n");
1771 goto err;
1772 }
1773
1774 socdev->card->codec = wm8903_codec;
1775
1776 /* register pcms */
1777 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
1778 if (ret < 0) {
1779 dev_err(&pdev->dev, "failed to create pcms\n");
1780 goto err;
1781 }
1782
1783 snd_soc_add_controls(socdev->card->codec, wm8903_snd_controls,
1784 ARRAY_SIZE(wm8903_snd_controls));
1785 wm8903_add_widgets(socdev->card->codec);
1786
1787 ret = snd_soc_init_card(socdev);
1788 if (ret < 0) {
1789 dev_err(&pdev->dev, "wm8903: failed to register card\n");
1790 goto card_err;
1791 }
1792
1793 return ret;
1794
1795 card_err:
1796 snd_soc_free_pcms(socdev);
1797 snd_soc_dapm_free(socdev);
1798 err:
1799 return ret;
1800 }
1801
1802 /* power down chip */
1803 static int wm8903_remove(struct platform_device *pdev)
1804 {
1805 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1806 struct snd_soc_codec *codec = socdev->card->codec;
1807
1808 if (codec->control_data)
1809 wm8903_set_bias_level(codec, SND_SOC_BIAS_OFF);
1810
1811 snd_soc_free_pcms(socdev);
1812 snd_soc_dapm_free(socdev);
1813
1814 return 0;
1815 }
1816
1817 struct snd_soc_codec_device soc_codec_dev_wm8903 = {
1818 .probe = wm8903_probe,
1819 .remove = wm8903_remove,
1820 .suspend = wm8903_suspend,
1821 .resume = wm8903_resume,
1822 };
1823 EXPORT_SYMBOL_GPL(soc_codec_dev_wm8903);
1824
1825 static int __init wm8903_modinit(void)
1826 {
1827 return i2c_add_driver(&wm8903_i2c_driver);
1828 }
1829 module_init(wm8903_modinit);
1830
1831 static void __exit wm8903_exit(void)
1832 {
1833 i2c_del_driver(&wm8903_i2c_driver);
1834 }
1835 module_exit(wm8903_exit);
1836
1837 MODULE_DESCRIPTION("ASoC WM8903 driver");
1838 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.cm>");
1839 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.069107 seconds and 5 git commands to generate.