diff options
Diffstat (limited to 'sound/soc/codecs/wm8974.c')
-rw-r--r-- | sound/soc/codecs/wm8974.c | 808 |
1 files changed, 808 insertions, 0 deletions
diff --git a/sound/soc/codecs/wm8974.c b/sound/soc/codecs/wm8974.c new file mode 100644 index 000000000000..d8a013ab3177 --- /dev/null +++ b/sound/soc/codecs/wm8974.c | |||
@@ -0,0 +1,808 @@ | |||
1 | /* | ||
2 | * wm8974.c -- WM8974 ALSA Soc Audio driver | ||
3 | * | ||
4 | * Copyright 2006-2009 Wolfson Microelectronics PLC. | ||
5 | * | ||
6 | * Author: Liam Girdwood <linux@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 | |||
13 | #include <linux/module.h> | ||
14 | #include <linux/moduleparam.h> | ||
15 | #include <linux/version.h> | ||
16 | #include <linux/kernel.h> | ||
17 | #include <linux/init.h> | ||
18 | #include <linux/delay.h> | ||
19 | #include <linux/pm.h> | ||
20 | #include <linux/i2c.h> | ||
21 | #include <linux/platform_device.h> | ||
22 | #include <sound/core.h> | ||
23 | #include <sound/pcm.h> | ||
24 | #include <sound/pcm_params.h> | ||
25 | #include <sound/soc.h> | ||
26 | #include <sound/soc-dapm.h> | ||
27 | #include <sound/initval.h> | ||
28 | #include <sound/tlv.h> | ||
29 | |||
30 | #include "wm8974.h" | ||
31 | |||
32 | static const u16 wm8974_reg[WM8974_CACHEREGNUM] = { | ||
33 | 0x0000, 0x0000, 0x0000, 0x0000, | ||
34 | 0x0050, 0x0000, 0x0140, 0x0000, | ||
35 | 0x0000, 0x0000, 0x0000, 0x00ff, | ||
36 | 0x0000, 0x0000, 0x0100, 0x00ff, | ||
37 | 0x0000, 0x0000, 0x012c, 0x002c, | ||
38 | 0x002c, 0x002c, 0x002c, 0x0000, | ||
39 | 0x0032, 0x0000, 0x0000, 0x0000, | ||
40 | 0x0000, 0x0000, 0x0000, 0x0000, | ||
41 | 0x0038, 0x000b, 0x0032, 0x0000, | ||
42 | 0x0008, 0x000c, 0x0093, 0x00e9, | ||
43 | 0x0000, 0x0000, 0x0000, 0x0000, | ||
44 | 0x0003, 0x0010, 0x0000, 0x0000, | ||
45 | 0x0000, 0x0002, 0x0000, 0x0000, | ||
46 | 0x0000, 0x0000, 0x0039, 0x0000, | ||
47 | 0x0000, | ||
48 | }; | ||
49 | |||
50 | #define WM8974_POWER1_BIASEN 0x08 | ||
51 | #define WM8974_POWER1_BUFIOEN 0x10 | ||
52 | |||
53 | struct wm8974_priv { | ||
54 | struct snd_soc_codec codec; | ||
55 | u16 reg_cache[WM8974_CACHEREGNUM]; | ||
56 | }; | ||
57 | |||
58 | static struct snd_soc_codec *wm8974_codec; | ||
59 | |||
60 | #define wm8974_reset(c) snd_soc_write(c, WM8974_RESET, 0) | ||
61 | |||
62 | static const char *wm8974_companding[] = {"Off", "NC", "u-law", "A-law" }; | ||
63 | static const char *wm8974_deemp[] = {"None", "32kHz", "44.1kHz", "48kHz" }; | ||
64 | static const char *wm8974_eqmode[] = {"Capture", "Playback" }; | ||
65 | static const char *wm8974_bw[] = {"Narrow", "Wide" }; | ||
66 | static const char *wm8974_eq1[] = {"80Hz", "105Hz", "135Hz", "175Hz" }; | ||
67 | static const char *wm8974_eq2[] = {"230Hz", "300Hz", "385Hz", "500Hz" }; | ||
68 | static const char *wm8974_eq3[] = {"650Hz", "850Hz", "1.1kHz", "1.4kHz" }; | ||
69 | static const char *wm8974_eq4[] = {"1.8kHz", "2.4kHz", "3.2kHz", "4.1kHz" }; | ||
70 | static const char *wm8974_eq5[] = {"5.3kHz", "6.9kHz", "9kHz", "11.7kHz" }; | ||
71 | static const char *wm8974_alc[] = {"ALC", "Limiter" }; | ||
72 | |||
73 | static const struct soc_enum wm8974_enum[] = { | ||
74 | SOC_ENUM_SINGLE(WM8974_COMP, 1, 4, wm8974_companding), /* adc */ | ||
75 | SOC_ENUM_SINGLE(WM8974_COMP, 3, 4, wm8974_companding), /* dac */ | ||
76 | SOC_ENUM_SINGLE(WM8974_DAC, 4, 4, wm8974_deemp), | ||
77 | SOC_ENUM_SINGLE(WM8974_EQ1, 8, 2, wm8974_eqmode), | ||
78 | |||
79 | SOC_ENUM_SINGLE(WM8974_EQ1, 5, 4, wm8974_eq1), | ||
80 | SOC_ENUM_SINGLE(WM8974_EQ2, 8, 2, wm8974_bw), | ||
81 | SOC_ENUM_SINGLE(WM8974_EQ2, 5, 4, wm8974_eq2), | ||
82 | SOC_ENUM_SINGLE(WM8974_EQ3, 8, 2, wm8974_bw), | ||
83 | |||
84 | SOC_ENUM_SINGLE(WM8974_EQ3, 5, 4, wm8974_eq3), | ||
85 | SOC_ENUM_SINGLE(WM8974_EQ4, 8, 2, wm8974_bw), | ||
86 | SOC_ENUM_SINGLE(WM8974_EQ4, 5, 4, wm8974_eq4), | ||
87 | SOC_ENUM_SINGLE(WM8974_EQ5, 8, 2, wm8974_bw), | ||
88 | |||
89 | SOC_ENUM_SINGLE(WM8974_EQ5, 5, 4, wm8974_eq5), | ||
90 | SOC_ENUM_SINGLE(WM8974_ALC3, 8, 2, wm8974_alc), | ||
91 | }; | ||
92 | |||
93 | static const char *wm8974_auxmode_text[] = { "Buffer", "Mixer" }; | ||
94 | |||
95 | static const struct soc_enum wm8974_auxmode = | ||
96 | SOC_ENUM_SINGLE(WM8974_INPUT, 3, 2, wm8974_auxmode_text); | ||
97 | |||
98 | static const DECLARE_TLV_DB_SCALE(digital_tlv, -12750, 50, 1); | ||
99 | static const DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0); | ||
100 | static const DECLARE_TLV_DB_SCALE(inpga_tlv, -1200, 75, 0); | ||
101 | static const DECLARE_TLV_DB_SCALE(spk_tlv, -5700, 100, 0); | ||
102 | |||
103 | static const struct snd_kcontrol_new wm8974_snd_controls[] = { | ||
104 | |||
105 | SOC_SINGLE("Digital Loopback Switch", WM8974_COMP, 0, 1, 0), | ||
106 | |||
107 | SOC_ENUM("DAC Companding", wm8974_enum[1]), | ||
108 | SOC_ENUM("ADC Companding", wm8974_enum[0]), | ||
109 | |||
110 | SOC_ENUM("Playback De-emphasis", wm8974_enum[2]), | ||
111 | SOC_SINGLE("DAC Inversion Switch", WM8974_DAC, 0, 1, 0), | ||
112 | |||
113 | SOC_SINGLE_TLV("PCM Volume", WM8974_DACVOL, 0, 255, 0, digital_tlv), | ||
114 | |||
115 | SOC_SINGLE("High Pass Filter Switch", WM8974_ADC, 8, 1, 0), | ||
116 | SOC_SINGLE("High Pass Cut Off", WM8974_ADC, 4, 7, 0), | ||
117 | SOC_SINGLE("ADC Inversion Switch", WM8974_ADC, 0, 1, 0), | ||
118 | |||
119 | SOC_SINGLE_TLV("Capture Volume", WM8974_ADCVOL, 0, 255, 0, digital_tlv), | ||
120 | |||
121 | SOC_ENUM("Equaliser Function", wm8974_enum[3]), | ||
122 | SOC_ENUM("EQ1 Cut Off", wm8974_enum[4]), | ||
123 | SOC_SINGLE_TLV("EQ1 Volume", WM8974_EQ1, 0, 24, 1, eq_tlv), | ||
124 | |||
125 | SOC_ENUM("Equaliser EQ2 Bandwith", wm8974_enum[5]), | ||
126 | SOC_ENUM("EQ2 Cut Off", wm8974_enum[6]), | ||
127 | SOC_SINGLE_TLV("EQ2 Volume", WM8974_EQ2, 0, 24, 1, eq_tlv), | ||
128 | |||
129 | SOC_ENUM("Equaliser EQ3 Bandwith", wm8974_enum[7]), | ||
130 | SOC_ENUM("EQ3 Cut Off", wm8974_enum[8]), | ||
131 | SOC_SINGLE_TLV("EQ3 Volume", WM8974_EQ3, 0, 24, 1, eq_tlv), | ||
132 | |||
133 | SOC_ENUM("Equaliser EQ4 Bandwith", wm8974_enum[9]), | ||
134 | SOC_ENUM("EQ4 Cut Off", wm8974_enum[10]), | ||
135 | SOC_SINGLE_TLV("EQ4 Volume", WM8974_EQ4, 0, 24, 1, eq_tlv), | ||
136 | |||
137 | SOC_ENUM("Equaliser EQ5 Bandwith", wm8974_enum[11]), | ||
138 | SOC_ENUM("EQ5 Cut Off", wm8974_enum[12]), | ||
139 | SOC_SINGLE_TLV("EQ5 Volume", WM8974_EQ5, 0, 24, 1, eq_tlv), | ||
140 | |||
141 | SOC_SINGLE("DAC Playback Limiter Switch", WM8974_DACLIM1, 8, 1, 0), | ||
142 | SOC_SINGLE("DAC Playback Limiter Decay", WM8974_DACLIM1, 4, 15, 0), | ||
143 | SOC_SINGLE("DAC Playback Limiter Attack", WM8974_DACLIM1, 0, 15, 0), | ||
144 | |||
145 | SOC_SINGLE("DAC Playback Limiter Threshold", WM8974_DACLIM2, 4, 7, 0), | ||
146 | SOC_SINGLE("DAC Playback Limiter Boost", WM8974_DACLIM2, 0, 15, 0), | ||
147 | |||
148 | SOC_SINGLE("ALC Enable Switch", WM8974_ALC1, 8, 1, 0), | ||
149 | SOC_SINGLE("ALC Capture Max Gain", WM8974_ALC1, 3, 7, 0), | ||
150 | SOC_SINGLE("ALC Capture Min Gain", WM8974_ALC1, 0, 7, 0), | ||
151 | |||
152 | SOC_SINGLE("ALC Capture ZC Switch", WM8974_ALC2, 8, 1, 0), | ||
153 | SOC_SINGLE("ALC Capture Hold", WM8974_ALC2, 4, 7, 0), | ||
154 | SOC_SINGLE("ALC Capture Target", WM8974_ALC2, 0, 15, 0), | ||
155 | |||
156 | SOC_ENUM("ALC Capture Mode", wm8974_enum[13]), | ||
157 | SOC_SINGLE("ALC Capture Decay", WM8974_ALC3, 4, 15, 0), | ||
158 | SOC_SINGLE("ALC Capture Attack", WM8974_ALC3, 0, 15, 0), | ||
159 | |||
160 | SOC_SINGLE("ALC Capture Noise Gate Switch", WM8974_NGATE, 3, 1, 0), | ||
161 | SOC_SINGLE("ALC Capture Noise Gate Threshold", WM8974_NGATE, 0, 7, 0), | ||
162 | |||
163 | SOC_SINGLE("Capture PGA ZC Switch", WM8974_INPPGA, 7, 1, 0), | ||
164 | SOC_SINGLE_TLV("Capture PGA Volume", WM8974_INPPGA, 0, 63, 0, inpga_tlv), | ||
165 | |||
166 | SOC_SINGLE("Speaker Playback ZC Switch", WM8974_SPKVOL, 7, 1, 0), | ||
167 | SOC_SINGLE("Speaker Playback Switch", WM8974_SPKVOL, 6, 1, 1), | ||
168 | SOC_SINGLE_TLV("Speaker Playback Volume", WM8974_SPKVOL, 0, 63, 0, spk_tlv), | ||
169 | |||
170 | SOC_ENUM("Aux Mode", wm8974_auxmode), | ||
171 | |||
172 | SOC_SINGLE("Capture Boost(+20dB)", WM8974_ADCBOOST, 8, 1, 0), | ||
173 | SOC_SINGLE("Mono Playback Switch", WM8974_MONOMIX, 6, 1, 1), | ||
174 | }; | ||
175 | |||
176 | /* Speaker Output Mixer */ | ||
177 | static const struct snd_kcontrol_new wm8974_speaker_mixer_controls[] = { | ||
178 | SOC_DAPM_SINGLE("Line Bypass Switch", WM8974_SPKMIX, 1, 1, 0), | ||
179 | SOC_DAPM_SINGLE("Aux Playback Switch", WM8974_SPKMIX, 5, 1, 0), | ||
180 | SOC_DAPM_SINGLE("PCM Playback Switch", WM8974_SPKMIX, 0, 1, 1), | ||
181 | }; | ||
182 | |||
183 | /* Mono Output Mixer */ | ||
184 | static const struct snd_kcontrol_new wm8974_mono_mixer_controls[] = { | ||
185 | SOC_DAPM_SINGLE("Line Bypass Switch", WM8974_MONOMIX, 1, 1, 0), | ||
186 | SOC_DAPM_SINGLE("Aux Playback Switch", WM8974_MONOMIX, 2, 1, 0), | ||
187 | SOC_DAPM_SINGLE("PCM Playback Switch", WM8974_MONOMIX, 0, 1, 0), | ||
188 | }; | ||
189 | |||
190 | /* Boost mixer */ | ||
191 | static const struct snd_kcontrol_new wm8974_boost_mixer[] = { | ||
192 | SOC_DAPM_SINGLE("Aux Switch", WM8974_INPPGA, 6, 1, 0), | ||
193 | }; | ||
194 | |||
195 | /* Input PGA */ | ||
196 | static const struct snd_kcontrol_new wm8974_inpga[] = { | ||
197 | SOC_DAPM_SINGLE("Aux Switch", WM8974_INPUT, 2, 1, 0), | ||
198 | SOC_DAPM_SINGLE("MicN Switch", WM8974_INPUT, 1, 1, 0), | ||
199 | SOC_DAPM_SINGLE("MicP Switch", WM8974_INPUT, 0, 1, 0), | ||
200 | }; | ||
201 | |||
202 | /* AUX Input boost vol */ | ||
203 | static const struct snd_kcontrol_new wm8974_aux_boost_controls = | ||
204 | SOC_DAPM_SINGLE("Aux Volume", WM8974_ADCBOOST, 0, 7, 0); | ||
205 | |||
206 | /* Mic Input boost vol */ | ||
207 | static const struct snd_kcontrol_new wm8974_mic_boost_controls = | ||
208 | SOC_DAPM_SINGLE("Mic Volume", WM8974_ADCBOOST, 4, 7, 0); | ||
209 | |||
210 | static const struct snd_soc_dapm_widget wm8974_dapm_widgets[] = { | ||
211 | SND_SOC_DAPM_MIXER("Speaker Mixer", WM8974_POWER3, 2, 0, | ||
212 | &wm8974_speaker_mixer_controls[0], | ||
213 | ARRAY_SIZE(wm8974_speaker_mixer_controls)), | ||
214 | SND_SOC_DAPM_MIXER("Mono Mixer", WM8974_POWER3, 3, 0, | ||
215 | &wm8974_mono_mixer_controls[0], | ||
216 | ARRAY_SIZE(wm8974_mono_mixer_controls)), | ||
217 | SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8974_POWER3, 0, 0), | ||
218 | SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8974_POWER2, 0, 0), | ||
219 | SND_SOC_DAPM_PGA("Aux Input", WM8974_POWER1, 6, 0, NULL, 0), | ||
220 | SND_SOC_DAPM_PGA("SpkN Out", WM8974_POWER3, 5, 0, NULL, 0), | ||
221 | SND_SOC_DAPM_PGA("SpkP Out", WM8974_POWER3, 6, 0, NULL, 0), | ||
222 | SND_SOC_DAPM_PGA("Mono Out", WM8974_POWER3, 7, 0, NULL, 0), | ||
223 | |||
224 | SND_SOC_DAPM_MIXER("Input PGA", WM8974_POWER2, 2, 0, wm8974_inpga, | ||
225 | ARRAY_SIZE(wm8974_inpga)), | ||
226 | SND_SOC_DAPM_MIXER("Boost Mixer", WM8974_POWER2, 4, 0, | ||
227 | wm8974_boost_mixer, ARRAY_SIZE(wm8974_boost_mixer)), | ||
228 | |||
229 | SND_SOC_DAPM_MICBIAS("Mic Bias", WM8974_POWER1, 4, 0), | ||
230 | |||
231 | SND_SOC_DAPM_INPUT("MICN"), | ||
232 | SND_SOC_DAPM_INPUT("MICP"), | ||
233 | SND_SOC_DAPM_INPUT("AUX"), | ||
234 | SND_SOC_DAPM_OUTPUT("MONOOUT"), | ||
235 | SND_SOC_DAPM_OUTPUT("SPKOUTP"), | ||
236 | SND_SOC_DAPM_OUTPUT("SPKOUTN"), | ||
237 | }; | ||
238 | |||
239 | static const struct snd_soc_dapm_route audio_map[] = { | ||
240 | /* Mono output mixer */ | ||
241 | {"Mono Mixer", "PCM Playback Switch", "DAC"}, | ||
242 | {"Mono Mixer", "Aux Playback Switch", "Aux Input"}, | ||
243 | {"Mono Mixer", "Line Bypass Switch", "Boost Mixer"}, | ||
244 | |||
245 | /* Speaker output mixer */ | ||
246 | {"Speaker Mixer", "PCM Playback Switch", "DAC"}, | ||
247 | {"Speaker Mixer", "Aux Playback Switch", "Aux Input"}, | ||
248 | {"Speaker Mixer", "Line Bypass Switch", "Boost Mixer"}, | ||
249 | |||
250 | /* Outputs */ | ||
251 | {"Mono Out", NULL, "Mono Mixer"}, | ||
252 | {"MONOOUT", NULL, "Mono Out"}, | ||
253 | {"SpkN Out", NULL, "Speaker Mixer"}, | ||
254 | {"SpkP Out", NULL, "Speaker Mixer"}, | ||
255 | {"SPKOUTN", NULL, "SpkN Out"}, | ||
256 | {"SPKOUTP", NULL, "SpkP Out"}, | ||
257 | |||
258 | /* Boost Mixer */ | ||
259 | {"ADC", NULL, "Boost Mixer"}, | ||
260 | {"Boost Mixer", "Aux Switch", "Aux Input"}, | ||
261 | {"Boost Mixer", NULL, "Input PGA"}, | ||
262 | {"Boost Mixer", NULL, "MICP"}, | ||
263 | |||
264 | /* Input PGA */ | ||
265 | {"Input PGA", "Aux Switch", "Aux Input"}, | ||
266 | {"Input PGA", "MicN Switch", "MICN"}, | ||
267 | {"Input PGA", "MicP Switch", "MICP"}, | ||
268 | |||
269 | /* Inputs */ | ||
270 | {"Aux Input", NULL, "AUX"}, | ||
271 | }; | ||
272 | |||
273 | static int wm8974_add_widgets(struct snd_soc_codec *codec) | ||
274 | { | ||
275 | snd_soc_dapm_new_controls(codec, wm8974_dapm_widgets, | ||
276 | ARRAY_SIZE(wm8974_dapm_widgets)); | ||
277 | |||
278 | snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map)); | ||
279 | |||
280 | snd_soc_dapm_new_widgets(codec); | ||
281 | return 0; | ||
282 | } | ||
283 | |||
284 | struct pll_ { | ||
285 | unsigned int pre_div:4; /* prescale - 1 */ | ||
286 | unsigned int n:4; | ||
287 | unsigned int k; | ||
288 | }; | ||
289 | |||
290 | static struct pll_ pll_div; | ||
291 | |||
292 | /* The size in bits of the pll divide multiplied by 10 | ||
293 | * to allow rounding later */ | ||
294 | #define FIXED_PLL_SIZE ((1 << 24) * 10) | ||
295 | |||
296 | static void pll_factors(unsigned int target, unsigned int source) | ||
297 | { | ||
298 | unsigned long long Kpart; | ||
299 | unsigned int K, Ndiv, Nmod; | ||
300 | |||
301 | Ndiv = target / source; | ||
302 | if (Ndiv < 6) { | ||
303 | source >>= 1; | ||
304 | pll_div.pre_div = 1; | ||
305 | Ndiv = target / source; | ||
306 | } else | ||
307 | pll_div.pre_div = 0; | ||
308 | |||
309 | if ((Ndiv < 6) || (Ndiv > 12)) | ||
310 | printk(KERN_WARNING | ||
311 | "WM8974 N value %u outwith recommended range!\n", | ||
312 | Ndiv); | ||
313 | |||
314 | pll_div.n = Ndiv; | ||
315 | Nmod = target % source; | ||
316 | Kpart = FIXED_PLL_SIZE * (long long)Nmod; | ||
317 | |||
318 | do_div(Kpart, source); | ||
319 | |||
320 | K = Kpart & 0xFFFFFFFF; | ||
321 | |||
322 | /* Check if we need to round */ | ||
323 | if ((K % 10) >= 5) | ||
324 | K += 5; | ||
325 | |||
326 | /* Move down to proper range now rounding is done */ | ||
327 | K /= 10; | ||
328 | |||
329 | pll_div.k = K; | ||
330 | } | ||
331 | |||
332 | static int wm8974_set_dai_pll(struct snd_soc_dai *codec_dai, | ||
333 | int pll_id, unsigned int freq_in, unsigned int freq_out) | ||
334 | { | ||
335 | struct snd_soc_codec *codec = codec_dai->codec; | ||
336 | u16 reg; | ||
337 | |||
338 | if (freq_in == 0 || freq_out == 0) { | ||
339 | /* Clock CODEC directly from MCLK */ | ||
340 | reg = snd_soc_read(codec, WM8974_CLOCK); | ||
341 | snd_soc_write(codec, WM8974_CLOCK, reg & 0x0ff); | ||
342 | |||
343 | /* Turn off PLL */ | ||
344 | reg = snd_soc_read(codec, WM8974_POWER1); | ||
345 | snd_soc_write(codec, WM8974_POWER1, reg & 0x1df); | ||
346 | return 0; | ||
347 | } | ||
348 | |||
349 | pll_factors(freq_out*4, freq_in); | ||
350 | |||
351 | snd_soc_write(codec, WM8974_PLLN, (pll_div.pre_div << 4) | pll_div.n); | ||
352 | snd_soc_write(codec, WM8974_PLLK1, pll_div.k >> 18); | ||
353 | snd_soc_write(codec, WM8974_PLLK2, (pll_div.k >> 9) & 0x1ff); | ||
354 | snd_soc_write(codec, WM8974_PLLK3, pll_div.k & 0x1ff); | ||
355 | reg = snd_soc_read(codec, WM8974_POWER1); | ||
356 | snd_soc_write(codec, WM8974_POWER1, reg | 0x020); | ||
357 | |||
358 | /* Run CODEC from PLL instead of MCLK */ | ||
359 | reg = snd_soc_read(codec, WM8974_CLOCK); | ||
360 | snd_soc_write(codec, WM8974_CLOCK, reg | 0x100); | ||
361 | |||
362 | return 0; | ||
363 | } | ||
364 | |||
365 | /* | ||
366 | * Configure WM8974 clock dividers. | ||
367 | */ | ||
368 | static int wm8974_set_dai_clkdiv(struct snd_soc_dai *codec_dai, | ||
369 | int div_id, int div) | ||
370 | { | ||
371 | struct snd_soc_codec *codec = codec_dai->codec; | ||
372 | u16 reg; | ||
373 | |||
374 | switch (div_id) { | ||
375 | case WM8974_OPCLKDIV: | ||
376 | reg = snd_soc_read(codec, WM8974_GPIO) & 0x1cf; | ||
377 | snd_soc_write(codec, WM8974_GPIO, reg | div); | ||
378 | break; | ||
379 | case WM8974_MCLKDIV: | ||
380 | reg = snd_soc_read(codec, WM8974_CLOCK) & 0x11f; | ||
381 | snd_soc_write(codec, WM8974_CLOCK, reg | div); | ||
382 | break; | ||
383 | case WM8974_ADCCLK: | ||
384 | reg = snd_soc_read(codec, WM8974_ADC) & 0x1f7; | ||
385 | snd_soc_write(codec, WM8974_ADC, reg | div); | ||
386 | break; | ||
387 | case WM8974_DACCLK: | ||
388 | reg = snd_soc_read(codec, WM8974_DAC) & 0x1f7; | ||
389 | snd_soc_write(codec, WM8974_DAC, reg | div); | ||
390 | break; | ||
391 | case WM8974_BCLKDIV: | ||
392 | reg = snd_soc_read(codec, WM8974_CLOCK) & 0x1e3; | ||
393 | snd_soc_write(codec, WM8974_CLOCK, reg | div); | ||
394 | break; | ||
395 | default: | ||
396 | return -EINVAL; | ||
397 | } | ||
398 | |||
399 | return 0; | ||
400 | } | ||
401 | |||
402 | static int wm8974_set_dai_fmt(struct snd_soc_dai *codec_dai, | ||
403 | unsigned int fmt) | ||
404 | { | ||
405 | struct snd_soc_codec *codec = codec_dai->codec; | ||
406 | u16 iface = 0; | ||
407 | u16 clk = snd_soc_read(codec, WM8974_CLOCK) & 0x1fe; | ||
408 | |||
409 | /* set master/slave audio interface */ | ||
410 | switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { | ||
411 | case SND_SOC_DAIFMT_CBM_CFM: | ||
412 | clk |= 0x0001; | ||
413 | break; | ||
414 | case SND_SOC_DAIFMT_CBS_CFS: | ||
415 | break; | ||
416 | default: | ||
417 | return -EINVAL; | ||
418 | } | ||
419 | |||
420 | /* interface format */ | ||
421 | switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { | ||
422 | case SND_SOC_DAIFMT_I2S: | ||
423 | iface |= 0x0010; | ||
424 | break; | ||
425 | case SND_SOC_DAIFMT_RIGHT_J: | ||
426 | break; | ||
427 | case SND_SOC_DAIFMT_LEFT_J: | ||
428 | iface |= 0x0008; | ||
429 | break; | ||
430 | case SND_SOC_DAIFMT_DSP_A: | ||
431 | iface |= 0x00018; | ||
432 | break; | ||
433 | default: | ||
434 | return -EINVAL; | ||
435 | } | ||
436 | |||
437 | /* clock inversion */ | ||
438 | switch (fmt & SND_SOC_DAIFMT_INV_MASK) { | ||
439 | case SND_SOC_DAIFMT_NB_NF: | ||
440 | break; | ||
441 | case SND_SOC_DAIFMT_IB_IF: | ||
442 | iface |= 0x0180; | ||
443 | break; | ||
444 | case SND_SOC_DAIFMT_IB_NF: | ||
445 | iface |= 0x0100; | ||
446 | break; | ||
447 | case SND_SOC_DAIFMT_NB_IF: | ||
448 | iface |= 0x0080; | ||
449 | break; | ||
450 | default: | ||
451 | return -EINVAL; | ||
452 | } | ||
453 | |||
454 | snd_soc_write(codec, WM8974_IFACE, iface); | ||
455 | snd_soc_write(codec, WM8974_CLOCK, clk); | ||
456 | return 0; | ||
457 | } | ||
458 | |||
459 | static int wm8974_pcm_hw_params(struct snd_pcm_substream *substream, | ||
460 | struct snd_pcm_hw_params *params, | ||
461 | struct snd_soc_dai *dai) | ||
462 | { | ||
463 | struct snd_soc_codec *codec = dai->codec; | ||
464 | u16 iface = snd_soc_read(codec, WM8974_IFACE) & 0x19f; | ||
465 | u16 adn = snd_soc_read(codec, WM8974_ADD) & 0x1f1; | ||
466 | |||
467 | /* bit size */ | ||
468 | switch (params_format(params)) { | ||
469 | case SNDRV_PCM_FORMAT_S16_LE: | ||
470 | break; | ||
471 | case SNDRV_PCM_FORMAT_S20_3LE: | ||
472 | iface |= 0x0020; | ||
473 | break; | ||
474 | case SNDRV_PCM_FORMAT_S24_LE: | ||
475 | iface |= 0x0040; | ||
476 | break; | ||
477 | case SNDRV_PCM_FORMAT_S32_LE: | ||
478 | iface |= 0x0060; | ||
479 | break; | ||
480 | } | ||
481 | |||
482 | /* filter coefficient */ | ||
483 | switch (params_rate(params)) { | ||
484 | case SNDRV_PCM_RATE_8000: | ||
485 | adn |= 0x5 << 1; | ||
486 | break; | ||
487 | case SNDRV_PCM_RATE_11025: | ||
488 | adn |= 0x4 << 1; | ||
489 | break; | ||
490 | case SNDRV_PCM_RATE_16000: | ||
491 | adn |= 0x3 << 1; | ||
492 | break; | ||
493 | case SNDRV_PCM_RATE_22050: | ||
494 | adn |= 0x2 << 1; | ||
495 | break; | ||
496 | case SNDRV_PCM_RATE_32000: | ||
497 | adn |= 0x1 << 1; | ||
498 | break; | ||
499 | case SNDRV_PCM_RATE_44100: | ||
500 | case SNDRV_PCM_RATE_48000: | ||
501 | break; | ||
502 | } | ||
503 | |||
504 | snd_soc_write(codec, WM8974_IFACE, iface); | ||
505 | snd_soc_write(codec, WM8974_ADD, adn); | ||
506 | return 0; | ||
507 | } | ||
508 | |||
509 | static int wm8974_mute(struct snd_soc_dai *dai, int mute) | ||
510 | { | ||
511 | struct snd_soc_codec *codec = dai->codec; | ||
512 | u16 mute_reg = snd_soc_read(codec, WM8974_DAC) & 0xffbf; | ||
513 | |||
514 | if (mute) | ||
515 | snd_soc_write(codec, WM8974_DAC, mute_reg | 0x40); | ||
516 | else | ||
517 | snd_soc_write(codec, WM8974_DAC, mute_reg); | ||
518 | return 0; | ||
519 | } | ||
520 | |||
521 | /* liam need to make this lower power with dapm */ | ||
522 | static int wm8974_set_bias_level(struct snd_soc_codec *codec, | ||
523 | enum snd_soc_bias_level level) | ||
524 | { | ||
525 | u16 power1 = snd_soc_read(codec, WM8974_POWER1) & ~0x3; | ||
526 | |||
527 | switch (level) { | ||
528 | case SND_SOC_BIAS_ON: | ||
529 | case SND_SOC_BIAS_PREPARE: | ||
530 | power1 |= 0x1; /* VMID 50k */ | ||
531 | snd_soc_write(codec, WM8974_POWER1, power1); | ||
532 | break; | ||
533 | |||
534 | case SND_SOC_BIAS_STANDBY: | ||
535 | power1 |= WM8974_POWER1_BIASEN | WM8974_POWER1_BUFIOEN; | ||
536 | |||
537 | if (codec->bias_level == SND_SOC_BIAS_OFF) { | ||
538 | /* Initial cap charge at VMID 5k */ | ||
539 | snd_soc_write(codec, WM8974_POWER1, power1 | 0x3); | ||
540 | mdelay(100); | ||
541 | } | ||
542 | |||
543 | power1 |= 0x2; /* VMID 500k */ | ||
544 | snd_soc_write(codec, WM8974_POWER1, power1); | ||
545 | break; | ||
546 | |||
547 | case SND_SOC_BIAS_OFF: | ||
548 | snd_soc_write(codec, WM8974_POWER1, 0); | ||
549 | snd_soc_write(codec, WM8974_POWER2, 0); | ||
550 | snd_soc_write(codec, WM8974_POWER3, 0); | ||
551 | break; | ||
552 | } | ||
553 | |||
554 | codec->bias_level = level; | ||
555 | return 0; | ||
556 | } | ||
557 | |||
558 | #define WM8974_RATES (SNDRV_PCM_RATE_8000_48000) | ||
559 | |||
560 | #define WM8974_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ | ||
561 | SNDRV_PCM_FMTBIT_S24_LE) | ||
562 | |||
563 | static struct snd_soc_dai_ops wm8974_ops = { | ||
564 | .hw_params = wm8974_pcm_hw_params, | ||
565 | .digital_mute = wm8974_mute, | ||
566 | .set_fmt = wm8974_set_dai_fmt, | ||
567 | .set_clkdiv = wm8974_set_dai_clkdiv, | ||
568 | .set_pll = wm8974_set_dai_pll, | ||
569 | }; | ||
570 | |||
571 | struct snd_soc_dai wm8974_dai = { | ||
572 | .name = "WM8974 HiFi", | ||
573 | .playback = { | ||
574 | .stream_name = "Playback", | ||
575 | .channels_min = 1, | ||
576 | .channels_max = 2, /* Only 1 channel of data */ | ||
577 | .rates = WM8974_RATES, | ||
578 | .formats = WM8974_FORMATS,}, | ||
579 | .capture = { | ||
580 | .stream_name = "Capture", | ||
581 | .channels_min = 1, | ||
582 | .channels_max = 2, /* Only 1 channel of data */ | ||
583 | .rates = WM8974_RATES, | ||
584 | .formats = WM8974_FORMATS,}, | ||
585 | .ops = &wm8974_ops, | ||
586 | .symmetric_rates = 1, | ||
587 | }; | ||
588 | EXPORT_SYMBOL_GPL(wm8974_dai); | ||
589 | |||
590 | static int wm8974_suspend(struct platform_device *pdev, pm_message_t state) | ||
591 | { | ||
592 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
593 | struct snd_soc_codec *codec = socdev->card->codec; | ||
594 | |||
595 | wm8974_set_bias_level(codec, SND_SOC_BIAS_OFF); | ||
596 | return 0; | ||
597 | } | ||
598 | |||
599 | static int wm8974_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 | int i; | ||
604 | u8 data[2]; | ||
605 | u16 *cache = codec->reg_cache; | ||
606 | |||
607 | /* Sync reg_cache with the hardware */ | ||
608 | for (i = 0; i < ARRAY_SIZE(wm8974_reg); i++) { | ||
609 | data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001); | ||
610 | data[1] = cache[i] & 0x00ff; | ||
611 | codec->hw_write(codec->control_data, data, 2); | ||
612 | } | ||
613 | wm8974_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | ||
614 | wm8974_set_bias_level(codec, codec->suspend_bias_level); | ||
615 | return 0; | ||
616 | } | ||
617 | |||
618 | static int wm8974_probe(struct platform_device *pdev) | ||
619 | { | ||
620 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
621 | struct snd_soc_codec *codec; | ||
622 | int ret = 0; | ||
623 | |||
624 | if (wm8974_codec == NULL) { | ||
625 | dev_err(&pdev->dev, "Codec device not registered\n"); | ||
626 | return -ENODEV; | ||
627 | } | ||
628 | |||
629 | socdev->card->codec = wm8974_codec; | ||
630 | codec = wm8974_codec; | ||
631 | |||
632 | /* register pcms */ | ||
633 | ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1); | ||
634 | if (ret < 0) { | ||
635 | dev_err(codec->dev, "failed to create pcms: %d\n", ret); | ||
636 | goto pcm_err; | ||
637 | } | ||
638 | |||
639 | snd_soc_add_controls(codec, wm8974_snd_controls, | ||
640 | ARRAY_SIZE(wm8974_snd_controls)); | ||
641 | wm8974_add_widgets(codec); | ||
642 | ret = snd_soc_init_card(socdev); | ||
643 | if (ret < 0) { | ||
644 | dev_err(codec->dev, "failed to register card: %d\n", ret); | ||
645 | goto card_err; | ||
646 | } | ||
647 | |||
648 | return ret; | ||
649 | |||
650 | card_err: | ||
651 | snd_soc_free_pcms(socdev); | ||
652 | snd_soc_dapm_free(socdev); | ||
653 | pcm_err: | ||
654 | return ret; | ||
655 | } | ||
656 | |||
657 | /* power down chip */ | ||
658 | static int wm8974_remove(struct platform_device *pdev) | ||
659 | { | ||
660 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
661 | |||
662 | snd_soc_free_pcms(socdev); | ||
663 | snd_soc_dapm_free(socdev); | ||
664 | |||
665 | return 0; | ||
666 | } | ||
667 | |||
668 | struct snd_soc_codec_device soc_codec_dev_wm8974 = { | ||
669 | .probe = wm8974_probe, | ||
670 | .remove = wm8974_remove, | ||
671 | .suspend = wm8974_suspend, | ||
672 | .resume = wm8974_resume, | ||
673 | }; | ||
674 | EXPORT_SYMBOL_GPL(soc_codec_dev_wm8974); | ||
675 | |||
676 | static __devinit int wm8974_register(struct wm8974_priv *wm8974) | ||
677 | { | ||
678 | int ret; | ||
679 | struct snd_soc_codec *codec = &wm8974->codec; | ||
680 | |||
681 | if (wm8974_codec) { | ||
682 | dev_err(codec->dev, "Another WM8974 is registered\n"); | ||
683 | return -EINVAL; | ||
684 | } | ||
685 | |||
686 | mutex_init(&codec->mutex); | ||
687 | INIT_LIST_HEAD(&codec->dapm_widgets); | ||
688 | INIT_LIST_HEAD(&codec->dapm_paths); | ||
689 | |||
690 | codec->private_data = wm8974; | ||
691 | codec->name = "WM8974"; | ||
692 | codec->owner = THIS_MODULE; | ||
693 | codec->bias_level = SND_SOC_BIAS_OFF; | ||
694 | codec->set_bias_level = wm8974_set_bias_level; | ||
695 | codec->dai = &wm8974_dai; | ||
696 | codec->num_dai = 1; | ||
697 | codec->reg_cache_size = WM8974_CACHEREGNUM; | ||
698 | codec->reg_cache = &wm8974->reg_cache; | ||
699 | |||
700 | ret = snd_soc_codec_set_cache_io(codec, 7, 9, SND_SOC_I2C); | ||
701 | if (ret < 0) { | ||
702 | dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret); | ||
703 | goto err; | ||
704 | } | ||
705 | |||
706 | memcpy(codec->reg_cache, wm8974_reg, sizeof(wm8974_reg)); | ||
707 | |||
708 | ret = wm8974_reset(codec); | ||
709 | if (ret < 0) { | ||
710 | dev_err(codec->dev, "Failed to issue reset\n"); | ||
711 | goto err; | ||
712 | } | ||
713 | |||
714 | wm8974_dai.dev = codec->dev; | ||
715 | |||
716 | wm8974_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | ||
717 | |||
718 | wm8974_codec = codec; | ||
719 | |||
720 | ret = snd_soc_register_codec(codec); | ||
721 | if (ret != 0) { | ||
722 | dev_err(codec->dev, "Failed to register codec: %d\n", ret); | ||
723 | goto err; | ||
724 | } | ||
725 | |||
726 | ret = snd_soc_register_dai(&wm8974_dai); | ||
727 | if (ret != 0) { | ||
728 | dev_err(codec->dev, "Failed to register DAI: %d\n", ret); | ||
729 | goto err_codec; | ||
730 | } | ||
731 | |||
732 | return 0; | ||
733 | |||
734 | err_codec: | ||
735 | snd_soc_unregister_codec(codec); | ||
736 | err: | ||
737 | kfree(wm8974); | ||
738 | return ret; | ||
739 | } | ||
740 | |||
741 | static __devexit void wm8974_unregister(struct wm8974_priv *wm8974) | ||
742 | { | ||
743 | wm8974_set_bias_level(&wm8974->codec, SND_SOC_BIAS_OFF); | ||
744 | snd_soc_unregister_dai(&wm8974_dai); | ||
745 | snd_soc_unregister_codec(&wm8974->codec); | ||
746 | kfree(wm8974); | ||
747 | wm8974_codec = NULL; | ||
748 | } | ||
749 | |||
750 | static __devinit int wm8974_i2c_probe(struct i2c_client *i2c, | ||
751 | const struct i2c_device_id *id) | ||
752 | { | ||
753 | struct wm8974_priv *wm8974; | ||
754 | struct snd_soc_codec *codec; | ||
755 | |||
756 | wm8974 = kzalloc(sizeof(struct wm8974_priv), GFP_KERNEL); | ||
757 | if (wm8974 == NULL) | ||
758 | return -ENOMEM; | ||
759 | |||
760 | codec = &wm8974->codec; | ||
761 | codec->hw_write = (hw_write_t)i2c_master_send; | ||
762 | |||
763 | i2c_set_clientdata(i2c, wm8974); | ||
764 | codec->control_data = i2c; | ||
765 | |||
766 | codec->dev = &i2c->dev; | ||
767 | |||
768 | return wm8974_register(wm8974); | ||
769 | } | ||
770 | |||
771 | static __devexit int wm8974_i2c_remove(struct i2c_client *client) | ||
772 | { | ||
773 | struct wm8974_priv *wm8974 = i2c_get_clientdata(client); | ||
774 | wm8974_unregister(wm8974); | ||
775 | return 0; | ||
776 | } | ||
777 | |||
778 | static const struct i2c_device_id wm8974_i2c_id[] = { | ||
779 | { "wm8974", 0 }, | ||
780 | { } | ||
781 | }; | ||
782 | MODULE_DEVICE_TABLE(i2c, wm8974_i2c_id); | ||
783 | |||
784 | static struct i2c_driver wm8974_i2c_driver = { | ||
785 | .driver = { | ||
786 | .name = "WM8974", | ||
787 | .owner = THIS_MODULE, | ||
788 | }, | ||
789 | .probe = wm8974_i2c_probe, | ||
790 | .remove = __devexit_p(wm8974_i2c_remove), | ||
791 | .id_table = wm8974_i2c_id, | ||
792 | }; | ||
793 | |||
794 | static int __init wm8974_modinit(void) | ||
795 | { | ||
796 | return i2c_add_driver(&wm8974_i2c_driver); | ||
797 | } | ||
798 | module_init(wm8974_modinit); | ||
799 | |||
800 | static void __exit wm8974_exit(void) | ||
801 | { | ||
802 | i2c_del_driver(&wm8974_i2c_driver); | ||
803 | } | ||
804 | module_exit(wm8974_exit); | ||
805 | |||
806 | MODULE_DESCRIPTION("ASoC WM8974 driver"); | ||
807 | MODULE_AUTHOR("Liam Girdwood"); | ||
808 | MODULE_LICENSE("GPL"); | ||