2 * wm8960.c -- WM8960 ALSA SoC Audio driver
4 * Author: Liam Girdwood
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/module.h>
12 #include <linux/moduleparam.h>
13 #include <linux/init.h>
14 #include <linux/delay.h>
16 #include <linux/i2c.h>
17 #include <linux/platform_device.h>
18 #include <linux/slab.h>
19 #include <sound/core.h>
20 #include <sound/pcm.h>
21 #include <sound/pcm_params.h>
22 #include <sound/soc.h>
23 #include <sound/initval.h>
24 #include <sound/tlv.h>
25 #include <sound/wm8960.h>
29 #define AUDIO_NAME "wm8960"
32 #define WM8960_VMID_MASK 0x180
33 #define WM8960_VREF 0x40
36 #define WM8960_PWR2_LOUT1 0x40
37 #define WM8960_PWR2_ROUT1 0x20
38 #define WM8960_PWR2_OUT3 0x02
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
47 /* R29 - Anti-pop 2 */
48 #define WM8960_DISOP 0x40
49 #define WM8960_DRES_MASK 0x30
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.
56 static const u16 wm8960_reg
[WM8960_CACHEREGNUM
] = {
57 0x0097, 0x0097, 0x0000, 0x0000,
58 0x0000, 0x0008, 0x0000, 0x000a,
59 0x01c0, 0x0000, 0x00ff, 0x00ff,
60 0x0000, 0x0000, 0x0000, 0x0000,
61 0x0000, 0x007b, 0x0100, 0x0032,
62 0x0000, 0x00c3, 0x00c3, 0x01c0,
63 0x0000, 0x0000, 0x0000, 0x0000,
64 0x0000, 0x0000, 0x0000, 0x0000,
65 0x0100, 0x0100, 0x0050, 0x0050,
66 0x0050, 0x0050, 0x0000, 0x0000,
67 0x0000, 0x0000, 0x0040, 0x0000,
68 0x0000, 0x0050, 0x0050, 0x0000,
69 0x0002, 0x0037, 0x004d, 0x0080,
70 0x0008, 0x0031, 0x0026, 0x00e9,
74 enum snd_soc_control_type control_type
;
75 int (*set_bias_level
)(struct snd_soc_codec
*,
76 enum snd_soc_bias_level level
);
77 struct snd_soc_dapm_widget
*lout1
;
78 struct snd_soc_dapm_widget
*rout1
;
79 struct snd_soc_dapm_widget
*out3
;
84 #define wm8960_reset(c) snd_soc_write(c, WM8960_RESET, 0)
86 /* enumerated controls */
87 static const char *wm8960_polarity
[] = {"No Inversion", "Left Inverted",
88 "Right Inverted", "Stereo Inversion"};
89 static const char *wm8960_3d_upper_cutoff
[] = {"High", "Low"};
90 static const char *wm8960_3d_lower_cutoff
[] = {"Low", "High"};
91 static const char *wm8960_alcfunc
[] = {"Off", "Right", "Left", "Stereo"};
92 static const char *wm8960_alcmode
[] = {"ALC", "Limiter"};
94 static const struct soc_enum wm8960_enum
[] = {
95 SOC_ENUM_SINGLE(WM8960_DACCTL1
, 5, 4, wm8960_polarity
),
96 SOC_ENUM_SINGLE(WM8960_DACCTL2
, 5, 4, wm8960_polarity
),
97 SOC_ENUM_SINGLE(WM8960_3D
, 6, 2, wm8960_3d_upper_cutoff
),
98 SOC_ENUM_SINGLE(WM8960_3D
, 5, 2, wm8960_3d_lower_cutoff
),
99 SOC_ENUM_SINGLE(WM8960_ALC1
, 7, 4, wm8960_alcfunc
),
100 SOC_ENUM_SINGLE(WM8960_ALC3
, 8, 2, wm8960_alcmode
),
103 static const int deemph_settings
[] = { 0, 32000, 44100, 48000 };
105 static int wm8960_set_deemph(struct snd_soc_codec
*codec
)
107 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
110 /* If we're using deemphasis select the nearest available sample
113 if (wm8960
->deemph
) {
115 for (i
= 2; i
< ARRAY_SIZE(deemph_settings
); i
++) {
116 if (abs(deemph_settings
[i
] - wm8960
->playback_fs
) <
117 abs(deemph_settings
[best
] - wm8960
->playback_fs
))
126 dev_dbg(codec
->dev
, "Set deemphasis %d\n", val
);
128 return snd_soc_update_bits(codec
, WM8960_DACCTL1
,
132 static int wm8960_get_deemph(struct snd_kcontrol
*kcontrol
,
133 struct snd_ctl_elem_value
*ucontrol
)
135 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
136 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
138 ucontrol
->value
.enumerated
.item
[0] = wm8960
->deemph
;
142 static int wm8960_put_deemph(struct snd_kcontrol
*kcontrol
,
143 struct snd_ctl_elem_value
*ucontrol
)
145 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
146 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
147 int deemph
= ucontrol
->value
.enumerated
.item
[0];
152 wm8960
->deemph
= deemph
;
154 return wm8960_set_deemph(codec
);
157 static const DECLARE_TLV_DB_SCALE(adc_tlv
, -9700, 50, 0);
158 static const DECLARE_TLV_DB_SCALE(dac_tlv
, -12700, 50, 1);
159 static const DECLARE_TLV_DB_SCALE(bypass_tlv
, -2100, 300, 0);
160 static const DECLARE_TLV_DB_SCALE(out_tlv
, -12100, 100, 1);
162 static const struct snd_kcontrol_new wm8960_snd_controls
[] = {
163 SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL
, WM8960_RINVOL
,
165 SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL
, WM8960_RINVOL
,
167 SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL
, WM8960_RINVOL
,
170 SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC
, WM8960_RDAC
,
173 SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1
, WM8960_ROUT1
,
175 SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1
, WM8960_ROUT1
,
178 SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2
, WM8960_ROUT2
,
180 SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2
, WM8960_ROUT2
,
182 SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3
, 3, 5, 0),
183 SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3
, 0, 5, 0),
185 SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1
, 7, 1, 0),
186 SOC_ENUM("ADC Polarity", wm8960_enum
[0]),
187 SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1
, 0, 1, 0),
189 SOC_ENUM("DAC Polarity", wm8960_enum
[2]),
190 SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0,
191 wm8960_get_deemph
, wm8960_put_deemph
),
193 SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum
[2]),
194 SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum
[3]),
195 SOC_SINGLE("3D Volume", WM8960_3D
, 1, 15, 0),
196 SOC_SINGLE("3D Switch", WM8960_3D
, 0, 1, 0),
198 SOC_ENUM("ALC Function", wm8960_enum
[4]),
199 SOC_SINGLE("ALC Max Gain", WM8960_ALC1
, 4, 7, 0),
200 SOC_SINGLE("ALC Target", WM8960_ALC1
, 0, 15, 1),
201 SOC_SINGLE("ALC Min Gain", WM8960_ALC2
, 4, 7, 0),
202 SOC_SINGLE("ALC Hold Time", WM8960_ALC2
, 0, 15, 0),
203 SOC_ENUM("ALC Mode", wm8960_enum
[5]),
204 SOC_SINGLE("ALC Decay", WM8960_ALC3
, 4, 15, 0),
205 SOC_SINGLE("ALC Attack", WM8960_ALC3
, 0, 15, 0),
207 SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG
, 3, 31, 0),
208 SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG
, 0, 1, 0),
210 SOC_DOUBLE_R("ADC PCM Capture Volume", WM8960_LINPATH
, WM8960_RINPATH
,
213 SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume",
214 WM8960_BYPASS1
, 4, 7, 1, bypass_tlv
),
215 SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume",
216 WM8960_LOUTMIX
, 4, 7, 1, bypass_tlv
),
217 SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume",
218 WM8960_BYPASS2
, 4, 7, 1, bypass_tlv
),
219 SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume",
220 WM8960_ROUTMIX
, 4, 7, 1, bypass_tlv
),
223 static const struct snd_kcontrol_new wm8960_lin_boost
[] = {
224 SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH
, 6, 1, 0),
225 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH
, 7, 1, 0),
226 SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH
, 8, 1, 0),
229 static const struct snd_kcontrol_new wm8960_lin
[] = {
230 SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH
, 3, 1, 0),
233 static const struct snd_kcontrol_new wm8960_rin_boost
[] = {
234 SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH
, 6, 1, 0),
235 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH
, 7, 1, 0),
236 SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH
, 8, 1, 0),
239 static const struct snd_kcontrol_new wm8960_rin
[] = {
240 SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH
, 3, 1, 0),
243 static const struct snd_kcontrol_new wm8960_loutput_mixer
[] = {
244 SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX
, 8, 1, 0),
245 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX
, 7, 1, 0),
246 SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1
, 7, 1, 0),
249 static const struct snd_kcontrol_new wm8960_routput_mixer
[] = {
250 SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX
, 8, 1, 0),
251 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX
, 7, 1, 0),
252 SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2
, 7, 1, 0),
255 static const struct snd_kcontrol_new wm8960_mono_out
[] = {
256 SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1
, 7, 1, 0),
257 SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2
, 7, 1, 0),
260 static const struct snd_soc_dapm_widget wm8960_dapm_widgets
[] = {
261 SND_SOC_DAPM_INPUT("LINPUT1"),
262 SND_SOC_DAPM_INPUT("RINPUT1"),
263 SND_SOC_DAPM_INPUT("LINPUT2"),
264 SND_SOC_DAPM_INPUT("RINPUT2"),
265 SND_SOC_DAPM_INPUT("LINPUT3"),
266 SND_SOC_DAPM_INPUT("RINPUT3"),
268 SND_SOC_DAPM_MICBIAS("MICB", WM8960_POWER1
, 1, 0),
270 SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1
, 5, 0,
271 wm8960_lin_boost
, ARRAY_SIZE(wm8960_lin_boost
)),
272 SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1
, 4, 0,
273 wm8960_rin_boost
, ARRAY_SIZE(wm8960_rin_boost
)),
275 SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3
, 5, 0,
276 wm8960_lin
, ARRAY_SIZE(wm8960_lin
)),
277 SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3
, 4, 0,
278 wm8960_rin
, ARRAY_SIZE(wm8960_rin
)),
280 SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER2
, 3, 0),
281 SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER2
, 2, 0),
283 SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2
, 8, 0),
284 SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2
, 7, 0),
286 SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3
, 3, 0,
287 &wm8960_loutput_mixer
[0],
288 ARRAY_SIZE(wm8960_loutput_mixer
)),
289 SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3
, 2, 0,
290 &wm8960_routput_mixer
[0],
291 ARRAY_SIZE(wm8960_routput_mixer
)),
293 SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2
, 6, 0, NULL
, 0),
294 SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2
, 5, 0, NULL
, 0),
296 SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2
, 4, 0, NULL
, 0),
297 SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2
, 3, 0, NULL
, 0),
299 SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1
, 7, 0, NULL
, 0),
300 SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1
, 6, 0, NULL
, 0),
302 SND_SOC_DAPM_OUTPUT("SPK_LP"),
303 SND_SOC_DAPM_OUTPUT("SPK_LN"),
304 SND_SOC_DAPM_OUTPUT("HP_L"),
305 SND_SOC_DAPM_OUTPUT("HP_R"),
306 SND_SOC_DAPM_OUTPUT("SPK_RP"),
307 SND_SOC_DAPM_OUTPUT("SPK_RN"),
308 SND_SOC_DAPM_OUTPUT("OUT3"),
311 static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3
[] = {
312 SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2
, 1, 0,
314 ARRAY_SIZE(wm8960_mono_out
)),
317 /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */
318 static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless
[] = {
319 SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2
, 1, 0, NULL
, 0),
322 static const struct snd_soc_dapm_route audio_paths
[] = {
323 { "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" },
324 { "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" },
325 { "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" },
327 { "Left Input Mixer", "Boost Switch", "Left Boost Mixer", },
328 { "Left Input Mixer", NULL
, "LINPUT1", }, /* Really Boost Switch */
329 { "Left Input Mixer", NULL
, "LINPUT2" },
330 { "Left Input Mixer", NULL
, "LINPUT3" },
332 { "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" },
333 { "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" },
334 { "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" },
336 { "Right Input Mixer", "Boost Switch", "Right Boost Mixer", },
337 { "Right Input Mixer", NULL
, "RINPUT1", }, /* Really Boost Switch */
338 { "Right Input Mixer", NULL
, "RINPUT2" },
339 { "Right Input Mixer", NULL
, "LINPUT3" },
341 { "Left ADC", NULL
, "Left Input Mixer" },
342 { "Right ADC", NULL
, "Right Input Mixer" },
344 { "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" },
345 { "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer"} ,
346 { "Left Output Mixer", "PCM Playback Switch", "Left DAC" },
348 { "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" },
349 { "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" } ,
350 { "Right Output Mixer", "PCM Playback Switch", "Right DAC" },
352 { "LOUT1 PGA", NULL
, "Left Output Mixer" },
353 { "ROUT1 PGA", NULL
, "Right Output Mixer" },
355 { "HP_L", NULL
, "LOUT1 PGA" },
356 { "HP_R", NULL
, "ROUT1 PGA" },
358 { "Left Speaker PGA", NULL
, "Left Output Mixer" },
359 { "Right Speaker PGA", NULL
, "Right Output Mixer" },
361 { "Left Speaker Output", NULL
, "Left Speaker PGA" },
362 { "Right Speaker Output", NULL
, "Right Speaker PGA" },
364 { "SPK_LN", NULL
, "Left Speaker Output" },
365 { "SPK_LP", NULL
, "Left Speaker Output" },
366 { "SPK_RN", NULL
, "Right Speaker Output" },
367 { "SPK_RP", NULL
, "Right Speaker Output" },
370 static const struct snd_soc_dapm_route audio_paths_out3
[] = {
371 { "Mono Output Mixer", "Left Switch", "Left Output Mixer" },
372 { "Mono Output Mixer", "Right Switch", "Right Output Mixer" },
374 { "OUT3", NULL
, "Mono Output Mixer", }
377 static const struct snd_soc_dapm_route audio_paths_capless
[] = {
378 { "HP_L", NULL
, "OUT3 VMID" },
379 { "HP_R", NULL
, "OUT3 VMID" },
381 { "OUT3 VMID", NULL
, "Left Output Mixer" },
382 { "OUT3 VMID", NULL
, "Right Output Mixer" },
385 static int wm8960_add_widgets(struct snd_soc_codec
*codec
)
387 struct wm8960_data
*pdata
= codec
->dev
->platform_data
;
388 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
389 struct snd_soc_dapm_context
*dapm
= &codec
->dapm
;
390 struct snd_soc_dapm_widget
*w
;
392 snd_soc_dapm_new_controls(dapm
, wm8960_dapm_widgets
,
393 ARRAY_SIZE(wm8960_dapm_widgets
));
395 snd_soc_dapm_add_routes(dapm
, audio_paths
, ARRAY_SIZE(audio_paths
));
397 /* In capless mode OUT3 is used to provide VMID for the
398 * headphone outputs, otherwise it is used as a mono mixer.
400 if (pdata
&& pdata
->capless
) {
401 snd_soc_dapm_new_controls(dapm
, wm8960_dapm_widgets_capless
,
402 ARRAY_SIZE(wm8960_dapm_widgets_capless
));
404 snd_soc_dapm_add_routes(dapm
, audio_paths_capless
,
405 ARRAY_SIZE(audio_paths_capless
));
407 snd_soc_dapm_new_controls(dapm
, wm8960_dapm_widgets_out3
,
408 ARRAY_SIZE(wm8960_dapm_widgets_out3
));
410 snd_soc_dapm_add_routes(dapm
, audio_paths_out3
,
411 ARRAY_SIZE(audio_paths_out3
));
414 /* We need to power up the headphone output stage out of
415 * sequence for capless mode. To save scanning the widget
416 * list each time to find the desired power state do so now
417 * and save the result.
419 list_for_each_entry(w
, &codec
->card
->widgets
, list
) {
420 if (w
->dapm
!= &codec
->dapm
)
422 if (strcmp(w
->name
, "LOUT1 PGA") == 0)
424 if (strcmp(w
->name
, "ROUT1 PGA") == 0)
426 if (strcmp(w
->name
, "OUT3 VMID") == 0)
433 static int wm8960_set_dai_fmt(struct snd_soc_dai
*codec_dai
,
436 struct snd_soc_codec
*codec
= codec_dai
->codec
;
439 /* set master/slave audio interface */
440 switch (fmt
& SND_SOC_DAIFMT_MASTER_MASK
) {
441 case SND_SOC_DAIFMT_CBM_CFM
:
444 case SND_SOC_DAIFMT_CBS_CFS
:
450 /* interface format */
451 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
452 case SND_SOC_DAIFMT_I2S
:
455 case SND_SOC_DAIFMT_RIGHT_J
:
457 case SND_SOC_DAIFMT_LEFT_J
:
460 case SND_SOC_DAIFMT_DSP_A
:
463 case SND_SOC_DAIFMT_DSP_B
:
470 /* clock inversion */
471 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
472 case SND_SOC_DAIFMT_NB_NF
:
474 case SND_SOC_DAIFMT_IB_IF
:
477 case SND_SOC_DAIFMT_IB_NF
:
480 case SND_SOC_DAIFMT_NB_IF
:
488 snd_soc_write(codec
, WM8960_IFACE1
, iface
);
507 static int wm8960_hw_params(struct snd_pcm_substream
*substream
,
508 struct snd_pcm_hw_params
*params
,
509 struct snd_soc_dai
*dai
)
511 struct snd_soc_pcm_runtime
*rtd
= substream
->private_data
;
512 struct snd_soc_codec
*codec
= rtd
->codec
;
513 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
514 u16 iface
= snd_soc_read(codec
, WM8960_IFACE1
) & 0xfff3;
518 switch (params_format(params
)) {
519 case SNDRV_PCM_FORMAT_S16_LE
:
521 case SNDRV_PCM_FORMAT_S20_3LE
:
524 case SNDRV_PCM_FORMAT_S24_LE
:
529 /* Update filters for the new rate */
530 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
531 wm8960
->playback_fs
= params_rate(params
);
532 wm8960_set_deemph(codec
);
534 for (i
= 0; i
< ARRAY_SIZE(alc_rates
); i
++)
535 if (alc_rates
[i
].rate
== params_rate(params
))
536 snd_soc_update_bits(codec
,
542 snd_soc_write(codec
, WM8960_IFACE1
, iface
);
546 static int wm8960_mute(struct snd_soc_dai
*dai
, int mute
)
548 struct snd_soc_codec
*codec
= dai
->codec
;
549 u16 mute_reg
= snd_soc_read(codec
, WM8960_DACCTL1
) & 0xfff7;
552 snd_soc_write(codec
, WM8960_DACCTL1
, mute_reg
| 0x8);
554 snd_soc_write(codec
, WM8960_DACCTL1
, mute_reg
);
558 static int wm8960_set_bias_level_out3(struct snd_soc_codec
*codec
,
559 enum snd_soc_bias_level level
)
564 case SND_SOC_BIAS_ON
:
567 case SND_SOC_BIAS_PREPARE
:
568 /* Set VMID to 2x50k */
569 reg
= snd_soc_read(codec
, WM8960_POWER1
);
572 snd_soc_write(codec
, WM8960_POWER1
, reg
);
575 case SND_SOC_BIAS_STANDBY
:
576 if (codec
->dapm
.bias_level
== SND_SOC_BIAS_OFF
) {
577 snd_soc_cache_sync(codec
);
579 /* Enable anti-pop features */
580 snd_soc_write(codec
, WM8960_APOP1
,
581 WM8960_POBCTRL
| WM8960_SOFT_ST
|
582 WM8960_BUFDCOPEN
| WM8960_BUFIOEN
);
584 /* Enable & ramp VMID at 2x50k */
585 reg
= snd_soc_read(codec
, WM8960_POWER1
);
587 snd_soc_write(codec
, WM8960_POWER1
, reg
);
591 snd_soc_write(codec
, WM8960_POWER1
, reg
| WM8960_VREF
);
593 /* Disable anti-pop features */
594 snd_soc_write(codec
, WM8960_APOP1
, WM8960_BUFIOEN
);
597 /* Set VMID to 2x250k */
598 reg
= snd_soc_read(codec
, WM8960_POWER1
);
601 snd_soc_write(codec
, WM8960_POWER1
, reg
);
604 case SND_SOC_BIAS_OFF
:
605 /* Enable anti-pop features */
606 snd_soc_write(codec
, WM8960_APOP1
,
607 WM8960_POBCTRL
| WM8960_SOFT_ST
|
608 WM8960_BUFDCOPEN
| WM8960_BUFIOEN
);
610 /* Disable VMID and VREF, let them discharge */
611 snd_soc_write(codec
, WM8960_POWER1
, 0);
616 codec
->dapm
.bias_level
= level
;
621 static int wm8960_set_bias_level_capless(struct snd_soc_codec
*codec
,
622 enum snd_soc_bias_level level
)
624 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
628 case SND_SOC_BIAS_ON
:
631 case SND_SOC_BIAS_PREPARE
:
632 switch (codec
->dapm
.bias_level
) {
633 case SND_SOC_BIAS_STANDBY
:
634 /* Enable anti pop mode */
635 snd_soc_update_bits(codec
, WM8960_APOP1
,
636 WM8960_POBCTRL
| WM8960_SOFT_ST
|
638 WM8960_POBCTRL
| WM8960_SOFT_ST
|
641 /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */
643 if (wm8960
->lout1
&& wm8960
->lout1
->power
)
644 reg
|= WM8960_PWR2_LOUT1
;
645 if (wm8960
->rout1
&& wm8960
->rout1
->power
)
646 reg
|= WM8960_PWR2_ROUT1
;
647 if (wm8960
->out3
&& wm8960
->out3
->power
)
648 reg
|= WM8960_PWR2_OUT3
;
649 snd_soc_update_bits(codec
, WM8960_POWER2
,
652 WM8960_PWR2_OUT3
, reg
);
654 /* Enable VMID at 2*50k */
655 snd_soc_update_bits(codec
, WM8960_POWER1
,
656 WM8960_VMID_MASK
, 0x80);
662 snd_soc_update_bits(codec
, WM8960_POWER1
,
663 WM8960_VREF
, WM8960_VREF
);
668 case SND_SOC_BIAS_ON
:
669 /* Enable anti-pop mode */
670 snd_soc_update_bits(codec
, WM8960_APOP1
,
671 WM8960_POBCTRL
| WM8960_SOFT_ST
|
673 WM8960_POBCTRL
| WM8960_SOFT_ST
|
676 /* Disable VMID and VREF */
677 snd_soc_update_bits(codec
, WM8960_POWER1
,
678 WM8960_VREF
| WM8960_VMID_MASK
, 0);
681 case SND_SOC_BIAS_OFF
:
682 snd_soc_cache_sync(codec
);
689 case SND_SOC_BIAS_STANDBY
:
690 switch (codec
->dapm
.bias_level
) {
691 case SND_SOC_BIAS_PREPARE
:
692 /* Disable HP discharge */
693 snd_soc_update_bits(codec
, WM8960_APOP2
,
694 WM8960_DISOP
| WM8960_DRES_MASK
,
697 /* Disable anti-pop features */
698 snd_soc_update_bits(codec
, WM8960_APOP1
,
699 WM8960_POBCTRL
| WM8960_SOFT_ST
|
701 WM8960_POBCTRL
| WM8960_SOFT_ST
|
710 case SND_SOC_BIAS_OFF
:
714 codec
->dapm
.bias_level
= level
;
726 /* The size in bits of the pll divide multiplied by 10
727 * to allow rounding later */
728 #define FIXED_PLL_SIZE ((1 << 24) * 10)
730 static int pll_factors(unsigned int source
, unsigned int target
,
731 struct _pll_div
*pll_div
)
733 unsigned long long Kpart
;
734 unsigned int K
, Ndiv
, Nmod
;
736 pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source
, target
);
738 /* Scale up target to PLL operating frequency */
741 Ndiv
= target
/ source
;
744 pll_div
->pre_div
= 1;
745 Ndiv
= target
/ source
;
747 pll_div
->pre_div
= 0;
749 if ((Ndiv
< 6) || (Ndiv
> 12)) {
750 pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv
);
755 Nmod
= target
% source
;
756 Kpart
= FIXED_PLL_SIZE
* (long long)Nmod
;
758 do_div(Kpart
, source
);
760 K
= Kpart
& 0xFFFFFFFF;
762 /* Check if we need to round */
766 /* Move down to proper range now rounding is done */
771 pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n",
772 pll_div
->n
, pll_div
->k
, pll_div
->pre_div
);
777 static int wm8960_set_dai_pll(struct snd_soc_dai
*codec_dai
, int pll_id
,
778 int source
, unsigned int freq_in
, unsigned int freq_out
)
780 struct snd_soc_codec
*codec
= codec_dai
->codec
;
782 static struct _pll_div pll_div
;
785 if (freq_in
&& freq_out
) {
786 ret
= pll_factors(freq_in
, freq_out
, &pll_div
);
791 /* Disable the PLL: even if we are changing the frequency the
792 * PLL needs to be disabled while we do so. */
793 snd_soc_write(codec
, WM8960_CLOCK1
,
794 snd_soc_read(codec
, WM8960_CLOCK1
) & ~1);
795 snd_soc_write(codec
, WM8960_POWER2
,
796 snd_soc_read(codec
, WM8960_POWER2
) & ~1);
798 if (!freq_in
|| !freq_out
)
801 reg
= snd_soc_read(codec
, WM8960_PLL1
) & ~0x3f;
802 reg
|= pll_div
.pre_div
<< 4;
808 snd_soc_write(codec
, WM8960_PLL2
, (pll_div
.k
>> 18) & 0x3f);
809 snd_soc_write(codec
, WM8960_PLL3
, (pll_div
.k
>> 9) & 0x1ff);
810 snd_soc_write(codec
, WM8960_PLL4
, pll_div
.k
& 0x1ff);
812 snd_soc_write(codec
, WM8960_PLL1
, reg
);
815 snd_soc_write(codec
, WM8960_POWER2
,
816 snd_soc_read(codec
, WM8960_POWER2
) | 1);
818 snd_soc_write(codec
, WM8960_CLOCK1
,
819 snd_soc_read(codec
, WM8960_CLOCK1
) | 1);
824 static int wm8960_set_dai_clkdiv(struct snd_soc_dai
*codec_dai
,
827 struct snd_soc_codec
*codec
= codec_dai
->codec
;
831 case WM8960_SYSCLKDIV
:
832 reg
= snd_soc_read(codec
, WM8960_CLOCK1
) & 0x1f9;
833 snd_soc_write(codec
, WM8960_CLOCK1
, reg
| div
);
836 reg
= snd_soc_read(codec
, WM8960_CLOCK1
) & 0x1c7;
837 snd_soc_write(codec
, WM8960_CLOCK1
, reg
| div
);
839 case WM8960_OPCLKDIV
:
840 reg
= snd_soc_read(codec
, WM8960_PLL1
) & 0x03f;
841 snd_soc_write(codec
, WM8960_PLL1
, reg
| div
);
844 reg
= snd_soc_read(codec
, WM8960_CLOCK2
) & 0x03f;
845 snd_soc_write(codec
, WM8960_CLOCK2
, reg
| div
);
847 case WM8960_TOCLKSEL
:
848 reg
= snd_soc_read(codec
, WM8960_ADDCTL1
) & 0x1fd;
849 snd_soc_write(codec
, WM8960_ADDCTL1
, reg
| div
);
858 static int wm8960_set_bias_level(struct snd_soc_codec
*codec
,
859 enum snd_soc_bias_level level
)
861 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
863 return wm8960
->set_bias_level(codec
, level
);
866 #define WM8960_RATES SNDRV_PCM_RATE_8000_48000
868 #define WM8960_FORMATS \
869 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
870 SNDRV_PCM_FMTBIT_S24_LE)
872 static struct snd_soc_dai_ops wm8960_dai_ops
= {
873 .hw_params
= wm8960_hw_params
,
874 .digital_mute
= wm8960_mute
,
875 .set_fmt
= wm8960_set_dai_fmt
,
876 .set_clkdiv
= wm8960_set_dai_clkdiv
,
877 .set_pll
= wm8960_set_dai_pll
,
880 static struct snd_soc_dai_driver wm8960_dai
= {
881 .name
= "wm8960-hifi",
883 .stream_name
= "Playback",
886 .rates
= WM8960_RATES
,
887 .formats
= WM8960_FORMATS
,},
889 .stream_name
= "Capture",
892 .rates
= WM8960_RATES
,
893 .formats
= WM8960_FORMATS
,},
894 .ops
= &wm8960_dai_ops
,
895 .symmetric_rates
= 1,
898 static int wm8960_suspend(struct snd_soc_codec
*codec
, pm_message_t state
)
900 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
902 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_OFF
);
906 static int wm8960_resume(struct snd_soc_codec
*codec
)
908 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
910 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
914 static int wm8960_probe(struct snd_soc_codec
*codec
)
916 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
917 struct wm8960_data
*pdata
= dev_get_platdata(codec
->dev
);
921 wm8960
->set_bias_level
= wm8960_set_bias_level_out3
;
924 dev_warn(codec
->dev
, "No platform data supplied\n");
926 if (pdata
->dres
> WM8960_DRES_MAX
) {
927 dev_err(codec
->dev
, "Invalid DRES: %d\n", pdata
->dres
);
932 wm8960
->set_bias_level
= wm8960_set_bias_level_capless
;
935 ret
= snd_soc_codec_set_cache_io(codec
, 7, 9, wm8960
->control_type
);
937 dev_err(codec
->dev
, "Failed to set cache I/O: %d\n", ret
);
941 ret
= wm8960_reset(codec
);
943 dev_err(codec
->dev
, "Failed to issue reset\n");
947 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
949 /* Latch the update bits */
950 reg
= snd_soc_read(codec
, WM8960_LINVOL
);
951 snd_soc_write(codec
, WM8960_LINVOL
, reg
| 0x100);
952 reg
= snd_soc_read(codec
, WM8960_RINVOL
);
953 snd_soc_write(codec
, WM8960_RINVOL
, reg
| 0x100);
954 reg
= snd_soc_read(codec
, WM8960_LADC
);
955 snd_soc_write(codec
, WM8960_LADC
, reg
| 0x100);
956 reg
= snd_soc_read(codec
, WM8960_RADC
);
957 snd_soc_write(codec
, WM8960_RADC
, reg
| 0x100);
958 reg
= snd_soc_read(codec
, WM8960_LDAC
);
959 snd_soc_write(codec
, WM8960_LDAC
, reg
| 0x100);
960 reg
= snd_soc_read(codec
, WM8960_RDAC
);
961 snd_soc_write(codec
, WM8960_RDAC
, reg
| 0x100);
962 reg
= snd_soc_read(codec
, WM8960_LOUT1
);
963 snd_soc_write(codec
, WM8960_LOUT1
, reg
| 0x100);
964 reg
= snd_soc_read(codec
, WM8960_ROUT1
);
965 snd_soc_write(codec
, WM8960_ROUT1
, reg
| 0x100);
966 reg
= snd_soc_read(codec
, WM8960_LOUT2
);
967 snd_soc_write(codec
, WM8960_LOUT2
, reg
| 0x100);
968 reg
= snd_soc_read(codec
, WM8960_ROUT2
);
969 snd_soc_write(codec
, WM8960_ROUT2
, reg
| 0x100);
971 snd_soc_add_controls(codec
, wm8960_snd_controls
,
972 ARRAY_SIZE(wm8960_snd_controls
));
973 wm8960_add_widgets(codec
);
978 /* power down chip */
979 static int wm8960_remove(struct snd_soc_codec
*codec
)
981 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
983 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_OFF
);
987 static struct snd_soc_codec_driver soc_codec_dev_wm8960
= {
988 .probe
= wm8960_probe
,
989 .remove
= wm8960_remove
,
990 .suspend
= wm8960_suspend
,
991 .resume
= wm8960_resume
,
992 .set_bias_level
= wm8960_set_bias_level
,
993 .reg_cache_size
= ARRAY_SIZE(wm8960_reg
),
994 .reg_word_size
= sizeof(u16
),
995 .reg_cache_default
= wm8960_reg
,
998 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
999 static __devinit
int wm8960_i2c_probe(struct i2c_client
*i2c
,
1000 const struct i2c_device_id
*id
)
1002 struct wm8960_priv
*wm8960
;
1005 wm8960
= kzalloc(sizeof(struct wm8960_priv
), GFP_KERNEL
);
1009 i2c_set_clientdata(i2c
, wm8960
);
1010 wm8960
->control_type
= SND_SOC_I2C
;
1012 ret
= snd_soc_register_codec(&i2c
->dev
,
1013 &soc_codec_dev_wm8960
, &wm8960_dai
, 1);
1019 static __devexit
int wm8960_i2c_remove(struct i2c_client
*client
)
1021 snd_soc_unregister_codec(&client
->dev
);
1022 kfree(i2c_get_clientdata(client
));
1026 static const struct i2c_device_id wm8960_i2c_id
[] = {
1030 MODULE_DEVICE_TABLE(i2c
, wm8960_i2c_id
);
1032 static struct i2c_driver wm8960_i2c_driver
= {
1034 .name
= "wm8960-codec",
1035 .owner
= THIS_MODULE
,
1037 .probe
= wm8960_i2c_probe
,
1038 .remove
= __devexit_p(wm8960_i2c_remove
),
1039 .id_table
= wm8960_i2c_id
,
1043 static int __init
wm8960_modinit(void)
1046 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1047 ret
= i2c_add_driver(&wm8960_i2c_driver
);
1049 printk(KERN_ERR
"Failed to register WM8960 I2C driver: %d\n",
1055 module_init(wm8960_modinit
);
1057 static void __exit
wm8960_exit(void)
1059 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1060 i2c_del_driver(&wm8960_i2c_driver
);
1063 module_exit(wm8960_exit
);
1065 MODULE_DESCRIPTION("ASoC WM8960 driver");
1066 MODULE_AUTHOR("Liam Girdwood");
1067 MODULE_LICENSE("GPL");