ASoC: wm8960: Replace direct snd_soc_codec dapm field access
[deliverable/linux.git] / sound / soc / codecs / wm8960.c
1 /*
2 * wm8960.c -- WM8960 ALSA SoC Audio driver
3 *
4 * Copyright 2007-11 Wolfson Microelectronics, plc
5 *
6 * Author: Liam Girdwood
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/init.h>
16 #include <linux/delay.h>
17 #include <linux/pm.h>
18 #include <linux/clk.h>
19 #include <linux/i2c.h>
20 #include <linux/slab.h>
21 #include <sound/core.h>
22 #include <sound/pcm.h>
23 #include <sound/pcm_params.h>
24 #include <sound/soc.h>
25 #include <sound/initval.h>
26 #include <sound/tlv.h>
27 #include <sound/wm8960.h>
28
29 #include "wm8960.h"
30
31 /* R25 - Power 1 */
32 #define WM8960_VMID_MASK 0x180
33 #define WM8960_VREF 0x40
34
35 /* R26 - Power 2 */
36 #define WM8960_PWR2_LOUT1 0x40
37 #define WM8960_PWR2_ROUT1 0x20
38 #define WM8960_PWR2_OUT3 0x02
39
40 /* R28 - Anti-pop 1 */
41 #define WM8960_POBCTRL 0x80
42 #define WM8960_BUFDCOPEN 0x10
43 #define WM8960_BUFIOEN 0x08
44 #define WM8960_SOFT_ST 0x04
45 #define WM8960_HPSTBY 0x01
46
47 /* R29 - Anti-pop 2 */
48 #define WM8960_DISOP 0x40
49 #define WM8960_DRES_MASK 0x30
50
51 /*
52 * wm8960 register cache
53 * We can't read the WM8960 register space when we are
54 * using 2 wire for device control, so we cache them instead.
55 */
56 static const struct reg_default wm8960_reg_defaults[] = {
57 { 0x0, 0x00a7 },
58 { 0x1, 0x00a7 },
59 { 0x2, 0x0000 },
60 { 0x3, 0x0000 },
61 { 0x4, 0x0000 },
62 { 0x5, 0x0008 },
63 { 0x6, 0x0000 },
64 { 0x7, 0x000a },
65 { 0x8, 0x01c0 },
66 { 0x9, 0x0000 },
67 { 0xa, 0x00ff },
68 { 0xb, 0x00ff },
69
70 { 0x10, 0x0000 },
71 { 0x11, 0x007b },
72 { 0x12, 0x0100 },
73 { 0x13, 0x0032 },
74 { 0x14, 0x0000 },
75 { 0x15, 0x00c3 },
76 { 0x16, 0x00c3 },
77 { 0x17, 0x01c0 },
78 { 0x18, 0x0000 },
79 { 0x19, 0x0000 },
80 { 0x1a, 0x0000 },
81 { 0x1b, 0x0000 },
82 { 0x1c, 0x0000 },
83 { 0x1d, 0x0000 },
84
85 { 0x20, 0x0100 },
86 { 0x21, 0x0100 },
87 { 0x22, 0x0050 },
88
89 { 0x25, 0x0050 },
90 { 0x26, 0x0000 },
91 { 0x27, 0x0000 },
92 { 0x28, 0x0000 },
93 { 0x29, 0x0000 },
94 { 0x2a, 0x0040 },
95 { 0x2b, 0x0000 },
96 { 0x2c, 0x0000 },
97 { 0x2d, 0x0050 },
98 { 0x2e, 0x0050 },
99 { 0x2f, 0x0000 },
100 { 0x30, 0x0002 },
101 { 0x31, 0x0037 },
102
103 { 0x33, 0x0080 },
104 { 0x34, 0x0008 },
105 { 0x35, 0x0031 },
106 { 0x36, 0x0026 },
107 { 0x37, 0x00e9 },
108 };
109
110 static bool wm8960_volatile(struct device *dev, unsigned int reg)
111 {
112 switch (reg) {
113 case WM8960_RESET:
114 return true;
115 default:
116 return false;
117 }
118 }
119
120 struct wm8960_priv {
121 struct clk *mclk;
122 struct regmap *regmap;
123 int (*set_bias_level)(struct snd_soc_codec *,
124 enum snd_soc_bias_level level);
125 struct snd_soc_dapm_widget *lout1;
126 struct snd_soc_dapm_widget *rout1;
127 struct snd_soc_dapm_widget *out3;
128 bool deemph;
129 int playback_fs;
130 struct wm8960_data pdata;
131 };
132
133 #define wm8960_reset(c) regmap_write(c, WM8960_RESET, 0)
134
135 /* enumerated controls */
136 static const char *wm8960_polarity[] = {"No Inversion", "Left Inverted",
137 "Right Inverted", "Stereo Inversion"};
138 static const char *wm8960_3d_upper_cutoff[] = {"High", "Low"};
139 static const char *wm8960_3d_lower_cutoff[] = {"Low", "High"};
140 static const char *wm8960_alcfunc[] = {"Off", "Right", "Left", "Stereo"};
141 static const char *wm8960_alcmode[] = {"ALC", "Limiter"};
142
143 static const struct soc_enum wm8960_enum[] = {
144 SOC_ENUM_SINGLE(WM8960_DACCTL1, 5, 4, wm8960_polarity),
145 SOC_ENUM_SINGLE(WM8960_DACCTL2, 5, 4, wm8960_polarity),
146 SOC_ENUM_SINGLE(WM8960_3D, 6, 2, wm8960_3d_upper_cutoff),
147 SOC_ENUM_SINGLE(WM8960_3D, 5, 2, wm8960_3d_lower_cutoff),
148 SOC_ENUM_SINGLE(WM8960_ALC1, 7, 4, wm8960_alcfunc),
149 SOC_ENUM_SINGLE(WM8960_ALC3, 8, 2, wm8960_alcmode),
150 };
151
152 static const int deemph_settings[] = { 0, 32000, 44100, 48000 };
153
154 static int wm8960_set_deemph(struct snd_soc_codec *codec)
155 {
156 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
157 int val, i, best;
158
159 /* If we're using deemphasis select the nearest available sample
160 * rate.
161 */
162 if (wm8960->deemph) {
163 best = 1;
164 for (i = 2; i < ARRAY_SIZE(deemph_settings); i++) {
165 if (abs(deemph_settings[i] - wm8960->playback_fs) <
166 abs(deemph_settings[best] - wm8960->playback_fs))
167 best = i;
168 }
169
170 val = best << 1;
171 } else {
172 val = 0;
173 }
174
175 dev_dbg(codec->dev, "Set deemphasis %d\n", val);
176
177 return snd_soc_update_bits(codec, WM8960_DACCTL1,
178 0x6, val);
179 }
180
181 static int wm8960_get_deemph(struct snd_kcontrol *kcontrol,
182 struct snd_ctl_elem_value *ucontrol)
183 {
184 struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
185 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
186
187 ucontrol->value.integer.value[0] = wm8960->deemph;
188 return 0;
189 }
190
191 static int wm8960_put_deemph(struct snd_kcontrol *kcontrol,
192 struct snd_ctl_elem_value *ucontrol)
193 {
194 struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
195 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
196 int deemph = ucontrol->value.integer.value[0];
197
198 if (deemph > 1)
199 return -EINVAL;
200
201 wm8960->deemph = deemph;
202
203 return wm8960_set_deemph(codec);
204 }
205
206 static const DECLARE_TLV_DB_SCALE(adc_tlv, -9700, 50, 0);
207 static const DECLARE_TLV_DB_SCALE(dac_tlv, -12700, 50, 1);
208 static const DECLARE_TLV_DB_SCALE(bypass_tlv, -2100, 300, 0);
209 static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1);
210 static const DECLARE_TLV_DB_SCALE(boost_tlv, -1200, 300, 1);
211
212 static const struct snd_kcontrol_new wm8960_snd_controls[] = {
213 SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL, WM8960_RINVOL,
214 0, 63, 0, adc_tlv),
215 SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL, WM8960_RINVOL,
216 6, 1, 0),
217 SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL, WM8960_RINVOL,
218 7, 1, 0),
219
220 SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT3 Volume",
221 WM8960_INBMIX1, 4, 7, 0, boost_tlv),
222 SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT2 Volume",
223 WM8960_INBMIX1, 1, 7, 0, boost_tlv),
224 SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT3 Volume",
225 WM8960_INBMIX2, 4, 7, 0, boost_tlv),
226 SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT2 Volume",
227 WM8960_INBMIX2, 1, 7, 0, boost_tlv),
228
229 SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC, WM8960_RDAC,
230 0, 255, 0, dac_tlv),
231
232 SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1, WM8960_ROUT1,
233 0, 127, 0, out_tlv),
234 SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1, WM8960_ROUT1,
235 7, 1, 0),
236
237 SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2, WM8960_ROUT2,
238 0, 127, 0, out_tlv),
239 SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2, WM8960_ROUT2,
240 7, 1, 0),
241 SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3, 3, 5, 0),
242 SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3, 0, 5, 0),
243
244 SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1, 7, 1, 0),
245 SOC_ENUM("ADC Polarity", wm8960_enum[0]),
246 SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1, 0, 1, 0),
247
248 SOC_ENUM("DAC Polarity", wm8960_enum[2]),
249 SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0,
250 wm8960_get_deemph, wm8960_put_deemph),
251
252 SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum[2]),
253 SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum[3]),
254 SOC_SINGLE("3D Volume", WM8960_3D, 1, 15, 0),
255 SOC_SINGLE("3D Switch", WM8960_3D, 0, 1, 0),
256
257 SOC_ENUM("ALC Function", wm8960_enum[4]),
258 SOC_SINGLE("ALC Max Gain", WM8960_ALC1, 4, 7, 0),
259 SOC_SINGLE("ALC Target", WM8960_ALC1, 0, 15, 1),
260 SOC_SINGLE("ALC Min Gain", WM8960_ALC2, 4, 7, 0),
261 SOC_SINGLE("ALC Hold Time", WM8960_ALC2, 0, 15, 0),
262 SOC_ENUM("ALC Mode", wm8960_enum[5]),
263 SOC_SINGLE("ALC Decay", WM8960_ALC3, 4, 15, 0),
264 SOC_SINGLE("ALC Attack", WM8960_ALC3, 0, 15, 0),
265
266 SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG, 3, 31, 0),
267 SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG, 0, 1, 0),
268
269 SOC_DOUBLE_R_TLV("ADC PCM Capture Volume", WM8960_LADC, WM8960_RADC,
270 0, 255, 0, adc_tlv),
271
272 SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume",
273 WM8960_BYPASS1, 4, 7, 1, bypass_tlv),
274 SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume",
275 WM8960_LOUTMIX, 4, 7, 1, bypass_tlv),
276 SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume",
277 WM8960_BYPASS2, 4, 7, 1, bypass_tlv),
278 SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume",
279 WM8960_ROUTMIX, 4, 7, 1, bypass_tlv),
280 };
281
282 static const struct snd_kcontrol_new wm8960_lin_boost[] = {
283 SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH, 6, 1, 0),
284 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH, 7, 1, 0),
285 SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH, 8, 1, 0),
286 };
287
288 static const struct snd_kcontrol_new wm8960_lin[] = {
289 SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH, 3, 1, 0),
290 };
291
292 static const struct snd_kcontrol_new wm8960_rin_boost[] = {
293 SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH, 6, 1, 0),
294 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH, 7, 1, 0),
295 SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH, 8, 1, 0),
296 };
297
298 static const struct snd_kcontrol_new wm8960_rin[] = {
299 SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH, 3, 1, 0),
300 };
301
302 static const struct snd_kcontrol_new wm8960_loutput_mixer[] = {
303 SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX, 8, 1, 0),
304 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX, 7, 1, 0),
305 SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1, 7, 1, 0),
306 };
307
308 static const struct snd_kcontrol_new wm8960_routput_mixer[] = {
309 SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX, 8, 1, 0),
310 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX, 7, 1, 0),
311 SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2, 7, 1, 0),
312 };
313
314 static const struct snd_kcontrol_new wm8960_mono_out[] = {
315 SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1, 7, 1, 0),
316 SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2, 7, 1, 0),
317 };
318
319 static const struct snd_soc_dapm_widget wm8960_dapm_widgets[] = {
320 SND_SOC_DAPM_INPUT("LINPUT1"),
321 SND_SOC_DAPM_INPUT("RINPUT1"),
322 SND_SOC_DAPM_INPUT("LINPUT2"),
323 SND_SOC_DAPM_INPUT("RINPUT2"),
324 SND_SOC_DAPM_INPUT("LINPUT3"),
325 SND_SOC_DAPM_INPUT("RINPUT3"),
326
327 SND_SOC_DAPM_SUPPLY("MICB", WM8960_POWER1, 1, 0, NULL, 0),
328
329 SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1, 5, 0,
330 wm8960_lin_boost, ARRAY_SIZE(wm8960_lin_boost)),
331 SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1, 4, 0,
332 wm8960_rin_boost, ARRAY_SIZE(wm8960_rin_boost)),
333
334 SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3, 5, 0,
335 wm8960_lin, ARRAY_SIZE(wm8960_lin)),
336 SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3, 4, 0,
337 wm8960_rin, ARRAY_SIZE(wm8960_rin)),
338
339 SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER1, 3, 0),
340 SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER1, 2, 0),
341
342 SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2, 8, 0),
343 SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2, 7, 0),
344
345 SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3, 3, 0,
346 &wm8960_loutput_mixer[0],
347 ARRAY_SIZE(wm8960_loutput_mixer)),
348 SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3, 2, 0,
349 &wm8960_routput_mixer[0],
350 ARRAY_SIZE(wm8960_routput_mixer)),
351
352 SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2, 6, 0, NULL, 0),
353 SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2, 5, 0, NULL, 0),
354
355 SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2, 4, 0, NULL, 0),
356 SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2, 3, 0, NULL, 0),
357
358 SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1, 7, 0, NULL, 0),
359 SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1, 6, 0, NULL, 0),
360
361 SND_SOC_DAPM_OUTPUT("SPK_LP"),
362 SND_SOC_DAPM_OUTPUT("SPK_LN"),
363 SND_SOC_DAPM_OUTPUT("HP_L"),
364 SND_SOC_DAPM_OUTPUT("HP_R"),
365 SND_SOC_DAPM_OUTPUT("SPK_RP"),
366 SND_SOC_DAPM_OUTPUT("SPK_RN"),
367 SND_SOC_DAPM_OUTPUT("OUT3"),
368 };
369
370 static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3[] = {
371 SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2, 1, 0,
372 &wm8960_mono_out[0],
373 ARRAY_SIZE(wm8960_mono_out)),
374 };
375
376 /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */
377 static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless[] = {
378 SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2, 1, 0, NULL, 0),
379 };
380
381 static const struct snd_soc_dapm_route audio_paths[] = {
382 { "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" },
383 { "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" },
384 { "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" },
385
386 { "Left Input Mixer", "Boost Switch", "Left Boost Mixer", },
387 { "Left Input Mixer", NULL, "LINPUT1", }, /* Really Boost Switch */
388 { "Left Input Mixer", NULL, "LINPUT2" },
389 { "Left Input Mixer", NULL, "LINPUT3" },
390
391 { "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" },
392 { "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" },
393 { "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" },
394
395 { "Right Input Mixer", "Boost Switch", "Right Boost Mixer", },
396 { "Right Input Mixer", NULL, "RINPUT1", }, /* Really Boost Switch */
397 { "Right Input Mixer", NULL, "RINPUT2" },
398 { "Right Input Mixer", NULL, "LINPUT3" },
399
400 { "Left ADC", NULL, "Left Input Mixer" },
401 { "Right ADC", NULL, "Right Input Mixer" },
402
403 { "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" },
404 { "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer"} ,
405 { "Left Output Mixer", "PCM Playback Switch", "Left DAC" },
406
407 { "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" },
408 { "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" } ,
409 { "Right Output Mixer", "PCM Playback Switch", "Right DAC" },
410
411 { "LOUT1 PGA", NULL, "Left Output Mixer" },
412 { "ROUT1 PGA", NULL, "Right Output Mixer" },
413
414 { "HP_L", NULL, "LOUT1 PGA" },
415 { "HP_R", NULL, "ROUT1 PGA" },
416
417 { "Left Speaker PGA", NULL, "Left Output Mixer" },
418 { "Right Speaker PGA", NULL, "Right Output Mixer" },
419
420 { "Left Speaker Output", NULL, "Left Speaker PGA" },
421 { "Right Speaker Output", NULL, "Right Speaker PGA" },
422
423 { "SPK_LN", NULL, "Left Speaker Output" },
424 { "SPK_LP", NULL, "Left Speaker Output" },
425 { "SPK_RN", NULL, "Right Speaker Output" },
426 { "SPK_RP", NULL, "Right Speaker Output" },
427 };
428
429 static const struct snd_soc_dapm_route audio_paths_out3[] = {
430 { "Mono Output Mixer", "Left Switch", "Left Output Mixer" },
431 { "Mono Output Mixer", "Right Switch", "Right Output Mixer" },
432
433 { "OUT3", NULL, "Mono Output Mixer", }
434 };
435
436 static const struct snd_soc_dapm_route audio_paths_capless[] = {
437 { "HP_L", NULL, "OUT3 VMID" },
438 { "HP_R", NULL, "OUT3 VMID" },
439
440 { "OUT3 VMID", NULL, "Left Output Mixer" },
441 { "OUT3 VMID", NULL, "Right Output Mixer" },
442 };
443
444 static int wm8960_add_widgets(struct snd_soc_codec *codec)
445 {
446 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
447 struct wm8960_data *pdata = &wm8960->pdata;
448 struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
449 struct snd_soc_dapm_widget *w;
450
451 snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets,
452 ARRAY_SIZE(wm8960_dapm_widgets));
453
454 snd_soc_dapm_add_routes(dapm, audio_paths, ARRAY_SIZE(audio_paths));
455
456 /* In capless mode OUT3 is used to provide VMID for the
457 * headphone outputs, otherwise it is used as a mono mixer.
458 */
459 if (pdata && pdata->capless) {
460 snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_capless,
461 ARRAY_SIZE(wm8960_dapm_widgets_capless));
462
463 snd_soc_dapm_add_routes(dapm, audio_paths_capless,
464 ARRAY_SIZE(audio_paths_capless));
465 } else {
466 snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_out3,
467 ARRAY_SIZE(wm8960_dapm_widgets_out3));
468
469 snd_soc_dapm_add_routes(dapm, audio_paths_out3,
470 ARRAY_SIZE(audio_paths_out3));
471 }
472
473 /* We need to power up the headphone output stage out of
474 * sequence for capless mode. To save scanning the widget
475 * list each time to find the desired power state do so now
476 * and save the result.
477 */
478 list_for_each_entry(w, &codec->component.card->widgets, list) {
479 if (w->dapm != dapm)
480 continue;
481 if (strcmp(w->name, "LOUT1 PGA") == 0)
482 wm8960->lout1 = w;
483 if (strcmp(w->name, "ROUT1 PGA") == 0)
484 wm8960->rout1 = w;
485 if (strcmp(w->name, "OUT3 VMID") == 0)
486 wm8960->out3 = w;
487 }
488
489 return 0;
490 }
491
492 static int wm8960_set_dai_fmt(struct snd_soc_dai *codec_dai,
493 unsigned int fmt)
494 {
495 struct snd_soc_codec *codec = codec_dai->codec;
496 u16 iface = 0;
497
498 /* set master/slave audio interface */
499 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
500 case SND_SOC_DAIFMT_CBM_CFM:
501 iface |= 0x0040;
502 break;
503 case SND_SOC_DAIFMT_CBS_CFS:
504 break;
505 default:
506 return -EINVAL;
507 }
508
509 /* interface format */
510 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
511 case SND_SOC_DAIFMT_I2S:
512 iface |= 0x0002;
513 break;
514 case SND_SOC_DAIFMT_RIGHT_J:
515 break;
516 case SND_SOC_DAIFMT_LEFT_J:
517 iface |= 0x0001;
518 break;
519 case SND_SOC_DAIFMT_DSP_A:
520 iface |= 0x0003;
521 break;
522 case SND_SOC_DAIFMT_DSP_B:
523 iface |= 0x0013;
524 break;
525 default:
526 return -EINVAL;
527 }
528
529 /* clock inversion */
530 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
531 case SND_SOC_DAIFMT_NB_NF:
532 break;
533 case SND_SOC_DAIFMT_IB_IF:
534 iface |= 0x0090;
535 break;
536 case SND_SOC_DAIFMT_IB_NF:
537 iface |= 0x0080;
538 break;
539 case SND_SOC_DAIFMT_NB_IF:
540 iface |= 0x0010;
541 break;
542 default:
543 return -EINVAL;
544 }
545
546 /* set iface */
547 snd_soc_write(codec, WM8960_IFACE1, iface);
548 return 0;
549 }
550
551 static struct {
552 int rate;
553 unsigned int val;
554 } alc_rates[] = {
555 { 48000, 0 },
556 { 44100, 0 },
557 { 32000, 1 },
558 { 22050, 2 },
559 { 24000, 2 },
560 { 16000, 3 },
561 { 11025, 4 },
562 { 12000, 4 },
563 { 8000, 5 },
564 };
565
566 static int wm8960_hw_params(struct snd_pcm_substream *substream,
567 struct snd_pcm_hw_params *params,
568 struct snd_soc_dai *dai)
569 {
570 struct snd_soc_codec *codec = dai->codec;
571 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
572 u16 iface = snd_soc_read(codec, WM8960_IFACE1) & 0xfff3;
573 int i;
574
575 /* bit size */
576 switch (params_width(params)) {
577 case 16:
578 break;
579 case 20:
580 iface |= 0x0004;
581 break;
582 case 24:
583 iface |= 0x0008;
584 break;
585 default:
586 dev_err(codec->dev, "unsupported width %d\n",
587 params_width(params));
588 return -EINVAL;
589 }
590
591 /* Update filters for the new rate */
592 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
593 wm8960->playback_fs = params_rate(params);
594 wm8960_set_deemph(codec);
595 } else {
596 for (i = 0; i < ARRAY_SIZE(alc_rates); i++)
597 if (alc_rates[i].rate == params_rate(params))
598 snd_soc_update_bits(codec,
599 WM8960_ADDCTL3, 0x7,
600 alc_rates[i].val);
601 }
602
603 /* set iface */
604 snd_soc_write(codec, WM8960_IFACE1, iface);
605 return 0;
606 }
607
608 static int wm8960_mute(struct snd_soc_dai *dai, int mute)
609 {
610 struct snd_soc_codec *codec = dai->codec;
611
612 if (mute)
613 snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0x8);
614 else
615 snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0);
616 return 0;
617 }
618
619 static int wm8960_set_bias_level_out3(struct snd_soc_codec *codec,
620 enum snd_soc_bias_level level)
621 {
622 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
623 int ret;
624
625 switch (level) {
626 case SND_SOC_BIAS_ON:
627 break;
628
629 case SND_SOC_BIAS_PREPARE:
630 switch (snd_soc_codec_get_bias_level(codec)) {
631 case SND_SOC_BIAS_STANDBY:
632 if (!IS_ERR(wm8960->mclk)) {
633 ret = clk_prepare_enable(wm8960->mclk);
634 if (ret) {
635 dev_err(codec->dev,
636 "Failed to enable MCLK: %d\n",
637 ret);
638 return ret;
639 }
640 }
641
642 /* Set VMID to 2x50k */
643 snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x80);
644 break;
645
646 case SND_SOC_BIAS_ON:
647 if (!IS_ERR(wm8960->mclk))
648 clk_disable_unprepare(wm8960->mclk);
649 break;
650
651 default:
652 break;
653 }
654
655 break;
656
657 case SND_SOC_BIAS_STANDBY:
658 if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF) {
659 regcache_sync(wm8960->regmap);
660
661 /* Enable anti-pop features */
662 snd_soc_write(codec, WM8960_APOP1,
663 WM8960_POBCTRL | WM8960_SOFT_ST |
664 WM8960_BUFDCOPEN | WM8960_BUFIOEN);
665
666 /* Enable & ramp VMID at 2x50k */
667 snd_soc_update_bits(codec, WM8960_POWER1, 0x80, 0x80);
668 msleep(100);
669
670 /* Enable VREF */
671 snd_soc_update_bits(codec, WM8960_POWER1, WM8960_VREF,
672 WM8960_VREF);
673
674 /* Disable anti-pop features */
675 snd_soc_write(codec, WM8960_APOP1, WM8960_BUFIOEN);
676 }
677
678 /* Set VMID to 2x250k */
679 snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x100);
680 break;
681
682 case SND_SOC_BIAS_OFF:
683 /* Enable anti-pop features */
684 snd_soc_write(codec, WM8960_APOP1,
685 WM8960_POBCTRL | WM8960_SOFT_ST |
686 WM8960_BUFDCOPEN | WM8960_BUFIOEN);
687
688 /* Disable VMID and VREF, let them discharge */
689 snd_soc_write(codec, WM8960_POWER1, 0);
690 msleep(600);
691 break;
692 }
693
694 return 0;
695 }
696
697 static int wm8960_set_bias_level_capless(struct snd_soc_codec *codec,
698 enum snd_soc_bias_level level)
699 {
700 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
701 int reg, ret;
702
703 switch (level) {
704 case SND_SOC_BIAS_ON:
705 break;
706
707 case SND_SOC_BIAS_PREPARE:
708 switch (snd_soc_codec_get_bias_level(codec)) {
709 case SND_SOC_BIAS_STANDBY:
710 /* Enable anti pop mode */
711 snd_soc_update_bits(codec, WM8960_APOP1,
712 WM8960_POBCTRL | WM8960_SOFT_ST |
713 WM8960_BUFDCOPEN,
714 WM8960_POBCTRL | WM8960_SOFT_ST |
715 WM8960_BUFDCOPEN);
716
717 /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */
718 reg = 0;
719 if (wm8960->lout1 && wm8960->lout1->power)
720 reg |= WM8960_PWR2_LOUT1;
721 if (wm8960->rout1 && wm8960->rout1->power)
722 reg |= WM8960_PWR2_ROUT1;
723 if (wm8960->out3 && wm8960->out3->power)
724 reg |= WM8960_PWR2_OUT3;
725 snd_soc_update_bits(codec, WM8960_POWER2,
726 WM8960_PWR2_LOUT1 |
727 WM8960_PWR2_ROUT1 |
728 WM8960_PWR2_OUT3, reg);
729
730 /* Enable VMID at 2*50k */
731 snd_soc_update_bits(codec, WM8960_POWER1,
732 WM8960_VMID_MASK, 0x80);
733
734 /* Ramp */
735 msleep(100);
736
737 /* Enable VREF */
738 snd_soc_update_bits(codec, WM8960_POWER1,
739 WM8960_VREF, WM8960_VREF);
740
741 msleep(100);
742
743 if (!IS_ERR(wm8960->mclk)) {
744 ret = clk_prepare_enable(wm8960->mclk);
745 if (ret) {
746 dev_err(codec->dev,
747 "Failed to enable MCLK: %d\n",
748 ret);
749 return ret;
750 }
751 }
752 break;
753
754 case SND_SOC_BIAS_ON:
755 if (!IS_ERR(wm8960->mclk))
756 clk_disable_unprepare(wm8960->mclk);
757
758 /* Enable anti-pop mode */
759 snd_soc_update_bits(codec, WM8960_APOP1,
760 WM8960_POBCTRL | WM8960_SOFT_ST |
761 WM8960_BUFDCOPEN,
762 WM8960_POBCTRL | WM8960_SOFT_ST |
763 WM8960_BUFDCOPEN);
764
765 /* Disable VMID and VREF */
766 snd_soc_update_bits(codec, WM8960_POWER1,
767 WM8960_VREF | WM8960_VMID_MASK, 0);
768 break;
769
770 case SND_SOC_BIAS_OFF:
771 regcache_sync(wm8960->regmap);
772 break;
773 default:
774 break;
775 }
776 break;
777
778 case SND_SOC_BIAS_STANDBY:
779 switch (snd_soc_codec_get_bias_level(codec)) {
780 case SND_SOC_BIAS_PREPARE:
781 /* Disable HP discharge */
782 snd_soc_update_bits(codec, WM8960_APOP2,
783 WM8960_DISOP | WM8960_DRES_MASK,
784 0);
785
786 /* Disable anti-pop features */
787 snd_soc_update_bits(codec, WM8960_APOP1,
788 WM8960_POBCTRL | WM8960_SOFT_ST |
789 WM8960_BUFDCOPEN,
790 WM8960_POBCTRL | WM8960_SOFT_ST |
791 WM8960_BUFDCOPEN);
792 break;
793
794 default:
795 break;
796 }
797 break;
798
799 case SND_SOC_BIAS_OFF:
800 break;
801 }
802
803 return 0;
804 }
805
806 /* PLL divisors */
807 struct _pll_div {
808 u32 pre_div:1;
809 u32 n:4;
810 u32 k:24;
811 };
812
813 /* The size in bits of the pll divide multiplied by 10
814 * to allow rounding later */
815 #define FIXED_PLL_SIZE ((1 << 24) * 10)
816
817 static int pll_factors(unsigned int source, unsigned int target,
818 struct _pll_div *pll_div)
819 {
820 unsigned long long Kpart;
821 unsigned int K, Ndiv, Nmod;
822
823 pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source, target);
824
825 /* Scale up target to PLL operating frequency */
826 target *= 4;
827
828 Ndiv = target / source;
829 if (Ndiv < 6) {
830 source >>= 1;
831 pll_div->pre_div = 1;
832 Ndiv = target / source;
833 } else
834 pll_div->pre_div = 0;
835
836 if ((Ndiv < 6) || (Ndiv > 12)) {
837 pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv);
838 return -EINVAL;
839 }
840
841 pll_div->n = Ndiv;
842 Nmod = target % source;
843 Kpart = FIXED_PLL_SIZE * (long long)Nmod;
844
845 do_div(Kpart, source);
846
847 K = Kpart & 0xFFFFFFFF;
848
849 /* Check if we need to round */
850 if ((K % 10) >= 5)
851 K += 5;
852
853 /* Move down to proper range now rounding is done */
854 K /= 10;
855
856 pll_div->k = K;
857
858 pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n",
859 pll_div->n, pll_div->k, pll_div->pre_div);
860
861 return 0;
862 }
863
864 static int wm8960_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
865 int source, unsigned int freq_in, unsigned int freq_out)
866 {
867 struct snd_soc_codec *codec = codec_dai->codec;
868 u16 reg;
869 static struct _pll_div pll_div;
870 int ret;
871
872 if (freq_in && freq_out) {
873 ret = pll_factors(freq_in, freq_out, &pll_div);
874 if (ret != 0)
875 return ret;
876 }
877
878 /* Disable the PLL: even if we are changing the frequency the
879 * PLL needs to be disabled while we do so. */
880 snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0);
881 snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0);
882
883 if (!freq_in || !freq_out)
884 return 0;
885
886 reg = snd_soc_read(codec, WM8960_PLL1) & ~0x3f;
887 reg |= pll_div.pre_div << 4;
888 reg |= pll_div.n;
889
890 if (pll_div.k) {
891 reg |= 0x20;
892
893 snd_soc_write(codec, WM8960_PLL2, (pll_div.k >> 16) & 0xff);
894 snd_soc_write(codec, WM8960_PLL3, (pll_div.k >> 8) & 0xff);
895 snd_soc_write(codec, WM8960_PLL4, pll_div.k & 0xff);
896 }
897 snd_soc_write(codec, WM8960_PLL1, reg);
898
899 /* Turn it on */
900 snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0x1);
901 msleep(250);
902 snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0x1);
903
904 return 0;
905 }
906
907 static int wm8960_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
908 int div_id, int div)
909 {
910 struct snd_soc_codec *codec = codec_dai->codec;
911 u16 reg;
912
913 switch (div_id) {
914 case WM8960_SYSCLKDIV:
915 reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1f9;
916 snd_soc_write(codec, WM8960_CLOCK1, reg | div);
917 break;
918 case WM8960_DACDIV:
919 reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1c7;
920 snd_soc_write(codec, WM8960_CLOCK1, reg | div);
921 break;
922 case WM8960_OPCLKDIV:
923 reg = snd_soc_read(codec, WM8960_PLL1) & 0x03f;
924 snd_soc_write(codec, WM8960_PLL1, reg | div);
925 break;
926 case WM8960_DCLKDIV:
927 reg = snd_soc_read(codec, WM8960_CLOCK2) & 0x03f;
928 snd_soc_write(codec, WM8960_CLOCK2, reg | div);
929 break;
930 case WM8960_TOCLKSEL:
931 reg = snd_soc_read(codec, WM8960_ADDCTL1) & 0x1fd;
932 snd_soc_write(codec, WM8960_ADDCTL1, reg | div);
933 break;
934 default:
935 return -EINVAL;
936 }
937
938 return 0;
939 }
940
941 static int wm8960_set_bias_level(struct snd_soc_codec *codec,
942 enum snd_soc_bias_level level)
943 {
944 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
945
946 return wm8960->set_bias_level(codec, level);
947 }
948
949 #define WM8960_RATES SNDRV_PCM_RATE_8000_48000
950
951 #define WM8960_FORMATS \
952 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
953 SNDRV_PCM_FMTBIT_S24_LE)
954
955 static const struct snd_soc_dai_ops wm8960_dai_ops = {
956 .hw_params = wm8960_hw_params,
957 .digital_mute = wm8960_mute,
958 .set_fmt = wm8960_set_dai_fmt,
959 .set_clkdiv = wm8960_set_dai_clkdiv,
960 .set_pll = wm8960_set_dai_pll,
961 };
962
963 static struct snd_soc_dai_driver wm8960_dai = {
964 .name = "wm8960-hifi",
965 .playback = {
966 .stream_name = "Playback",
967 .channels_min = 1,
968 .channels_max = 2,
969 .rates = WM8960_RATES,
970 .formats = WM8960_FORMATS,},
971 .capture = {
972 .stream_name = "Capture",
973 .channels_min = 1,
974 .channels_max = 2,
975 .rates = WM8960_RATES,
976 .formats = WM8960_FORMATS,},
977 .ops = &wm8960_dai_ops,
978 .symmetric_rates = 1,
979 };
980
981 static int wm8960_probe(struct snd_soc_codec *codec)
982 {
983 struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
984 struct wm8960_data *pdata = &wm8960->pdata;
985
986 if (pdata->capless)
987 wm8960->set_bias_level = wm8960_set_bias_level_capless;
988 else
989 wm8960->set_bias_level = wm8960_set_bias_level_out3;
990
991 snd_soc_add_codec_controls(codec, wm8960_snd_controls,
992 ARRAY_SIZE(wm8960_snd_controls));
993 wm8960_add_widgets(codec);
994
995 return 0;
996 }
997
998 static struct snd_soc_codec_driver soc_codec_dev_wm8960 = {
999 .probe = wm8960_probe,
1000 .set_bias_level = wm8960_set_bias_level,
1001 .suspend_bias_off = true,
1002 };
1003
1004 static const struct regmap_config wm8960_regmap = {
1005 .reg_bits = 7,
1006 .val_bits = 9,
1007 .max_register = WM8960_PLL4,
1008
1009 .reg_defaults = wm8960_reg_defaults,
1010 .num_reg_defaults = ARRAY_SIZE(wm8960_reg_defaults),
1011 .cache_type = REGCACHE_RBTREE,
1012
1013 .volatile_reg = wm8960_volatile,
1014 };
1015
1016 static void wm8960_set_pdata_from_of(struct i2c_client *i2c,
1017 struct wm8960_data *pdata)
1018 {
1019 const struct device_node *np = i2c->dev.of_node;
1020
1021 if (of_property_read_bool(np, "wlf,capless"))
1022 pdata->capless = true;
1023
1024 if (of_property_read_bool(np, "wlf,shared-lrclk"))
1025 pdata->shared_lrclk = true;
1026 }
1027
1028 static int wm8960_i2c_probe(struct i2c_client *i2c,
1029 const struct i2c_device_id *id)
1030 {
1031 struct wm8960_data *pdata = dev_get_platdata(&i2c->dev);
1032 struct wm8960_priv *wm8960;
1033 int ret;
1034
1035 wm8960 = devm_kzalloc(&i2c->dev, sizeof(struct wm8960_priv),
1036 GFP_KERNEL);
1037 if (wm8960 == NULL)
1038 return -ENOMEM;
1039
1040 wm8960->mclk = devm_clk_get(&i2c->dev, "mclk");
1041 if (IS_ERR(wm8960->mclk)) {
1042 if (PTR_ERR(wm8960->mclk) == -EPROBE_DEFER)
1043 return -EPROBE_DEFER;
1044 }
1045
1046 wm8960->regmap = devm_regmap_init_i2c(i2c, &wm8960_regmap);
1047 if (IS_ERR(wm8960->regmap))
1048 return PTR_ERR(wm8960->regmap);
1049
1050 if (pdata)
1051 memcpy(&wm8960->pdata, pdata, sizeof(struct wm8960_data));
1052 else if (i2c->dev.of_node)
1053 wm8960_set_pdata_from_of(i2c, &wm8960->pdata);
1054
1055 ret = wm8960_reset(wm8960->regmap);
1056 if (ret != 0) {
1057 dev_err(&i2c->dev, "Failed to issue reset\n");
1058 return ret;
1059 }
1060
1061 if (wm8960->pdata.shared_lrclk) {
1062 ret = regmap_update_bits(wm8960->regmap, WM8960_ADDCTL2,
1063 0x4, 0x4);
1064 if (ret != 0) {
1065 dev_err(&i2c->dev, "Failed to enable LRCM: %d\n",
1066 ret);
1067 return ret;
1068 }
1069 }
1070
1071 /* Latch the update bits */
1072 regmap_update_bits(wm8960->regmap, WM8960_LINVOL, 0x100, 0x100);
1073 regmap_update_bits(wm8960->regmap, WM8960_RINVOL, 0x100, 0x100);
1074 regmap_update_bits(wm8960->regmap, WM8960_LADC, 0x100, 0x100);
1075 regmap_update_bits(wm8960->regmap, WM8960_RADC, 0x100, 0x100);
1076 regmap_update_bits(wm8960->regmap, WM8960_LDAC, 0x100, 0x100);
1077 regmap_update_bits(wm8960->regmap, WM8960_RDAC, 0x100, 0x100);
1078 regmap_update_bits(wm8960->regmap, WM8960_LOUT1, 0x100, 0x100);
1079 regmap_update_bits(wm8960->regmap, WM8960_ROUT1, 0x100, 0x100);
1080 regmap_update_bits(wm8960->regmap, WM8960_LOUT2, 0x100, 0x100);
1081 regmap_update_bits(wm8960->regmap, WM8960_ROUT2, 0x100, 0x100);
1082
1083 i2c_set_clientdata(i2c, wm8960);
1084
1085 ret = snd_soc_register_codec(&i2c->dev,
1086 &soc_codec_dev_wm8960, &wm8960_dai, 1);
1087
1088 return ret;
1089 }
1090
1091 static int wm8960_i2c_remove(struct i2c_client *client)
1092 {
1093 snd_soc_unregister_codec(&client->dev);
1094 return 0;
1095 }
1096
1097 static const struct i2c_device_id wm8960_i2c_id[] = {
1098 { "wm8960", 0 },
1099 { }
1100 };
1101 MODULE_DEVICE_TABLE(i2c, wm8960_i2c_id);
1102
1103 static const struct of_device_id wm8960_of_match[] = {
1104 { .compatible = "wlf,wm8960", },
1105 { }
1106 };
1107 MODULE_DEVICE_TABLE(of, wm8960_of_match);
1108
1109 static struct i2c_driver wm8960_i2c_driver = {
1110 .driver = {
1111 .name = "wm8960",
1112 .owner = THIS_MODULE,
1113 .of_match_table = wm8960_of_match,
1114 },
1115 .probe = wm8960_i2c_probe,
1116 .remove = wm8960_i2c_remove,
1117 .id_table = wm8960_i2c_id,
1118 };
1119
1120 module_i2c_driver(wm8960_i2c_driver);
1121
1122 MODULE_DESCRIPTION("ASoC WM8960 driver");
1123 MODULE_AUTHOR("Liam Girdwood");
1124 MODULE_LICENSE("GPL");
This page took 0.058113 seconds and 6 git commands to generate.