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