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/soc-dapm.h>
24 #include <sound/initval.h>
25 #include <sound/tlv.h>
26 #include <sound/wm8960.h>
30 #define AUDIO_NAME "wm8960"
33 #define WM8960_VMID_MASK 0x180
34 #define WM8960_VREF 0x40
37 #define WM8960_PWR2_LOUT1 0x40
38 #define WM8960_PWR2_ROUT1 0x20
39 #define WM8960_PWR2_OUT3 0x02
41 /* R28 - Anti-pop 1 */
42 #define WM8960_POBCTRL 0x80
43 #define WM8960_BUFDCOPEN 0x10
44 #define WM8960_BUFIOEN 0x08
45 #define WM8960_SOFT_ST 0x04
46 #define WM8960_HPSTBY 0x01
48 /* R29 - Anti-pop 2 */
49 #define WM8960_DISOP 0x40
50 #define WM8960_DRES_MASK 0x30
53 * wm8960 register cache
54 * We can't read the WM8960 register space when we are
55 * using 2 wire for device control, so we cache them instead.
57 static const u16 wm8960_reg
[WM8960_CACHEREGNUM
] = {
58 0x0097, 0x0097, 0x0000, 0x0000,
59 0x0000, 0x0008, 0x0000, 0x000a,
60 0x01c0, 0x0000, 0x00ff, 0x00ff,
61 0x0000, 0x0000, 0x0000, 0x0000,
62 0x0000, 0x007b, 0x0100, 0x0032,
63 0x0000, 0x00c3, 0x00c3, 0x01c0,
64 0x0000, 0x0000, 0x0000, 0x0000,
65 0x0000, 0x0000, 0x0000, 0x0000,
66 0x0100, 0x0100, 0x0050, 0x0050,
67 0x0050, 0x0050, 0x0000, 0x0000,
68 0x0000, 0x0000, 0x0040, 0x0000,
69 0x0000, 0x0050, 0x0050, 0x0000,
70 0x0002, 0x0037, 0x004d, 0x0080,
71 0x0008, 0x0031, 0x0026, 0x00e9,
75 u16 reg_cache
[WM8960_CACHEREGNUM
];
76 enum snd_soc_control_type control_type
;
78 int (*set_bias_level
)(struct snd_soc_codec
*,
79 enum snd_soc_bias_level level
);
80 struct snd_soc_dapm_widget
*lout1
;
81 struct snd_soc_dapm_widget
*rout1
;
82 struct snd_soc_dapm_widget
*out3
;
87 #define wm8960_reset(c) snd_soc_write(c, WM8960_RESET, 0)
89 /* enumerated controls */
90 static const char *wm8960_polarity
[] = {"No Inversion", "Left Inverted",
91 "Right Inverted", "Stereo Inversion"};
92 static const char *wm8960_3d_upper_cutoff
[] = {"High", "Low"};
93 static const char *wm8960_3d_lower_cutoff
[] = {"Low", "High"};
94 static const char *wm8960_alcfunc
[] = {"Off", "Right", "Left", "Stereo"};
95 static const char *wm8960_alcmode
[] = {"ALC", "Limiter"};
97 static const struct soc_enum wm8960_enum
[] = {
98 SOC_ENUM_SINGLE(WM8960_DACCTL1
, 5, 4, wm8960_polarity
),
99 SOC_ENUM_SINGLE(WM8960_DACCTL2
, 5, 4, wm8960_polarity
),
100 SOC_ENUM_SINGLE(WM8960_3D
, 6, 2, wm8960_3d_upper_cutoff
),
101 SOC_ENUM_SINGLE(WM8960_3D
, 5, 2, wm8960_3d_lower_cutoff
),
102 SOC_ENUM_SINGLE(WM8960_ALC1
, 7, 4, wm8960_alcfunc
),
103 SOC_ENUM_SINGLE(WM8960_ALC3
, 8, 2, wm8960_alcmode
),
106 static const int deemph_settings
[] = { 0, 32000, 44100, 48000 };
108 static int wm8960_set_deemph(struct snd_soc_codec
*codec
)
110 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
113 /* If we're using deemphasis select the nearest available sample
116 if (wm8960
->deemph
) {
118 for (i
= 2; i
< ARRAY_SIZE(deemph_settings
); i
++) {
119 if (abs(deemph_settings
[i
] - wm8960
->playback_fs
) <
120 abs(deemph_settings
[best
] - wm8960
->playback_fs
))
129 dev_dbg(codec
->dev
, "Set deemphasis %d\n", val
);
131 return snd_soc_update_bits(codec
, WM8960_DACCTL1
,
135 static int wm8960_get_deemph(struct snd_kcontrol
*kcontrol
,
136 struct snd_ctl_elem_value
*ucontrol
)
138 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
139 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
141 return wm8960
->deemph
;
144 static int wm8960_put_deemph(struct snd_kcontrol
*kcontrol
,
145 struct snd_ctl_elem_value
*ucontrol
)
147 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
148 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
149 int deemph
= ucontrol
->value
.enumerated
.item
[0];
154 wm8960
->deemph
= deemph
;
156 return wm8960_set_deemph(codec
);
159 static const DECLARE_TLV_DB_SCALE(adc_tlv
, -9700, 50, 0);
160 static const DECLARE_TLV_DB_SCALE(dac_tlv
, -12700, 50, 1);
161 static const DECLARE_TLV_DB_SCALE(bypass_tlv
, -2100, 300, 0);
162 static const DECLARE_TLV_DB_SCALE(out_tlv
, -12100, 100, 1);
164 static const struct snd_kcontrol_new wm8960_snd_controls
[] = {
165 SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL
, WM8960_RINVOL
,
167 SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL
, WM8960_RINVOL
,
169 SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL
, WM8960_RINVOL
,
172 SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC
, WM8960_RDAC
,
175 SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1
, WM8960_ROUT1
,
177 SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1
, WM8960_ROUT1
,
180 SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2
, WM8960_ROUT2
,
182 SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2
, WM8960_ROUT2
,
184 SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3
, 3, 5, 0),
185 SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3
, 0, 5, 0),
187 SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1
, 7, 1, 0),
188 SOC_ENUM("ADC Polarity", wm8960_enum
[0]),
189 SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1
, 0, 1, 0),
191 SOC_ENUM("DAC Polarity", wm8960_enum
[2]),
192 SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0,
193 wm8960_get_deemph
, wm8960_put_deemph
),
195 SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum
[2]),
196 SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum
[3]),
197 SOC_SINGLE("3D Volume", WM8960_3D
, 1, 15, 0),
198 SOC_SINGLE("3D Switch", WM8960_3D
, 0, 1, 0),
200 SOC_ENUM("ALC Function", wm8960_enum
[4]),
201 SOC_SINGLE("ALC Max Gain", WM8960_ALC1
, 4, 7, 0),
202 SOC_SINGLE("ALC Target", WM8960_ALC1
, 0, 15, 1),
203 SOC_SINGLE("ALC Min Gain", WM8960_ALC2
, 4, 7, 0),
204 SOC_SINGLE("ALC Hold Time", WM8960_ALC2
, 0, 15, 0),
205 SOC_ENUM("ALC Mode", wm8960_enum
[5]),
206 SOC_SINGLE("ALC Decay", WM8960_ALC3
, 4, 15, 0),
207 SOC_SINGLE("ALC Attack", WM8960_ALC3
, 0, 15, 0),
209 SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG
, 3, 31, 0),
210 SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG
, 0, 1, 0),
212 SOC_DOUBLE_R("ADC PCM Capture Volume", WM8960_LINPATH
, WM8960_RINPATH
,
215 SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume",
216 WM8960_BYPASS1
, 4, 7, 1, bypass_tlv
),
217 SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume",
218 WM8960_LOUTMIX
, 4, 7, 1, bypass_tlv
),
219 SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume",
220 WM8960_BYPASS2
, 4, 7, 1, bypass_tlv
),
221 SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume",
222 WM8960_ROUTMIX
, 4, 7, 1, bypass_tlv
),
225 static const struct snd_kcontrol_new wm8960_lin_boost
[] = {
226 SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH
, 6, 1, 0),
227 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH
, 7, 1, 0),
228 SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH
, 8, 1, 0),
231 static const struct snd_kcontrol_new wm8960_lin
[] = {
232 SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH
, 3, 1, 0),
235 static const struct snd_kcontrol_new wm8960_rin_boost
[] = {
236 SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH
, 6, 1, 0),
237 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH
, 7, 1, 0),
238 SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH
, 8, 1, 0),
241 static const struct snd_kcontrol_new wm8960_rin
[] = {
242 SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH
, 3, 1, 0),
245 static const struct snd_kcontrol_new wm8960_loutput_mixer
[] = {
246 SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX
, 8, 1, 0),
247 SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX
, 7, 1, 0),
248 SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1
, 7, 1, 0),
251 static const struct snd_kcontrol_new wm8960_routput_mixer
[] = {
252 SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX
, 8, 1, 0),
253 SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX
, 7, 1, 0),
254 SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2
, 7, 1, 0),
257 static const struct snd_kcontrol_new wm8960_mono_out
[] = {
258 SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1
, 7, 1, 0),
259 SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2
, 7, 1, 0),
262 static const struct snd_soc_dapm_widget wm8960_dapm_widgets
[] = {
263 SND_SOC_DAPM_INPUT("LINPUT1"),
264 SND_SOC_DAPM_INPUT("RINPUT1"),
265 SND_SOC_DAPM_INPUT("LINPUT2"),
266 SND_SOC_DAPM_INPUT("RINPUT2"),
267 SND_SOC_DAPM_INPUT("LINPUT3"),
268 SND_SOC_DAPM_INPUT("RINPUT3"),
270 SND_SOC_DAPM_MICBIAS("MICB", WM8960_POWER1
, 1, 0),
272 SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1
, 5, 0,
273 wm8960_lin_boost
, ARRAY_SIZE(wm8960_lin_boost
)),
274 SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1
, 4, 0,
275 wm8960_rin_boost
, ARRAY_SIZE(wm8960_rin_boost
)),
277 SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3
, 5, 0,
278 wm8960_lin
, ARRAY_SIZE(wm8960_lin
)),
279 SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3
, 4, 0,
280 wm8960_rin
, ARRAY_SIZE(wm8960_rin
)),
282 SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER2
, 3, 0),
283 SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER2
, 2, 0),
285 SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2
, 8, 0),
286 SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2
, 7, 0),
288 SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3
, 3, 0,
289 &wm8960_loutput_mixer
[0],
290 ARRAY_SIZE(wm8960_loutput_mixer
)),
291 SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3
, 2, 0,
292 &wm8960_routput_mixer
[0],
293 ARRAY_SIZE(wm8960_routput_mixer
)),
295 SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2
, 6, 0, NULL
, 0),
296 SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2
, 5, 0, NULL
, 0),
298 SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2
, 4, 0, NULL
, 0),
299 SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2
, 3, 0, NULL
, 0),
301 SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1
, 7, 0, NULL
, 0),
302 SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1
, 6, 0, NULL
, 0),
304 SND_SOC_DAPM_OUTPUT("SPK_LP"),
305 SND_SOC_DAPM_OUTPUT("SPK_LN"),
306 SND_SOC_DAPM_OUTPUT("HP_L"),
307 SND_SOC_DAPM_OUTPUT("HP_R"),
308 SND_SOC_DAPM_OUTPUT("SPK_RP"),
309 SND_SOC_DAPM_OUTPUT("SPK_RN"),
310 SND_SOC_DAPM_OUTPUT("OUT3"),
313 static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3
[] = {
314 SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2
, 1, 0,
316 ARRAY_SIZE(wm8960_mono_out
)),
319 /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */
320 static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless
[] = {
321 SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2
, 1, 0, NULL
, 0),
324 static const struct snd_soc_dapm_route audio_paths
[] = {
325 { "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" },
326 { "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" },
327 { "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" },
329 { "Left Input Mixer", "Boost Switch", "Left Boost Mixer", },
330 { "Left Input Mixer", NULL
, "LINPUT1", }, /* Really Boost Switch */
331 { "Left Input Mixer", NULL
, "LINPUT2" },
332 { "Left Input Mixer", NULL
, "LINPUT3" },
334 { "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" },
335 { "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" },
336 { "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" },
338 { "Right Input Mixer", "Boost Switch", "Right Boost Mixer", },
339 { "Right Input Mixer", NULL
, "RINPUT1", }, /* Really Boost Switch */
340 { "Right Input Mixer", NULL
, "RINPUT2" },
341 { "Right Input Mixer", NULL
, "LINPUT3" },
343 { "Left ADC", NULL
, "Left Input Mixer" },
344 { "Right ADC", NULL
, "Right Input Mixer" },
346 { "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" },
347 { "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer"} ,
348 { "Left Output Mixer", "PCM Playback Switch", "Left DAC" },
350 { "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" },
351 { "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" } ,
352 { "Right Output Mixer", "PCM Playback Switch", "Right DAC" },
354 { "LOUT1 PGA", NULL
, "Left Output Mixer" },
355 { "ROUT1 PGA", NULL
, "Right Output Mixer" },
357 { "HP_L", NULL
, "LOUT1 PGA" },
358 { "HP_R", NULL
, "ROUT1 PGA" },
360 { "Left Speaker PGA", NULL
, "Left Output Mixer" },
361 { "Right Speaker PGA", NULL
, "Right Output Mixer" },
363 { "Left Speaker Output", NULL
, "Left Speaker PGA" },
364 { "Right Speaker Output", NULL
, "Right Speaker PGA" },
366 { "SPK_LN", NULL
, "Left Speaker Output" },
367 { "SPK_LP", NULL
, "Left Speaker Output" },
368 { "SPK_RN", NULL
, "Right Speaker Output" },
369 { "SPK_RP", NULL
, "Right Speaker Output" },
372 static const struct snd_soc_dapm_route audio_paths_out3
[] = {
373 { "Mono Output Mixer", "Left Switch", "Left Output Mixer" },
374 { "Mono Output Mixer", "Right Switch", "Right Output Mixer" },
376 { "OUT3", NULL
, "Mono Output Mixer", }
379 static const struct snd_soc_dapm_route audio_paths_capless
[] = {
380 { "HP_L", NULL
, "OUT3 VMID" },
381 { "HP_R", NULL
, "OUT3 VMID" },
383 { "OUT3 VMID", NULL
, "Left Output Mixer" },
384 { "OUT3 VMID", NULL
, "Right Output Mixer" },
387 static int wm8960_add_widgets(struct snd_soc_codec
*codec
)
389 struct wm8960_data
*pdata
= codec
->dev
->platform_data
;
390 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
391 struct snd_soc_dapm_widget
*w
;
393 snd_soc_dapm_new_controls(codec
, wm8960_dapm_widgets
,
394 ARRAY_SIZE(wm8960_dapm_widgets
));
396 snd_soc_dapm_add_routes(codec
, audio_paths
, ARRAY_SIZE(audio_paths
));
398 /* In capless mode OUT3 is used to provide VMID for the
399 * headphone outputs, otherwise it is used as a mono mixer.
401 if (pdata
&& pdata
->capless
) {
402 snd_soc_dapm_new_controls(codec
, wm8960_dapm_widgets_capless
,
403 ARRAY_SIZE(wm8960_dapm_widgets_capless
));
405 snd_soc_dapm_add_routes(codec
, audio_paths_capless
,
406 ARRAY_SIZE(audio_paths_capless
));
408 snd_soc_dapm_new_controls(codec
, wm8960_dapm_widgets_out3
,
409 ARRAY_SIZE(wm8960_dapm_widgets_out3
));
411 snd_soc_dapm_add_routes(codec
, audio_paths_out3
,
412 ARRAY_SIZE(audio_paths_out3
));
415 /* We need to power up the headphone output stage out of
416 * sequence for capless mode. To save scanning the widget
417 * list each time to find the desired power state do so now
418 * and save the result.
420 list_for_each_entry(w
, &codec
->dapm_widgets
, list
) {
421 if (strcmp(w
->name
, "LOUT1 PGA") == 0)
423 if (strcmp(w
->name
, "ROUT1 PGA") == 0)
425 if (strcmp(w
->name
, "OUT3 VMID") == 0)
432 static int wm8960_set_dai_fmt(struct snd_soc_dai
*codec_dai
,
435 struct snd_soc_codec
*codec
= codec_dai
->codec
;
438 /* set master/slave audio interface */
439 switch (fmt
& SND_SOC_DAIFMT_MASTER_MASK
) {
440 case SND_SOC_DAIFMT_CBM_CFM
:
443 case SND_SOC_DAIFMT_CBS_CFS
:
449 /* interface format */
450 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
451 case SND_SOC_DAIFMT_I2S
:
454 case SND_SOC_DAIFMT_RIGHT_J
:
456 case SND_SOC_DAIFMT_LEFT_J
:
459 case SND_SOC_DAIFMT_DSP_A
:
462 case SND_SOC_DAIFMT_DSP_B
:
469 /* clock inversion */
470 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
471 case SND_SOC_DAIFMT_NB_NF
:
473 case SND_SOC_DAIFMT_IB_IF
:
476 case SND_SOC_DAIFMT_IB_NF
:
479 case SND_SOC_DAIFMT_NB_IF
:
487 snd_soc_write(codec
, WM8960_IFACE1
, iface
);
506 static int wm8960_hw_params(struct snd_pcm_substream
*substream
,
507 struct snd_pcm_hw_params
*params
,
508 struct snd_soc_dai
*dai
)
510 struct snd_soc_pcm_runtime
*rtd
= substream
->private_data
;
511 struct snd_soc_codec
*codec
= rtd
->codec
;
512 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
513 u16 iface
= snd_soc_read(codec
, WM8960_IFACE1
) & 0xfff3;
517 switch (params_format(params
)) {
518 case SNDRV_PCM_FORMAT_S16_LE
:
520 case SNDRV_PCM_FORMAT_S20_3LE
:
523 case SNDRV_PCM_FORMAT_S24_LE
:
528 /* Update filters for the new rate */
529 if (substream
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
530 wm8960
->playback_fs
= params_rate(params
);
531 wm8960_set_deemph(codec
);
533 for (i
= 0; i
< ARRAY_SIZE(alc_rates
); i
++)
534 if (alc_rates
[i
].rate
== params_rate(params
))
535 snd_soc_update_bits(codec
,
541 snd_soc_write(codec
, WM8960_IFACE1
, iface
);
545 static int wm8960_mute(struct snd_soc_dai
*dai
, int mute
)
547 struct snd_soc_codec
*codec
= dai
->codec
;
548 u16 mute_reg
= snd_soc_read(codec
, WM8960_DACCTL1
) & 0xfff7;
551 snd_soc_write(codec
, WM8960_DACCTL1
, mute_reg
| 0x8);
553 snd_soc_write(codec
, WM8960_DACCTL1
, mute_reg
);
557 static int wm8960_set_bias_level_out3(struct snd_soc_codec
*codec
,
558 enum snd_soc_bias_level level
)
563 case SND_SOC_BIAS_ON
:
566 case SND_SOC_BIAS_PREPARE
:
567 /* Set VMID to 2x50k */
568 reg
= snd_soc_read(codec
, WM8960_POWER1
);
571 snd_soc_write(codec
, WM8960_POWER1
, reg
);
574 case SND_SOC_BIAS_STANDBY
:
575 if (codec
->bias_level
== SND_SOC_BIAS_OFF
) {
576 /* Enable anti-pop features */
577 snd_soc_write(codec
, WM8960_APOP1
,
578 WM8960_POBCTRL
| WM8960_SOFT_ST
|
579 WM8960_BUFDCOPEN
| WM8960_BUFIOEN
);
581 /* Enable & ramp VMID at 2x50k */
582 reg
= snd_soc_read(codec
, WM8960_POWER1
);
584 snd_soc_write(codec
, WM8960_POWER1
, reg
);
588 snd_soc_write(codec
, WM8960_POWER1
, reg
| WM8960_VREF
);
590 /* Disable anti-pop features */
591 snd_soc_write(codec
, WM8960_APOP1
, WM8960_BUFIOEN
);
594 /* Set VMID to 2x250k */
595 reg
= snd_soc_read(codec
, WM8960_POWER1
);
598 snd_soc_write(codec
, WM8960_POWER1
, reg
);
601 case SND_SOC_BIAS_OFF
:
602 /* Enable anti-pop features */
603 snd_soc_write(codec
, WM8960_APOP1
,
604 WM8960_POBCTRL
| WM8960_SOFT_ST
|
605 WM8960_BUFDCOPEN
| WM8960_BUFIOEN
);
607 /* Disable VMID and VREF, let them discharge */
608 snd_soc_write(codec
, WM8960_POWER1
, 0);
613 codec
->bias_level
= level
;
618 static int wm8960_set_bias_level_capless(struct snd_soc_codec
*codec
,
619 enum snd_soc_bias_level level
)
621 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
625 case SND_SOC_BIAS_ON
:
628 case SND_SOC_BIAS_PREPARE
:
629 switch (codec
->bias_level
) {
630 case SND_SOC_BIAS_STANDBY
:
631 /* Enable anti pop mode */
632 snd_soc_update_bits(codec
, WM8960_APOP1
,
633 WM8960_POBCTRL
| WM8960_SOFT_ST
|
635 WM8960_POBCTRL
| WM8960_SOFT_ST
|
638 /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */
640 if (wm8960
->lout1
&& wm8960
->lout1
->power
)
641 reg
|= WM8960_PWR2_LOUT1
;
642 if (wm8960
->rout1
&& wm8960
->rout1
->power
)
643 reg
|= WM8960_PWR2_ROUT1
;
644 if (wm8960
->out3
&& wm8960
->out3
->power
)
645 reg
|= WM8960_PWR2_OUT3
;
646 snd_soc_update_bits(codec
, WM8960_POWER2
,
649 WM8960_PWR2_OUT3
, reg
);
651 /* Enable VMID at 2*50k */
652 snd_soc_update_bits(codec
, WM8960_POWER1
,
653 WM8960_VMID_MASK
, 0x80);
659 snd_soc_update_bits(codec
, WM8960_POWER1
,
660 WM8960_VREF
, WM8960_VREF
);
665 case SND_SOC_BIAS_ON
:
666 /* Enable anti-pop mode */
667 snd_soc_update_bits(codec
, WM8960_APOP1
,
668 WM8960_POBCTRL
| WM8960_SOFT_ST
|
670 WM8960_POBCTRL
| WM8960_SOFT_ST
|
673 /* Disable VMID and VREF */
674 snd_soc_update_bits(codec
, WM8960_POWER1
,
675 WM8960_VREF
| WM8960_VMID_MASK
, 0);
683 case SND_SOC_BIAS_STANDBY
:
684 switch (codec
->bias_level
) {
685 case SND_SOC_BIAS_PREPARE
:
686 /* Disable HP discharge */
687 snd_soc_update_bits(codec
, WM8960_APOP2
,
688 WM8960_DISOP
| WM8960_DRES_MASK
,
691 /* Disable anti-pop features */
692 snd_soc_update_bits(codec
, WM8960_APOP1
,
693 WM8960_POBCTRL
| WM8960_SOFT_ST
|
695 WM8960_POBCTRL
| WM8960_SOFT_ST
|
704 case SND_SOC_BIAS_OFF
:
708 codec
->bias_level
= level
;
720 /* The size in bits of the pll divide multiplied by 10
721 * to allow rounding later */
722 #define FIXED_PLL_SIZE ((1 << 24) * 10)
724 static int pll_factors(unsigned int source
, unsigned int target
,
725 struct _pll_div
*pll_div
)
727 unsigned long long Kpart
;
728 unsigned int K
, Ndiv
, Nmod
;
730 pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source
, target
);
732 /* Scale up target to PLL operating frequency */
735 Ndiv
= target
/ source
;
738 pll_div
->pre_div
= 1;
739 Ndiv
= target
/ source
;
741 pll_div
->pre_div
= 0;
743 if ((Ndiv
< 6) || (Ndiv
> 12)) {
744 pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv
);
749 Nmod
= target
% source
;
750 Kpart
= FIXED_PLL_SIZE
* (long long)Nmod
;
752 do_div(Kpart
, source
);
754 K
= Kpart
& 0xFFFFFFFF;
756 /* Check if we need to round */
760 /* Move down to proper range now rounding is done */
765 pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n",
766 pll_div
->n
, pll_div
->k
, pll_div
->pre_div
);
771 static int wm8960_set_dai_pll(struct snd_soc_dai
*codec_dai
, int pll_id
,
772 int source
, unsigned int freq_in
, unsigned int freq_out
)
774 struct snd_soc_codec
*codec
= codec_dai
->codec
;
776 static struct _pll_div pll_div
;
779 if (freq_in
&& freq_out
) {
780 ret
= pll_factors(freq_in
, freq_out
, &pll_div
);
785 /* Disable the PLL: even if we are changing the frequency the
786 * PLL needs to be disabled while we do so. */
787 snd_soc_write(codec
, WM8960_CLOCK1
,
788 snd_soc_read(codec
, WM8960_CLOCK1
) & ~1);
789 snd_soc_write(codec
, WM8960_POWER2
,
790 snd_soc_read(codec
, WM8960_POWER2
) & ~1);
792 if (!freq_in
|| !freq_out
)
795 reg
= snd_soc_read(codec
, WM8960_PLL1
) & ~0x3f;
796 reg
|= pll_div
.pre_div
<< 4;
802 snd_soc_write(codec
, WM8960_PLL2
, (pll_div
.k
>> 18) & 0x3f);
803 snd_soc_write(codec
, WM8960_PLL3
, (pll_div
.k
>> 9) & 0x1ff);
804 snd_soc_write(codec
, WM8960_PLL4
, pll_div
.k
& 0x1ff);
806 snd_soc_write(codec
, WM8960_PLL1
, reg
);
809 snd_soc_write(codec
, WM8960_POWER2
,
810 snd_soc_read(codec
, WM8960_POWER2
) | 1);
812 snd_soc_write(codec
, WM8960_CLOCK1
,
813 snd_soc_read(codec
, WM8960_CLOCK1
) | 1);
818 static int wm8960_set_dai_clkdiv(struct snd_soc_dai
*codec_dai
,
821 struct snd_soc_codec
*codec
= codec_dai
->codec
;
825 case WM8960_SYSCLKDIV
:
826 reg
= snd_soc_read(codec
, WM8960_CLOCK1
) & 0x1f9;
827 snd_soc_write(codec
, WM8960_CLOCK1
, reg
| div
);
830 reg
= snd_soc_read(codec
, WM8960_CLOCK1
) & 0x1c7;
831 snd_soc_write(codec
, WM8960_CLOCK1
, reg
| div
);
833 case WM8960_OPCLKDIV
:
834 reg
= snd_soc_read(codec
, WM8960_PLL1
) & 0x03f;
835 snd_soc_write(codec
, WM8960_PLL1
, reg
| div
);
838 reg
= snd_soc_read(codec
, WM8960_CLOCK2
) & 0x03f;
839 snd_soc_write(codec
, WM8960_CLOCK2
, reg
| div
);
841 case WM8960_TOCLKSEL
:
842 reg
= snd_soc_read(codec
, WM8960_ADDCTL1
) & 0x1fd;
843 snd_soc_write(codec
, WM8960_ADDCTL1
, reg
| div
);
852 static int wm8960_set_bias_level(struct snd_soc_codec
*codec
,
853 enum snd_soc_bias_level level
)
855 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
857 return wm8960
->set_bias_level(codec
, level
);
860 #define WM8960_RATES SNDRV_PCM_RATE_8000_48000
862 #define WM8960_FORMATS \
863 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
864 SNDRV_PCM_FMTBIT_S24_LE)
866 static struct snd_soc_dai_ops wm8960_dai_ops
= {
867 .hw_params
= wm8960_hw_params
,
868 .digital_mute
= wm8960_mute
,
869 .set_fmt
= wm8960_set_dai_fmt
,
870 .set_clkdiv
= wm8960_set_dai_clkdiv
,
871 .set_pll
= wm8960_set_dai_pll
,
874 static struct snd_soc_dai_driver wm8960_dai
= {
875 .name
= "wm8960-hifi",
877 .stream_name
= "Playback",
880 .rates
= WM8960_RATES
,
881 .formats
= WM8960_FORMATS
,},
883 .stream_name
= "Capture",
886 .rates
= WM8960_RATES
,
887 .formats
= WM8960_FORMATS
,},
888 .ops
= &wm8960_dai_ops
,
889 .symmetric_rates
= 1,
892 static int wm8960_suspend(struct snd_soc_codec
*codec
, pm_message_t state
)
894 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
896 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_OFF
);
900 static int wm8960_resume(struct snd_soc_codec
*codec
)
902 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
905 u16
*cache
= codec
->reg_cache
;
907 /* Sync reg_cache with the hardware */
908 for (i
= 0; i
< ARRAY_SIZE(wm8960_reg
); i
++) {
909 data
[0] = (i
<< 1) | ((cache
[i
] >> 8) & 0x0001);
910 data
[1] = cache
[i
] & 0x00ff;
911 codec
->hw_write(codec
->control_data
, data
, 2);
914 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
918 static int wm8960_probe(struct snd_soc_codec
*codec
)
920 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
921 struct wm8960_data
*pdata
= dev_get_platdata(codec
->dev
);
925 wm8960
->set_bias_level
= wm8960_set_bias_level_out3
;
926 codec
->control_data
= wm8960
->control_data
;
929 dev_warn(codec
->dev
, "No platform data supplied\n");
931 if (pdata
->dres
> WM8960_DRES_MAX
) {
932 dev_err(codec
->dev
, "Invalid DRES: %d\n", pdata
->dres
);
937 wm8960
->set_bias_level
= wm8960_set_bias_level_capless
;
940 ret
= snd_soc_codec_set_cache_io(codec
, 7, 9, wm8960
->control_type
);
942 dev_err(codec
->dev
, "Failed to set cache I/O: %d\n", ret
);
946 ret
= wm8960_reset(codec
);
948 dev_err(codec
->dev
, "Failed to issue reset\n");
952 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
954 /* Latch the update bits */
955 reg
= snd_soc_read(codec
, WM8960_LINVOL
);
956 snd_soc_write(codec
, WM8960_LINVOL
, reg
| 0x100);
957 reg
= snd_soc_read(codec
, WM8960_RINVOL
);
958 snd_soc_write(codec
, WM8960_RINVOL
, reg
| 0x100);
959 reg
= snd_soc_read(codec
, WM8960_LADC
);
960 snd_soc_write(codec
, WM8960_LADC
, reg
| 0x100);
961 reg
= snd_soc_read(codec
, WM8960_RADC
);
962 snd_soc_write(codec
, WM8960_RADC
, reg
| 0x100);
963 reg
= snd_soc_read(codec
, WM8960_LDAC
);
964 snd_soc_write(codec
, WM8960_LDAC
, reg
| 0x100);
965 reg
= snd_soc_read(codec
, WM8960_RDAC
);
966 snd_soc_write(codec
, WM8960_RDAC
, reg
| 0x100);
967 reg
= snd_soc_read(codec
, WM8960_LOUT1
);
968 snd_soc_write(codec
, WM8960_LOUT1
, reg
| 0x100);
969 reg
= snd_soc_read(codec
, WM8960_ROUT1
);
970 snd_soc_write(codec
, WM8960_ROUT1
, reg
| 0x100);
971 reg
= snd_soc_read(codec
, WM8960_LOUT2
);
972 snd_soc_write(codec
, WM8960_LOUT2
, reg
| 0x100);
973 reg
= snd_soc_read(codec
, WM8960_ROUT2
);
974 snd_soc_write(codec
, WM8960_ROUT2
, reg
| 0x100);
976 snd_soc_add_controls(codec
, wm8960_snd_controls
,
977 ARRAY_SIZE(wm8960_snd_controls
));
978 wm8960_add_widgets(codec
);
983 /* power down chip */
984 static int wm8960_remove(struct snd_soc_codec
*codec
)
986 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
988 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_OFF
);
992 static struct snd_soc_codec_driver soc_codec_dev_wm8960
= {
993 .probe
= wm8960_probe
,
994 .remove
= wm8960_remove
,
995 .suspend
= wm8960_suspend
,
996 .resume
= wm8960_resume
,
997 .set_bias_level
= wm8960_set_bias_level
,
998 .reg_cache_size
= ARRAY_SIZE(wm8960_reg
),
999 .reg_word_size
= sizeof(u16
),
1000 .reg_cache_default
= wm8960_reg
,
1003 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1004 static __devinit
int wm8960_i2c_probe(struct i2c_client
*i2c
,
1005 const struct i2c_device_id
*id
)
1007 struct wm8960_priv
*wm8960
;
1010 wm8960
= kzalloc(sizeof(struct wm8960_priv
), GFP_KERNEL
);
1014 i2c_set_clientdata(i2c
, wm8960
);
1015 wm8960
->control_data
= i2c
;
1017 ret
= snd_soc_register_codec(&i2c
->dev
,
1018 &soc_codec_dev_wm8960
, &wm8960_dai
, 1);
1024 static __devexit
int wm8960_i2c_remove(struct i2c_client
*client
)
1026 snd_soc_unregister_codec(&client
->dev
);
1027 kfree(i2c_get_clientdata(client
));
1031 static const struct i2c_device_id wm8960_i2c_id
[] = {
1035 MODULE_DEVICE_TABLE(i2c
, wm8960_i2c_id
);
1037 static struct i2c_driver wm8960_i2c_driver
= {
1039 .name
= "wm8960-codec",
1040 .owner
= THIS_MODULE
,
1042 .probe
= wm8960_i2c_probe
,
1043 .remove
= __devexit_p(wm8960_i2c_remove
),
1044 .id_table
= wm8960_i2c_id
,
1048 static int __init
wm8960_modinit(void)
1051 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1052 ret
= i2c_add_driver(&wm8960_i2c_driver
);
1054 printk(KERN_ERR
"Failed to register WM8960 I2C driver: %d\n",
1060 module_init(wm8960_modinit
);
1062 static void __exit
wm8960_exit(void)
1064 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1065 i2c_del_driver(&wm8960_i2c_driver
);
1068 module_exit(wm8960_exit
);
1070 MODULE_DESCRIPTION("ASoC WM8960 driver");
1071 MODULE_AUTHOR("Liam Girdwood");
1072 MODULE_LICENSE("GPL");