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_context
*dapm
= &codec
->dapm
;
392 struct snd_soc_dapm_widget
*w
;
394 snd_soc_dapm_new_controls(dapm
, wm8960_dapm_widgets
,
395 ARRAY_SIZE(wm8960_dapm_widgets
));
397 snd_soc_dapm_add_routes(dapm
, audio_paths
, ARRAY_SIZE(audio_paths
));
399 /* In capless mode OUT3 is used to provide VMID for the
400 * headphone outputs, otherwise it is used as a mono mixer.
402 if (pdata
&& pdata
->capless
) {
403 snd_soc_dapm_new_controls(dapm
, wm8960_dapm_widgets_capless
,
404 ARRAY_SIZE(wm8960_dapm_widgets_capless
));
406 snd_soc_dapm_add_routes(dapm
, audio_paths_capless
,
407 ARRAY_SIZE(audio_paths_capless
));
409 snd_soc_dapm_new_controls(dapm
, wm8960_dapm_widgets_out3
,
410 ARRAY_SIZE(wm8960_dapm_widgets_out3
));
412 snd_soc_dapm_add_routes(dapm
, audio_paths_out3
,
413 ARRAY_SIZE(audio_paths_out3
));
416 /* We need to power up the headphone output stage out of
417 * sequence for capless mode. To save scanning the widget
418 * list each time to find the desired power state do so now
419 * and save the result.
421 list_for_each_entry(w
, &codec
->dapm
.widgets
, list
) {
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 /* Enable anti-pop features */
578 snd_soc_write(codec
, WM8960_APOP1
,
579 WM8960_POBCTRL
| WM8960_SOFT_ST
|
580 WM8960_BUFDCOPEN
| WM8960_BUFIOEN
);
582 /* Enable & ramp VMID at 2x50k */
583 reg
= snd_soc_read(codec
, WM8960_POWER1
);
585 snd_soc_write(codec
, WM8960_POWER1
, reg
);
589 snd_soc_write(codec
, WM8960_POWER1
, reg
| WM8960_VREF
);
591 /* Disable anti-pop features */
592 snd_soc_write(codec
, WM8960_APOP1
, WM8960_BUFIOEN
);
595 /* Set VMID to 2x250k */
596 reg
= snd_soc_read(codec
, WM8960_POWER1
);
599 snd_soc_write(codec
, WM8960_POWER1
, reg
);
602 case SND_SOC_BIAS_OFF
:
603 /* Enable anti-pop features */
604 snd_soc_write(codec
, WM8960_APOP1
,
605 WM8960_POBCTRL
| WM8960_SOFT_ST
|
606 WM8960_BUFDCOPEN
| WM8960_BUFIOEN
);
608 /* Disable VMID and VREF, let them discharge */
609 snd_soc_write(codec
, WM8960_POWER1
, 0);
614 codec
->dapm
.bias_level
= level
;
619 static int wm8960_set_bias_level_capless(struct snd_soc_codec
*codec
,
620 enum snd_soc_bias_level level
)
622 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
626 case SND_SOC_BIAS_ON
:
629 case SND_SOC_BIAS_PREPARE
:
630 switch (codec
->dapm
.bias_level
) {
631 case SND_SOC_BIAS_STANDBY
:
632 /* Enable anti pop mode */
633 snd_soc_update_bits(codec
, WM8960_APOP1
,
634 WM8960_POBCTRL
| WM8960_SOFT_ST
|
636 WM8960_POBCTRL
| WM8960_SOFT_ST
|
639 /* Enable LOUT1, ROUT1 and OUT3 if they're enabled */
641 if (wm8960
->lout1
&& wm8960
->lout1
->power
)
642 reg
|= WM8960_PWR2_LOUT1
;
643 if (wm8960
->rout1
&& wm8960
->rout1
->power
)
644 reg
|= WM8960_PWR2_ROUT1
;
645 if (wm8960
->out3
&& wm8960
->out3
->power
)
646 reg
|= WM8960_PWR2_OUT3
;
647 snd_soc_update_bits(codec
, WM8960_POWER2
,
650 WM8960_PWR2_OUT3
, reg
);
652 /* Enable VMID at 2*50k */
653 snd_soc_update_bits(codec
, WM8960_POWER1
,
654 WM8960_VMID_MASK
, 0x80);
660 snd_soc_update_bits(codec
, WM8960_POWER1
,
661 WM8960_VREF
, WM8960_VREF
);
666 case SND_SOC_BIAS_ON
:
667 /* Enable anti-pop mode */
668 snd_soc_update_bits(codec
, WM8960_APOP1
,
669 WM8960_POBCTRL
| WM8960_SOFT_ST
|
671 WM8960_POBCTRL
| WM8960_SOFT_ST
|
674 /* Disable VMID and VREF */
675 snd_soc_update_bits(codec
, WM8960_POWER1
,
676 WM8960_VREF
| WM8960_VMID_MASK
, 0);
684 case SND_SOC_BIAS_STANDBY
:
685 switch (codec
->dapm
.bias_level
) {
686 case SND_SOC_BIAS_PREPARE
:
687 /* Disable HP discharge */
688 snd_soc_update_bits(codec
, WM8960_APOP2
,
689 WM8960_DISOP
| WM8960_DRES_MASK
,
692 /* Disable anti-pop features */
693 snd_soc_update_bits(codec
, WM8960_APOP1
,
694 WM8960_POBCTRL
| WM8960_SOFT_ST
|
696 WM8960_POBCTRL
| WM8960_SOFT_ST
|
705 case SND_SOC_BIAS_OFF
:
709 codec
->dapm
.bias_level
= level
;
721 /* The size in bits of the pll divide multiplied by 10
722 * to allow rounding later */
723 #define FIXED_PLL_SIZE ((1 << 24) * 10)
725 static int pll_factors(unsigned int source
, unsigned int target
,
726 struct _pll_div
*pll_div
)
728 unsigned long long Kpart
;
729 unsigned int K
, Ndiv
, Nmod
;
731 pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source
, target
);
733 /* Scale up target to PLL operating frequency */
736 Ndiv
= target
/ source
;
739 pll_div
->pre_div
= 1;
740 Ndiv
= target
/ source
;
742 pll_div
->pre_div
= 0;
744 if ((Ndiv
< 6) || (Ndiv
> 12)) {
745 pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv
);
750 Nmod
= target
% source
;
751 Kpart
= FIXED_PLL_SIZE
* (long long)Nmod
;
753 do_div(Kpart
, source
);
755 K
= Kpart
& 0xFFFFFFFF;
757 /* Check if we need to round */
761 /* Move down to proper range now rounding is done */
766 pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n",
767 pll_div
->n
, pll_div
->k
, pll_div
->pre_div
);
772 static int wm8960_set_dai_pll(struct snd_soc_dai
*codec_dai
, int pll_id
,
773 int source
, unsigned int freq_in
, unsigned int freq_out
)
775 struct snd_soc_codec
*codec
= codec_dai
->codec
;
777 static struct _pll_div pll_div
;
780 if (freq_in
&& freq_out
) {
781 ret
= pll_factors(freq_in
, freq_out
, &pll_div
);
786 /* Disable the PLL: even if we are changing the frequency the
787 * PLL needs to be disabled while we do so. */
788 snd_soc_write(codec
, WM8960_CLOCK1
,
789 snd_soc_read(codec
, WM8960_CLOCK1
) & ~1);
790 snd_soc_write(codec
, WM8960_POWER2
,
791 snd_soc_read(codec
, WM8960_POWER2
) & ~1);
793 if (!freq_in
|| !freq_out
)
796 reg
= snd_soc_read(codec
, WM8960_PLL1
) & ~0x3f;
797 reg
|= pll_div
.pre_div
<< 4;
803 snd_soc_write(codec
, WM8960_PLL2
, (pll_div
.k
>> 18) & 0x3f);
804 snd_soc_write(codec
, WM8960_PLL3
, (pll_div
.k
>> 9) & 0x1ff);
805 snd_soc_write(codec
, WM8960_PLL4
, pll_div
.k
& 0x1ff);
807 snd_soc_write(codec
, WM8960_PLL1
, reg
);
810 snd_soc_write(codec
, WM8960_POWER2
,
811 snd_soc_read(codec
, WM8960_POWER2
) | 1);
813 snd_soc_write(codec
, WM8960_CLOCK1
,
814 snd_soc_read(codec
, WM8960_CLOCK1
) | 1);
819 static int wm8960_set_dai_clkdiv(struct snd_soc_dai
*codec_dai
,
822 struct snd_soc_codec
*codec
= codec_dai
->codec
;
826 case WM8960_SYSCLKDIV
:
827 reg
= snd_soc_read(codec
, WM8960_CLOCK1
) & 0x1f9;
828 snd_soc_write(codec
, WM8960_CLOCK1
, reg
| div
);
831 reg
= snd_soc_read(codec
, WM8960_CLOCK1
) & 0x1c7;
832 snd_soc_write(codec
, WM8960_CLOCK1
, reg
| div
);
834 case WM8960_OPCLKDIV
:
835 reg
= snd_soc_read(codec
, WM8960_PLL1
) & 0x03f;
836 snd_soc_write(codec
, WM8960_PLL1
, reg
| div
);
839 reg
= snd_soc_read(codec
, WM8960_CLOCK2
) & 0x03f;
840 snd_soc_write(codec
, WM8960_CLOCK2
, reg
| div
);
842 case WM8960_TOCLKSEL
:
843 reg
= snd_soc_read(codec
, WM8960_ADDCTL1
) & 0x1fd;
844 snd_soc_write(codec
, WM8960_ADDCTL1
, reg
| div
);
853 static int wm8960_set_bias_level(struct snd_soc_codec
*codec
,
854 enum snd_soc_bias_level level
)
856 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
858 return wm8960
->set_bias_level(codec
, level
);
861 #define WM8960_RATES SNDRV_PCM_RATE_8000_48000
863 #define WM8960_FORMATS \
864 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
865 SNDRV_PCM_FMTBIT_S24_LE)
867 static struct snd_soc_dai_ops wm8960_dai_ops
= {
868 .hw_params
= wm8960_hw_params
,
869 .digital_mute
= wm8960_mute
,
870 .set_fmt
= wm8960_set_dai_fmt
,
871 .set_clkdiv
= wm8960_set_dai_clkdiv
,
872 .set_pll
= wm8960_set_dai_pll
,
875 static struct snd_soc_dai_driver wm8960_dai
= {
876 .name
= "wm8960-hifi",
878 .stream_name
= "Playback",
881 .rates
= WM8960_RATES
,
882 .formats
= WM8960_FORMATS
,},
884 .stream_name
= "Capture",
887 .rates
= WM8960_RATES
,
888 .formats
= WM8960_FORMATS
,},
889 .ops
= &wm8960_dai_ops
,
890 .symmetric_rates
= 1,
893 static int wm8960_suspend(struct snd_soc_codec
*codec
, pm_message_t state
)
895 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
897 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_OFF
);
901 static int wm8960_resume(struct snd_soc_codec
*codec
)
903 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
906 u16
*cache
= codec
->reg_cache
;
908 /* Sync reg_cache with the hardware */
909 for (i
= 0; i
< ARRAY_SIZE(wm8960_reg
); i
++) {
910 data
[0] = (i
<< 1) | ((cache
[i
] >> 8) & 0x0001);
911 data
[1] = cache
[i
] & 0x00ff;
912 codec
->hw_write(codec
->control_data
, data
, 2);
915 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
919 static int wm8960_probe(struct snd_soc_codec
*codec
)
921 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
922 struct wm8960_data
*pdata
= dev_get_platdata(codec
->dev
);
926 wm8960
->set_bias_level
= wm8960_set_bias_level_out3
;
927 codec
->control_data
= wm8960
->control_data
;
930 dev_warn(codec
->dev
, "No platform data supplied\n");
932 if (pdata
->dres
> WM8960_DRES_MAX
) {
933 dev_err(codec
->dev
, "Invalid DRES: %d\n", pdata
->dres
);
938 wm8960
->set_bias_level
= wm8960_set_bias_level_capless
;
941 ret
= snd_soc_codec_set_cache_io(codec
, 7, 9, wm8960
->control_type
);
943 dev_err(codec
->dev
, "Failed to set cache I/O: %d\n", ret
);
947 ret
= wm8960_reset(codec
);
949 dev_err(codec
->dev
, "Failed to issue reset\n");
953 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
955 /* Latch the update bits */
956 reg
= snd_soc_read(codec
, WM8960_LINVOL
);
957 snd_soc_write(codec
, WM8960_LINVOL
, reg
| 0x100);
958 reg
= snd_soc_read(codec
, WM8960_RINVOL
);
959 snd_soc_write(codec
, WM8960_RINVOL
, reg
| 0x100);
960 reg
= snd_soc_read(codec
, WM8960_LADC
);
961 snd_soc_write(codec
, WM8960_LADC
, reg
| 0x100);
962 reg
= snd_soc_read(codec
, WM8960_RADC
);
963 snd_soc_write(codec
, WM8960_RADC
, reg
| 0x100);
964 reg
= snd_soc_read(codec
, WM8960_LDAC
);
965 snd_soc_write(codec
, WM8960_LDAC
, reg
| 0x100);
966 reg
= snd_soc_read(codec
, WM8960_RDAC
);
967 snd_soc_write(codec
, WM8960_RDAC
, reg
| 0x100);
968 reg
= snd_soc_read(codec
, WM8960_LOUT1
);
969 snd_soc_write(codec
, WM8960_LOUT1
, reg
| 0x100);
970 reg
= snd_soc_read(codec
, WM8960_ROUT1
);
971 snd_soc_write(codec
, WM8960_ROUT1
, reg
| 0x100);
972 reg
= snd_soc_read(codec
, WM8960_LOUT2
);
973 snd_soc_write(codec
, WM8960_LOUT2
, reg
| 0x100);
974 reg
= snd_soc_read(codec
, WM8960_ROUT2
);
975 snd_soc_write(codec
, WM8960_ROUT2
, reg
| 0x100);
977 snd_soc_add_controls(codec
, wm8960_snd_controls
,
978 ARRAY_SIZE(wm8960_snd_controls
));
979 wm8960_add_widgets(codec
);
984 /* power down chip */
985 static int wm8960_remove(struct snd_soc_codec
*codec
)
987 struct wm8960_priv
*wm8960
= snd_soc_codec_get_drvdata(codec
);
989 wm8960
->set_bias_level(codec
, SND_SOC_BIAS_OFF
);
993 static struct snd_soc_codec_driver soc_codec_dev_wm8960
= {
994 .probe
= wm8960_probe
,
995 .remove
= wm8960_remove
,
996 .suspend
= wm8960_suspend
,
997 .resume
= wm8960_resume
,
998 .set_bias_level
= wm8960_set_bias_level
,
999 .reg_cache_size
= ARRAY_SIZE(wm8960_reg
),
1000 .reg_word_size
= sizeof(u16
),
1001 .reg_cache_default
= wm8960_reg
,
1004 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1005 static __devinit
int wm8960_i2c_probe(struct i2c_client
*i2c
,
1006 const struct i2c_device_id
*id
)
1008 struct wm8960_priv
*wm8960
;
1011 wm8960
= kzalloc(sizeof(struct wm8960_priv
), GFP_KERNEL
);
1015 i2c_set_clientdata(i2c
, wm8960
);
1016 wm8960
->control_data
= i2c
;
1018 ret
= snd_soc_register_codec(&i2c
->dev
,
1019 &soc_codec_dev_wm8960
, &wm8960_dai
, 1);
1025 static __devexit
int wm8960_i2c_remove(struct i2c_client
*client
)
1027 snd_soc_unregister_codec(&client
->dev
);
1028 kfree(i2c_get_clientdata(client
));
1032 static const struct i2c_device_id wm8960_i2c_id
[] = {
1036 MODULE_DEVICE_TABLE(i2c
, wm8960_i2c_id
);
1038 static struct i2c_driver wm8960_i2c_driver
= {
1040 .name
= "wm8960-codec",
1041 .owner
= THIS_MODULE
,
1043 .probe
= wm8960_i2c_probe
,
1044 .remove
= __devexit_p(wm8960_i2c_remove
),
1045 .id_table
= wm8960_i2c_id
,
1049 static int __init
wm8960_modinit(void)
1052 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1053 ret
= i2c_add_driver(&wm8960_i2c_driver
);
1055 printk(KERN_ERR
"Failed to register WM8960 I2C driver: %d\n",
1061 module_init(wm8960_modinit
);
1063 static void __exit
wm8960_exit(void)
1065 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1066 i2c_del_driver(&wm8960_i2c_driver
);
1069 module_exit(wm8960_exit
);
1071 MODULE_DESCRIPTION("ASoC WM8960 driver");
1072 MODULE_AUTHOR("Liam Girdwood");
1073 MODULE_LICENSE("GPL");