]> bbs.cooldavid.org Git - net-next-2.6.git/blame - sound/soc/codecs/wm9090.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ASoC: sound/wm9090: add missing __devexit marker
[net-next-2.6.git] / sound / soc / codecs / wm9090.c
CommitLineData
39b8eab7
MB		 1/*
2 * ALSA SoC WM9090 driver
3 *
4 * Copyright 2009, 2010 Wolfson Microelectronics
5 *
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
11 *
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
20 * 02110-1301 USA
21 */
22
23#include <linux/module.h>
24#include <linux/errno.h>
25#include <linux/device.h>
26#include <linux/i2c.h>
27#include <linux/delay.h>
28#include <linux/slab.h>
29#include <sound/initval.h>
30#include <sound/soc.h>
31#include <sound/soc-dapm.h>
32#include <sound/tlv.h>
33#include <sound/wm9090.h>
34
35#include "wm9090.h"
36
39b8eab7
MB		 37static const u16 wm9090_reg_defaults[] = {
38 0x9093, /* R0 - Software Reset */
39 0x0006, /* R1 - Power Management (1) */
40 0x6000, /* R2 - Power Management (2) */
41 0x0000, /* R3 - Power Management (3) */
42 0x0000, /* R4 */
43 0x0000, /* R5 */
44 0x01C0, /* R6 - Clocking 1 */
45 0x0000, /* R7 */
46 0x0000, /* R8 */
47 0x0000, /* R9 */
48 0x0000, /* R10 */
49 0x0000, /* R11 */
50 0x0000, /* R12 */
51 0x0000, /* R13 */
52 0x0000, /* R14 */
53 0x0000, /* R15 */
54 0x0000, /* R16 */
55 0x0000, /* R17 */
56 0x0000, /* R18 */
57 0x0000, /* R19 */
58 0x0000, /* R20 */
59 0x0000, /* R21 */
60 0x0003, /* R22 - IN1 Line Control */
61 0x0003, /* R23 - IN2 Line Control */
62 0x0083, /* R24 - IN1 Line Input A Volume */
63 0x0083, /* R25 - IN1 Line Input B Volume */
64 0x0083, /* R26 - IN2 Line Input A Volume */
65 0x0083, /* R27 - IN2 Line Input B Volume */
66 0x002D, /* R28 - Left Output Volume */
67 0x002D, /* R29 - Right Output Volume */
68 0x0000, /* R30 */
69 0x0000, /* R31 */
70 0x0000, /* R32 */
71 0x0000, /* R33 */
72 0x0100, /* R34 - SPKMIXL Attenuation */
73 0x0000, /* R35 */
74 0x0010, /* R36 - SPKOUT Mixers */
75 0x0140, /* R37 - ClassD3 */
76 0x0039, /* R38 - Speaker Volume Left */
77 0x0000, /* R39 */
78 0x0000, /* R40 */
79 0x0000, /* R41 */
80 0x0000, /* R42 */
81 0x0000, /* R43 */
82 0x0000, /* R44 */
83 0x0000, /* R45 - Output Mixer1 */
84 0x0000, /* R46 - Output Mixer2 */
85 0x0100, /* R47 - Output Mixer3 */
86 0x0100, /* R48 - Output Mixer4 */
87 0x0000, /* R49 */
88 0x0000, /* R50 */
89 0x0000, /* R51 */
90 0x0000, /* R52 */
91 0x0000, /* R53 */
92 0x0000, /* R54 - Speaker Mixer */
93 0x0000, /* R55 */
94 0x0000, /* R56 */
95 0x000D, /* R57 - AntiPOP2 */
96 0x0000, /* R58 */
97 0x0000, /* R59 */
98 0x0000, /* R60 */
99 0x0000, /* R61 */
100 0x0000, /* R62 */
101 0x0000, /* R63 */
102 0x0000, /* R64 */
103 0x0000, /* R65 */
104 0x0000, /* R66 */
105 0x0000, /* R67 */
106 0x0000, /* R68 */
107 0x0000, /* R69 */
108 0x0000, /* R70 - Write Sequencer 0 */
109 0x0000, /* R71 - Write Sequencer 1 */
110 0x0000, /* R72 - Write Sequencer 2 */
111 0x0000, /* R73 - Write Sequencer 3 */
112 0x0000, /* R74 - Write Sequencer 4 */
113 0x0000, /* R75 - Write Sequencer 5 */
114 0x1F25, /* R76 - Charge Pump 1 */
115 0x0000, /* R77 */
116 0x0000, /* R78 */
117 0x0000, /* R79 */
118 0x0000, /* R80 */
119 0x0000, /* R81 */
120 0x0000, /* R82 */
121 0x0000, /* R83 */
122 0x0000, /* R84 - DC Servo 0 */
123 0x054A, /* R85 - DC Servo 1 */
124 0x0000, /* R86 */
125 0x0000, /* R87 - DC Servo 3 */
126 0x0000, /* R88 - DC Servo Readback 0 */
127 0x0000, /* R89 - DC Servo Readback 1 */
128 0x0000, /* R90 - DC Servo Readback 2 */
129 0x0000, /* R91 */
130 0x0000, /* R92 */
131 0x0000, /* R93 */
132 0x0000, /* R94 */
133 0x0000, /* R95 */
134 0x0100, /* R96 - Analogue HP 0 */
135 0x0000, /* R97 */
136 0x8640, /* R98 - AGC Control 0 */
137 0xC000, /* R99 - AGC Control 1 */
138 0x0200, /* R100 - AGC Control 2 */
139};
140
141/* This struct is used to save the context */
142struct wm9090_priv {
39b8eab7
MB		 143 struct mutex mutex;
144 u16 reg_cache[WM9090_MAX_REGISTER + 1];
145 struct wm9090_platform_data pdata;
f0fba2ad 146 void *control_data;
39b8eab7
MB		 147};
148
149static int wm9090_volatile(unsigned int reg)
150{
151 switch (reg) {
152 case WM9090_SOFTWARE_RESET:
153 case WM9090_DC_SERVO_0:
154 case WM9090_DC_SERVO_READBACK_0:
155 case WM9090_DC_SERVO_READBACK_1:
156 case WM9090_DC_SERVO_READBACK_2:
157 return 1;
158
159 default:
160 return 0;
161 }
162}
163
164static void wait_for_dc_servo(struct snd_soc_codec *codec)
165{
166 unsigned int reg;
167 int count = 0;
168
169 dev_dbg(codec->dev, "Waiting for DC servo...\n");
170 do {
171 count++;
172 msleep(1);
173 reg = snd_soc_read(codec, WM9090_DC_SERVO_READBACK_0);
174 dev_dbg(codec->dev, "DC servo status: %x\n", reg);
175 } while ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
176 != WM9090_DCS_CAL_COMPLETE_MASK && count < 1000);
177
178 if ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
179 != WM9090_DCS_CAL_COMPLETE_MASK)
180 dev_err(codec->dev, "Timed out waiting for DC Servo\n");
181}
182
183static const unsigned int in_tlv[] = {
184 TLV_DB_RANGE_HEAD(6),
185 0, 0, TLV_DB_SCALE_ITEM(-600, 0, 0),
186 1, 3, TLV_DB_SCALE_ITEM(-350, 350, 0),
187 4, 6, TLV_DB_SCALE_ITEM(600, 600, 0),
188};
189static const unsigned int mix_tlv[] = {
190 TLV_DB_RANGE_HEAD(4),
191 0, 2, TLV_DB_SCALE_ITEM(-1200, 300, 0),
192 3, 3, TLV_DB_SCALE_ITEM(0, 0, 0),
193};
194static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
195static const unsigned int spkboost_tlv[] = {
196 TLV_DB_RANGE_HEAD(7),
197 0, 6, TLV_DB_SCALE_ITEM(0, 150, 0),
198 7, 7, TLV_DB_SCALE_ITEM(1200, 0, 0),
199};
200
201static const struct snd_kcontrol_new wm9090_controls[] = {
202SOC_SINGLE_TLV("IN1A Volume", WM9090_IN1_LINE_INPUT_A_VOLUME, 0, 6, 0,
203 in_tlv),
204SOC_SINGLE("IN1A Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 7, 1, 1),
205SOC_SINGLE("IN1A ZC Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 6, 1, 0),
206
207SOC_SINGLE_TLV("IN2A Volume", WM9090_IN2_LINE_INPUT_A_VOLUME, 0, 6, 0,
208 in_tlv),
209SOC_SINGLE("IN2A Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 7, 1, 1),
210SOC_SINGLE("IN2A ZC Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 6, 1, 0),
211
212SOC_SINGLE("MIXOUTL Switch", WM9090_OUTPUT_MIXER3, 8, 1, 1),
213SOC_SINGLE_TLV("MIXOUTL IN1A Volume", WM9090_OUTPUT_MIXER3, 6, 3, 1,
214 mix_tlv),
215SOC_SINGLE_TLV("MIXOUTL IN2A Volume", WM9090_OUTPUT_MIXER3, 2, 3, 1,
216 mix_tlv),
217
218SOC_SINGLE("MIXOUTR Switch", WM9090_OUTPUT_MIXER4, 8, 1, 1),
219SOC_SINGLE_TLV("MIXOUTR IN1A Volume", WM9090_OUTPUT_MIXER4, 6, 3, 1,
220 mix_tlv),
221SOC_SINGLE_TLV("MIXOUTR IN2A Volume", WM9090_OUTPUT_MIXER4, 2, 3, 1,
222 mix_tlv),
223
224SOC_SINGLE("SPKMIX Switch", WM9090_SPKMIXL_ATTENUATION, 8, 1, 1),
225SOC_SINGLE_TLV("SPKMIX IN1A Volume", WM9090_SPKMIXL_ATTENUATION, 6, 3, 1,
226 mix_tlv),
227SOC_SINGLE_TLV("SPKMIX IN2A Volume", WM9090_SPKMIXL_ATTENUATION, 2, 3, 1,
228 mix_tlv),
229
230SOC_DOUBLE_R_TLV("Headphone Volume", WM9090_LEFT_OUTPUT_VOLUME,
231 WM9090_RIGHT_OUTPUT_VOLUME, 0, 63, 0, out_tlv),
232SOC_DOUBLE_R("Headphone Switch", WM9090_LEFT_OUTPUT_VOLUME,
233 WM9090_RIGHT_OUTPUT_VOLUME, 6, 1, 1),
234SOC_DOUBLE_R("Headphone ZC Switch", WM9090_LEFT_OUTPUT_VOLUME,
235 WM9090_RIGHT_OUTPUT_VOLUME, 7, 1, 0),
236
237SOC_SINGLE_TLV("Speaker Volume", WM9090_SPEAKER_VOLUME_LEFT, 0, 63, 0,
238 out_tlv),
239SOC_SINGLE("Speaker Switch", WM9090_SPEAKER_VOLUME_LEFT, 6, 1, 1),
240SOC_SINGLE("Speaker ZC Switch", WM9090_SPEAKER_VOLUME_LEFT, 7, 1, 0),
241SOC_SINGLE_TLV("Speaker Boost Volume", WM9090_CLASSD3, 3, 7, 0, spkboost_tlv),
242};
243
244static const struct snd_kcontrol_new wm9090_in1_se_controls[] = {
245SOC_SINGLE_TLV("IN1B Volume", WM9090_IN1_LINE_INPUT_B_VOLUME, 0, 6, 0,
246 in_tlv),
247SOC_SINGLE("IN1B Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 7, 1, 1),
248SOC_SINGLE("IN1B ZC Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 6, 1, 0),
249
250SOC_SINGLE_TLV("SPKMIX IN1B Volume", WM9090_SPKMIXL_ATTENUATION, 4, 3, 1,
251 mix_tlv),
252SOC_SINGLE_TLV("MIXOUTL IN1B Volume", WM9090_OUTPUT_MIXER3, 4, 3, 1,
253 mix_tlv),
254SOC_SINGLE_TLV("MIXOUTR IN1B Volume", WM9090_OUTPUT_MIXER4, 4, 3, 1,
255 mix_tlv),
256};
257
258static const struct snd_kcontrol_new wm9090_in2_se_controls[] = {
259SOC_SINGLE_TLV("IN2B Volume", WM9090_IN2_LINE_INPUT_B_VOLUME, 0, 6, 0,
260 in_tlv),
261SOC_SINGLE("IN2B Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 7, 1, 1),
262SOC_SINGLE("IN2B ZC Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 6, 1, 0),
263
264SOC_SINGLE_TLV("SPKMIX IN2B Volume", WM9090_SPKMIXL_ATTENUATION, 0, 3, 1,
265 mix_tlv),
266SOC_SINGLE_TLV("MIXOUTL IN2B Volume", WM9090_OUTPUT_MIXER3, 0, 3, 1,
267 mix_tlv),
268SOC_SINGLE_TLV("MIXOUTR IN2B Volume", WM9090_OUTPUT_MIXER4, 0, 3, 1,
269 mix_tlv),
270};
271
272static int hp_ev(struct snd_soc_dapm_widget *w,
273 struct snd_kcontrol *kcontrol, int event)
274{
275 struct snd_soc_codec *codec = w->codec;
276 unsigned int reg = snd_soc_read(codec, WM9090_ANALOGUE_HP_0);
277
278 switch (event) {
279 case SND_SOC_DAPM_POST_PMU:
280 snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
281 WM9090_CP_ENA, WM9090_CP_ENA);
282
283 msleep(5);
284
285 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
286 WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
287 WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA);
288
289 reg |= WM9090_HPOUT1L_DLY | WM9090_HPOUT1R_DLY;
290 snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
291
292 /* Start the DC servo. We don't currently use the
293 * ability to save the state since we don't have full
294 * control of the analogue paths and they can change
295 * DC offsets; see the WM8904 driver for an example of
296 * doing so.
297 */
298 snd_soc_write(codec, WM9090_DC_SERVO_0,
299 WM9090_DCS_ENA_CHAN_0 |
300 WM9090_DCS_ENA_CHAN_1 |
301 WM9090_DCS_TRIG_STARTUP_1 |
302 WM9090_DCS_TRIG_STARTUP_0);
303 wait_for_dc_servo(codec);
304
305 reg |= WM9090_HPOUT1R_OUTP | WM9090_HPOUT1R_RMV_SHORT |
306 WM9090_HPOUT1L_OUTP | WM9090_HPOUT1L_RMV_SHORT;
307 snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
308 break;
309
310 case SND_SOC_DAPM_PRE_PMD:
311 reg &= ~(WM9090_HPOUT1L_RMV_SHORT |
312 WM9090_HPOUT1L_DLY |
313 WM9090_HPOUT1L_OUTP |
314 WM9090_HPOUT1R_RMV_SHORT |
315 WM9090_HPOUT1R_DLY |
316 WM9090_HPOUT1R_OUTP);
317
318 snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
319
320 snd_soc_write(codec, WM9090_DC_SERVO_0, 0);
321
322 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
323 WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
324 0);
325
326 snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
327 WM9090_CP_ENA, 0);
328 break;
329 }
330
331 return 0;
332}
333
334static const struct snd_kcontrol_new spkmix[] = {
335SOC_DAPM_SINGLE("IN1A Switch", WM9090_SPEAKER_MIXER, 6, 1, 0),
336SOC_DAPM_SINGLE("IN1B Switch", WM9090_SPEAKER_MIXER, 4, 1, 0),
337SOC_DAPM_SINGLE("IN2A Switch", WM9090_SPEAKER_MIXER, 2, 1, 0),
338SOC_DAPM_SINGLE("IN2B Switch", WM9090_SPEAKER_MIXER, 0, 1, 0),
339};
340
341static const struct snd_kcontrol_new spkout[] = {
342SOC_DAPM_SINGLE("Mixer Switch", WM9090_SPKOUT_MIXERS, 4, 1, 0),
343};
344
345static const struct snd_kcontrol_new mixoutl[] = {
346SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER1, 6, 1, 0),
347SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER1, 4, 1, 0),
348SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER1, 2, 1, 0),
349SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER1, 0, 1, 0),
350};
351
352static const struct snd_kcontrol_new mixoutr[] = {
353SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER2, 6, 1, 0),
354SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER2, 4, 1, 0),
355SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER2, 2, 1, 0),
356SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER2, 0, 1, 0),
357};
358
359static const struct snd_soc_dapm_widget wm9090_dapm_widgets[] = {
360SND_SOC_DAPM_INPUT("IN1+"),
361SND_SOC_DAPM_INPUT("IN1-"),
362SND_SOC_DAPM_INPUT("IN2+"),
363SND_SOC_DAPM_INPUT("IN2-"),
364
365SND_SOC_DAPM_SUPPLY("OSC", WM9090_POWER_MANAGEMENT_1, 3, 0, NULL, 0),
366
367SND_SOC_DAPM_PGA("IN1A PGA", WM9090_POWER_MANAGEMENT_2, 7, 0, NULL, 0),
368SND_SOC_DAPM_PGA("IN1B PGA", WM9090_POWER_MANAGEMENT_2, 6, 0, NULL, 0),
369SND_SOC_DAPM_PGA("IN2A PGA", WM9090_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
370SND_SOC_DAPM_PGA("IN2B PGA", WM9090_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
371
372SND_SOC_DAPM_MIXER("SPKMIX", WM9090_POWER_MANAGEMENT_3, 3, 0,
373 spkmix, ARRAY_SIZE(spkmix)),
374SND_SOC_DAPM_MIXER("MIXOUTL", WM9090_POWER_MANAGEMENT_3, 5, 0,
375 mixoutl, ARRAY_SIZE(mixoutl)),
376SND_SOC_DAPM_MIXER("MIXOUTR", WM9090_POWER_MANAGEMENT_3, 4, 0,
377 mixoutr, ARRAY_SIZE(mixoutr)),
378
379SND_SOC_DAPM_PGA_E("HP PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
380 hp_ev, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
381
382SND_SOC_DAPM_PGA("SPKPGA", WM9090_POWER_MANAGEMENT_3, 8, 0, NULL, 0),
383SND_SOC_DAPM_MIXER("SPKOUT", WM9090_POWER_MANAGEMENT_1, 12, 0,
384 spkout, ARRAY_SIZE(spkout)),
385
386SND_SOC_DAPM_OUTPUT("HPR"),
387SND_SOC_DAPM_OUTPUT("HPL"),
388SND_SOC_DAPM_OUTPUT("Speaker"),
389};
390
391static const struct snd_soc_dapm_route audio_map[] = {
392 { "IN1A PGA", NULL, "IN1+" },
393 { "IN2A PGA", NULL, "IN2+" },
394
395 { "SPKMIX", "IN1A Switch", "IN1A PGA" },
396 { "SPKMIX", "IN2A Switch", "IN2A PGA" },
397
398 { "MIXOUTL", "IN1A Switch", "IN1A PGA" },
399 { "MIXOUTL", "IN2A Switch", "IN2A PGA" },
400
401 { "MIXOUTR", "IN1A Switch", "IN1A PGA" },
402 { "MIXOUTR", "IN2A Switch", "IN2A PGA" },
403
404 { "HP PGA", NULL, "OSC" },
405 { "HP PGA", NULL, "MIXOUTL" },
406 { "HP PGA", NULL, "MIXOUTR" },
407
408 { "HPL", NULL, "HP PGA" },
409 { "HPR", NULL, "HP PGA" },
410
411 { "SPKPGA", NULL, "OSC" },
412 { "SPKPGA", NULL, "SPKMIX" },
413
414 { "SPKOUT", "Mixer Switch", "SPKPGA" },
415
416 { "Speaker", NULL, "SPKOUT" },
417};
418
419static const struct snd_soc_dapm_route audio_map_in1_se[] = {
420 { "IN1B PGA", NULL, "IN1-" },
421
422 { "SPKMIX", "IN1B Switch", "IN1B PGA" },
423 { "MIXOUTL", "IN1B Switch", "IN1B PGA" },
424 { "MIXOUTR", "IN1B Switch", "IN1B PGA" },
425};
426
427static const struct snd_soc_dapm_route audio_map_in1_diff[] = {
428 { "IN1A PGA", NULL, "IN1-" },
429};
430
431static const struct snd_soc_dapm_route audio_map_in2_se[] = {
432 { "IN2B PGA", NULL, "IN2-" },
433
434 { "SPKMIX", "IN2B Switch", "IN2B PGA" },
435 { "MIXOUTL", "IN2B Switch", "IN2B PGA" },
436 { "MIXOUTR", "IN2B Switch", "IN2B PGA" },
437};
438
439static const struct snd_soc_dapm_route audio_map_in2_diff[] = {
440 { "IN2A PGA", NULL, "IN2-" },
441};
442
443static int wm9090_add_controls(struct snd_soc_codec *codec)
444{
445 struct wm9090_priv *wm9090 = snd_soc_codec_get_drvdata(codec);
446 int i;
447
448 snd_soc_dapm_new_controls(codec, wm9090_dapm_widgets,
449 ARRAY_SIZE(wm9090_dapm_widgets));
450
451 snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
452
453 snd_soc_add_controls(codec, wm9090_controls,
454 ARRAY_SIZE(wm9090_controls));
455
456 if (wm9090->pdata.lin1_diff) {
457 snd_soc_dapm_add_routes(codec, audio_map_in1_diff,
458 ARRAY_SIZE(audio_map_in1_diff));
459 } else {
460 snd_soc_dapm_add_routes(codec, audio_map_in1_se,
461 ARRAY_SIZE(audio_map_in1_se));
462 snd_soc_add_controls(codec, wm9090_in1_se_controls,
463 ARRAY_SIZE(wm9090_in1_se_controls));
464 }
465
466 if (wm9090->pdata.lin2_diff) {
467 snd_soc_dapm_add_routes(codec, audio_map_in2_diff,
468 ARRAY_SIZE(audio_map_in2_diff));
469 } else {
470 snd_soc_dapm_add_routes(codec, audio_map_in2_se,
471 ARRAY_SIZE(audio_map_in2_se));
472 snd_soc_add_controls(codec, wm9090_in2_se_controls,
473 ARRAY_SIZE(wm9090_in2_se_controls));
474 }
475
476 if (wm9090->pdata.agc_ena) {
477 for (i = 0; i < ARRAY_SIZE(wm9090->pdata.agc); i++)
478 snd_soc_write(codec, WM9090_AGC_CONTROL_0 + i,
479 wm9090->pdata.agc[i]);
480 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
481 WM9090_AGC_ENA, WM9090_AGC_ENA);
482 } else {
483 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
484 WM9090_AGC_ENA, 0);
485 }
486
487 return 0;
488
489}
490
491/*
492 * The machine driver should call this from their set_bias_level; if there
493 * isn't one then this can just be set as the set_bias_level function.
494 */
495static int wm9090_set_bias_level(struct snd_soc_codec *codec,
496 enum snd_soc_bias_level level)
497{
498 u16 *reg_cache = codec->reg_cache;
499 int i, ret;
500
501 switch (level) {
502 case SND_SOC_BIAS_ON:
503 break;
504
505 case SND_SOC_BIAS_PREPARE:
506 snd_soc_update_bits(codec, WM9090_ANTIPOP2, WM9090_VMID_ENA,
507 WM9090_VMID_ENA);
508 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
509 WM9090_BIAS_ENA |
510 WM9090_VMID_RES_MASK,
511 WM9090_BIAS_ENA |
512 1 << WM9090_VMID_RES_SHIFT);
513 msleep(1); /* Probably an overestimate */
514 break;
515
516 case SND_SOC_BIAS_STANDBY:
517 if (codec->bias_level == SND_SOC_BIAS_OFF) {
518 /* Restore the register cache */
f0fba2ad 519 for (i = 1; i < codec->driver->reg_cache_size; i++) {
39b8eab7
MB		 520 if (reg_cache[i] == wm9090_reg_defaults[i])
521 continue;
522 if (wm9090_volatile(i))
523 continue;
524
525 ret = snd_soc_write(codec, i, reg_cache[i]);
526 if (ret != 0)
527 dev_warn(codec->dev,
528 "Failed to restore register %d: %d\n",
529 i, ret);
530 }
531 }
532
533 /* We keep VMID off during standby since the combination of
534 * ground referenced outputs and class D speaker mean that
535 * latency is not an issue.
536 */
537 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
538 WM9090_BIAS_ENA | WM9090_VMID_RES_MASK, 0);
539 snd_soc_update_bits(codec, WM9090_ANTIPOP2,
540 WM9090_VMID_ENA, 0);
541 break;
542
543 case SND_SOC_BIAS_OFF:
544 break;
545 }
546
547 codec->bias_level = level;
548
549 return 0;
550}
551
f0fba2ad 552static int wm9090_probe(struct snd_soc_codec *codec)
39b8eab7 553{
f0fba2ad
LG		 554 struct wm9090_priv *wm9090 = snd_soc_codec_get_drvdata(codec);
555 int ret;
39b8eab7 556
f0fba2ad
LG		 557 codec->control_data = wm9090->control_data;
558 ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
559 if (ret != 0) {
560 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
561 return ret;
39b8eab7
MB		 562 }
563
f0fba2ad
LG		 564 ret = snd_soc_read(codec, WM9090_SOFTWARE_RESET);
565 if (ret < 0)
566 return ret;
567 if (ret != wm9090_reg_defaults[WM9090_SOFTWARE_RESET]) {
568 dev_err(codec->dev, "Device is not a WM9090, ID=%x\n", ret);
569 return -EINVAL;
39b8eab7
MB		 570 }
571
f0fba2ad
LG		 572 ret = snd_soc_write(codec, WM9090_SOFTWARE_RESET, 0);
573 if (ret < 0)
574 return ret;
575
576 /* Configure some defaults; they will be written out when we
577 * bring the bias up.
578 */
579 wm9090->reg_cache[WM9090_IN1_LINE_INPUT_A_VOLUME] |= WM9090_IN1_VU
580 | WM9090_IN1A_ZC;
581 wm9090->reg_cache[WM9090_IN1_LINE_INPUT_B_VOLUME] |= WM9090_IN1_VU
582 | WM9090_IN1B_ZC;
583 wm9090->reg_cache[WM9090_IN2_LINE_INPUT_A_VOLUME] |= WM9090_IN2_VU
584 | WM9090_IN2A_ZC;
585 wm9090->reg_cache[WM9090_IN2_LINE_INPUT_B_VOLUME] |= WM9090_IN2_VU
586 | WM9090_IN2B_ZC;
587 wm9090->reg_cache[WM9090_SPEAKER_VOLUME_LEFT] |=
588 WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC;
589 wm9090->reg_cache[WM9090_LEFT_OUTPUT_VOLUME] |=
590 WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC;
591 wm9090->reg_cache[WM9090_RIGHT_OUTPUT_VOLUME] |=
592 WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC;
593
594 wm9090->reg_cache[WM9090_CLOCKING_1] |= WM9090_TOCLK_ENA;
595
596 wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
597
39b8eab7
MB		 598 wm9090_add_controls(codec);
599
600 return 0;
39b8eab7
MB		 601}
602
603#ifdef CONFIG_PM
f0fba2ad 604static int wm9090_suspend(struct snd_soc_codec *codec, pm_message_t state)
39b8eab7 605{
39b8eab7
MB		 606 wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
607
608 return 0;
609}
610
f0fba2ad 611static int wm9090_resume(struct snd_soc_codec *codec)
39b8eab7 612{
39b8eab7
MB		 613 wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
614
615 return 0;
616}
617#else
618#define wm9090_suspend NULL
619#define wm9090_resume NULL
620#endif
621
f0fba2ad 622static int wm9090_remove(struct snd_soc_codec *codec)
39b8eab7 623{
f0fba2ad 624 wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
39b8eab7
MB		 625
626 return 0;
627}
628
f0fba2ad 629static struct snd_soc_codec_driver soc_codec_dev_wm9090 = {
39b8eab7
MB		 630 .probe = wm9090_probe,
631 .remove = wm9090_remove,
632 .suspend = wm9090_suspend,
633 .resume = wm9090_resume,
f0fba2ad
LG		 634 .set_bias_level = wm9090_set_bias_level,
635 .reg_cache_size = (WM9090_MAX_REGISTER + 1),
636 .reg_word_size = sizeof(u16),
637 .reg_cache_default = wm9090_reg_defaults,
638 .volatile_register = wm9090_volatile,
39b8eab7 639};
39b8eab7
MB		 640
641static int wm9090_i2c_probe(struct i2c_client *i2c,
642 const struct i2c_device_id *id)
643{
644 struct wm9090_priv *wm9090;
39b8eab7
MB		 645 int ret;
646
647 wm9090 = kzalloc(sizeof(*wm9090), GFP_KERNEL);
648 if (wm9090 == NULL) {
649 dev_err(&i2c->dev, "Can not allocate memory\n");
650 return -ENOMEM;
651 }
39b8eab7
MB		 652
653 if (i2c->dev.platform_data)
654 memcpy(&wm9090->pdata, i2c->dev.platform_data,
655 sizeof(wm9090->pdata));
656
39b8eab7 657 i2c_set_clientdata(i2c, wm9090);
f0fba2ad
LG		 658 wm9090->control_data = i2c;
659 mutex_init(&wm9090->mutex);
39b8eab7 660
f0fba2ad
LG		 661 ret = snd_soc_register_codec(&i2c->dev,
662 &soc_codec_dev_wm9090, NULL, 0);
39b8eab7 663 if (ret < 0)
f0fba2ad 664 kfree(wm9090);
39b8eab7
MB		 665 return ret;
666}
667
0d040df9 668static int __devexit wm9090_i2c_remove(struct i2c_client *i2c)
39b8eab7
MB		 669{
670 struct wm9090_priv *wm9090 = i2c_get_clientdata(i2c);
39b8eab7 671
f0fba2ad 672 snd_soc_unregister_codec(&i2c->dev);
39b8eab7 673 kfree(wm9090);
39b8eab7
MB		 674
675 return 0;
676}
677
678static const struct i2c_device_id wm9090_id[] = {
679 { "wm9090", 0 },
680 { }
681};
682MODULE_DEVICE_TABLE(i2c, wm9090_id);
683
684static struct i2c_driver wm9090_i2c_driver = {
685 .driver = {
f0fba2ad 686 .name = "wm9090-codec",
39b8eab7
MB		 687 .owner = THIS_MODULE,
688 },
689 .probe = wm9090_i2c_probe,
690 .remove = __devexit_p(wm9090_i2c_remove),
691 .id_table = wm9090_id,
692};
693
694static int __init wm9090_init(void)
695{
696 return i2c_add_driver(&wm9090_i2c_driver);
697}
698module_init(wm9090_init);
699
700static void __exit wm9090_exit(void)
701{
702 i2c_del_driver(&wm9090_i2c_driver);
703}
704module_exit(wm9090_exit);
705
706MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
707MODULE_DESCRIPTION("WM9090 ASoC driver");
708MODULE_LICENSE("GPL");
Clone of davem's net-next-2.6 tree