2 * wm8971.c -- WM8971 ALSA SoC Audio driver
4 * Copyright 2005 Lab126, Inc.
6 * Author: Kenneth Kiraly <kiraly@lab126.com>
8 * Based on wm8753.c by Liam Girdwood
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
16 #include <linux/module.h>
17 #include <linux/moduleparam.h>
18 #include <linux/init.h>
19 #include <linux/delay.h>
21 #include <linux/i2c.h>
22 #include <linux/platform_device.h>
23 #include <sound/core.h>
24 #include <sound/pcm.h>
25 #include <sound/pcm_params.h>
26 #include <sound/soc.h>
27 #include <sound/soc-dapm.h>
28 #include <sound/initval.h>
32 #define WM8971_VERSION "0.9"
34 #define WM8971_REG_COUNT 43
36 static struct workqueue_struct
*wm8971_workq
= NULL
;
38 /* codec private data */
44 * wm8971 register cache
45 * We can't read the WM8971 register space when we
46 * are using 2 wire for device control, so we cache them instead.
48 static const u16 wm8971_reg
[] = {
49 0x0097, 0x0097, 0x0079, 0x0079, /* 0 */
50 0x0000, 0x0008, 0x0000, 0x000a, /* 4 */
51 0x0000, 0x0000, 0x00ff, 0x00ff, /* 8 */
52 0x000f, 0x000f, 0x0000, 0x0000, /* 12 */
53 0x0000, 0x007b, 0x0000, 0x0032, /* 16 */
54 0x0000, 0x00c3, 0x00c3, 0x00c0, /* 20 */
55 0x0000, 0x0000, 0x0000, 0x0000, /* 24 */
56 0x0000, 0x0000, 0x0000, 0x0000, /* 28 */
57 0x0000, 0x0000, 0x0050, 0x0050, /* 32 */
58 0x0050, 0x0050, 0x0050, 0x0050, /* 36 */
59 0x0079, 0x0079, 0x0079, /* 40 */
62 static inline unsigned int wm8971_read_reg_cache(struct snd_soc_codec
*codec
,
65 u16
*cache
= codec
->reg_cache
;
66 if (reg
< WM8971_REG_COUNT
)
72 static inline void wm8971_write_reg_cache(struct snd_soc_codec
*codec
,
73 unsigned int reg
, unsigned int value
)
75 u16
*cache
= codec
->reg_cache
;
76 if (reg
< WM8971_REG_COUNT
)
80 static int wm8971_write(struct snd_soc_codec
*codec
, unsigned int reg
,
86 * D15..D9 WM8753 register offset
87 * D8...D0 register data
89 data
[0] = (reg
<< 1) | ((value
>> 8) & 0x0001);
90 data
[1] = value
& 0x00ff;
92 wm8971_write_reg_cache (codec
, reg
, value
);
93 if (codec
->hw_write(codec
->control_data
, data
, 2) == 2)
99 #define wm8971_reset(c) wm8971_write(c, WM8971_RESET, 0)
101 /* WM8971 Controls */
102 static const char *wm8971_bass
[] = { "Linear Control", "Adaptive Boost" };
103 static const char *wm8971_bass_filter
[] = { "130Hz @ 48kHz",
105 static const char *wm8971_treble
[] = { "8kHz", "4kHz" };
106 static const char *wm8971_alc_func
[] = { "Off", "Right", "Left", "Stereo" };
107 static const char *wm8971_ng_type
[] = { "Constant PGA Gain",
109 static const char *wm8971_deemp
[] = { "None", "32kHz", "44.1kHz", "48kHz" };
110 static const char *wm8971_mono_mux
[] = {"Stereo", "Mono (Left)",
111 "Mono (Right)", "Digital Mono"};
112 static const char *wm8971_dac_phase
[] = { "Non Inverted", "Inverted" };
113 static const char *wm8971_lline_mux
[] = {"Line", "NC", "NC", "PGA",
115 static const char *wm8971_rline_mux
[] = {"Line", "Mic", "NC", "PGA",
117 static const char *wm8971_lpga_sel
[] = {"Line", "NC", "NC", "Differential"};
118 static const char *wm8971_rpga_sel
[] = {"Line", "Mic", "NC", "Differential"};
119 static const char *wm8971_adcpol
[] = {"Normal", "L Invert", "R Invert",
122 static const struct soc_enum wm8971_enum
[] = {
123 SOC_ENUM_SINGLE(WM8971_BASS
, 7, 2, wm8971_bass
), /* 0 */
124 SOC_ENUM_SINGLE(WM8971_BASS
, 6, 2, wm8971_bass_filter
),
125 SOC_ENUM_SINGLE(WM8971_TREBLE
, 6, 2, wm8971_treble
),
126 SOC_ENUM_SINGLE(WM8971_ALC1
, 7, 4, wm8971_alc_func
),
127 SOC_ENUM_SINGLE(WM8971_NGATE
, 1, 2, wm8971_ng_type
), /* 4 */
128 SOC_ENUM_SINGLE(WM8971_ADCDAC
, 1, 4, wm8971_deemp
),
129 SOC_ENUM_SINGLE(WM8971_ADCTL1
, 4, 4, wm8971_mono_mux
),
130 SOC_ENUM_SINGLE(WM8971_ADCTL1
, 1, 2, wm8971_dac_phase
),
131 SOC_ENUM_SINGLE(WM8971_LOUTM1
, 0, 5, wm8971_lline_mux
), /* 8 */
132 SOC_ENUM_SINGLE(WM8971_ROUTM1
, 0, 5, wm8971_rline_mux
),
133 SOC_ENUM_SINGLE(WM8971_LADCIN
, 6, 4, wm8971_lpga_sel
),
134 SOC_ENUM_SINGLE(WM8971_RADCIN
, 6, 4, wm8971_rpga_sel
),
135 SOC_ENUM_SINGLE(WM8971_ADCDAC
, 5, 4, wm8971_adcpol
), /* 12 */
136 SOC_ENUM_SINGLE(WM8971_ADCIN
, 6, 4, wm8971_mono_mux
),
139 static const struct snd_kcontrol_new wm8971_snd_controls
[] = {
140 SOC_DOUBLE_R("Capture Volume", WM8971_LINVOL
, WM8971_RINVOL
, 0, 63, 0),
141 SOC_DOUBLE_R("Capture ZC Switch", WM8971_LINVOL
, WM8971_RINVOL
,
143 SOC_DOUBLE_R("Capture Switch", WM8971_LINVOL
, WM8971_RINVOL
, 7, 1, 1),
145 SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8971_LOUT1V
,
146 WM8971_ROUT1V
, 7, 1, 0),
147 SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8971_LOUT2V
,
148 WM8971_ROUT2V
, 7, 1, 0),
149 SOC_SINGLE("Mono Playback ZC Switch", WM8971_MOUTV
, 7, 1, 0),
151 SOC_DOUBLE_R("PCM Volume", WM8971_LDAC
, WM8971_RDAC
, 0, 255, 0),
153 SOC_DOUBLE_R("Bypass Left Playback Volume", WM8971_LOUTM1
,
154 WM8971_LOUTM2
, 4, 7, 1),
155 SOC_DOUBLE_R("Bypass Right Playback Volume", WM8971_ROUTM1
,
156 WM8971_ROUTM2
, 4, 7, 1),
157 SOC_DOUBLE_R("Bypass Mono Playback Volume", WM8971_MOUTM1
,
158 WM8971_MOUTM2
, 4, 7, 1),
160 SOC_DOUBLE_R("Headphone Playback Volume", WM8971_LOUT1V
,
161 WM8971_ROUT1V
, 0, 127, 0),
162 SOC_DOUBLE_R("Speaker Playback Volume", WM8971_LOUT2V
,
163 WM8971_ROUT2V
, 0, 127, 0),
165 SOC_ENUM("Bass Boost", wm8971_enum
[0]),
166 SOC_ENUM("Bass Filter", wm8971_enum
[1]),
167 SOC_SINGLE("Bass Volume", WM8971_BASS
, 0, 7, 1),
169 SOC_SINGLE("Treble Volume", WM8971_TREBLE
, 0, 7, 0),
170 SOC_ENUM("Treble Cut-off", wm8971_enum
[2]),
172 SOC_SINGLE("Capture Filter Switch", WM8971_ADCDAC
, 0, 1, 1),
174 SOC_SINGLE("ALC Target Volume", WM8971_ALC1
, 0, 7, 0),
175 SOC_SINGLE("ALC Max Volume", WM8971_ALC1
, 4, 7, 0),
177 SOC_SINGLE("ALC Capture Target Volume", WM8971_ALC1
, 0, 7, 0),
178 SOC_SINGLE("ALC Capture Max Volume", WM8971_ALC1
, 4, 7, 0),
179 SOC_ENUM("ALC Capture Function", wm8971_enum
[3]),
180 SOC_SINGLE("ALC Capture ZC Switch", WM8971_ALC2
, 7, 1, 0),
181 SOC_SINGLE("ALC Capture Hold Time", WM8971_ALC2
, 0, 15, 0),
182 SOC_SINGLE("ALC Capture Decay Time", WM8971_ALC3
, 4, 15, 0),
183 SOC_SINGLE("ALC Capture Attack Time", WM8971_ALC3
, 0, 15, 0),
184 SOC_SINGLE("ALC Capture NG Threshold", WM8971_NGATE
, 3, 31, 0),
185 SOC_ENUM("ALC Capture NG Type", wm8971_enum
[4]),
186 SOC_SINGLE("ALC Capture NG Switch", WM8971_NGATE
, 0, 1, 0),
188 SOC_SINGLE("Capture 6dB Attenuate", WM8971_ADCDAC
, 8, 1, 0),
189 SOC_SINGLE("Playback 6dB Attenuate", WM8971_ADCDAC
, 7, 1, 0),
191 SOC_ENUM("Playback De-emphasis", wm8971_enum
[5]),
192 SOC_ENUM("Playback Function", wm8971_enum
[6]),
193 SOC_ENUM("Playback Phase", wm8971_enum
[7]),
195 SOC_DOUBLE_R("Mic Boost", WM8971_LADCIN
, WM8971_RADCIN
, 4, 3, 0),
198 /* add non-DAPM controls */
199 static int wm8971_add_controls(struct snd_soc_codec
*codec
)
203 for (i
= 0; i
< ARRAY_SIZE(wm8971_snd_controls
); i
++) {
204 err
= snd_ctl_add(codec
->card
,
205 snd_soc_cnew(&wm8971_snd_controls
[i
],
218 static const struct snd_kcontrol_new wm8971_left_mixer_controls
[] = {
219 SOC_DAPM_SINGLE("Playback Switch", WM8971_LOUTM1
, 8, 1, 0),
220 SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_LOUTM1
, 7, 1, 0),
221 SOC_DAPM_SINGLE("Right Playback Switch", WM8971_LOUTM2
, 8, 1, 0),
222 SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_LOUTM2
, 7, 1, 0),
226 static const struct snd_kcontrol_new wm8971_right_mixer_controls
[] = {
227 SOC_DAPM_SINGLE("Left Playback Switch", WM8971_ROUTM1
, 8, 1, 0),
228 SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_ROUTM1
, 7, 1, 0),
229 SOC_DAPM_SINGLE("Playback Switch", WM8971_ROUTM2
, 8, 1, 0),
230 SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_ROUTM2
, 7, 1, 0),
234 static const struct snd_kcontrol_new wm8971_mono_mixer_controls
[] = {
235 SOC_DAPM_SINGLE("Left Playback Switch", WM8971_MOUTM1
, 8, 1, 0),
236 SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_MOUTM1
, 7, 1, 0),
237 SOC_DAPM_SINGLE("Right Playback Switch", WM8971_MOUTM2
, 8, 1, 0),
238 SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_MOUTM2
, 7, 1, 0),
242 static const struct snd_kcontrol_new wm8971_left_line_controls
=
243 SOC_DAPM_ENUM("Route", wm8971_enum
[8]);
246 static const struct snd_kcontrol_new wm8971_right_line_controls
=
247 SOC_DAPM_ENUM("Route", wm8971_enum
[9]);
250 static const struct snd_kcontrol_new wm8971_left_pga_controls
=
251 SOC_DAPM_ENUM("Route", wm8971_enum
[10]);
254 static const struct snd_kcontrol_new wm8971_right_pga_controls
=
255 SOC_DAPM_ENUM("Route", wm8971_enum
[11]);
258 static const struct snd_kcontrol_new wm8971_monomux_controls
=
259 SOC_DAPM_ENUM("Route", wm8971_enum
[13]);
261 static const struct snd_soc_dapm_widget wm8971_dapm_widgets
[] = {
262 SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM
, 0, 0,
263 &wm8971_left_mixer_controls
[0],
264 ARRAY_SIZE(wm8971_left_mixer_controls
)),
265 SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM
, 0, 0,
266 &wm8971_right_mixer_controls
[0],
267 ARRAY_SIZE(wm8971_right_mixer_controls
)),
268 SND_SOC_DAPM_MIXER("Mono Mixer", WM8971_PWR2
, 2, 0,
269 &wm8971_mono_mixer_controls
[0],
270 ARRAY_SIZE(wm8971_mono_mixer_controls
)),
272 SND_SOC_DAPM_PGA("Right Out 2", WM8971_PWR2
, 3, 0, NULL
, 0),
273 SND_SOC_DAPM_PGA("Left Out 2", WM8971_PWR2
, 4, 0, NULL
, 0),
274 SND_SOC_DAPM_PGA("Right Out 1", WM8971_PWR2
, 5, 0, NULL
, 0),
275 SND_SOC_DAPM_PGA("Left Out 1", WM8971_PWR2
, 6, 0, NULL
, 0),
276 SND_SOC_DAPM_DAC("Right DAC", "Right Playback", WM8971_PWR2
, 7, 0),
277 SND_SOC_DAPM_DAC("Left DAC", "Left Playback", WM8971_PWR2
, 8, 0),
278 SND_SOC_DAPM_PGA("Mono Out 1", WM8971_PWR2
, 2, 0, NULL
, 0),
280 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8971_PWR1
, 1, 0),
281 SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8971_PWR1
, 2, 0),
282 SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8971_PWR1
, 3, 0),
284 SND_SOC_DAPM_MUX("Left PGA Mux", WM8971_PWR1
, 5, 0,
285 &wm8971_left_pga_controls
),
286 SND_SOC_DAPM_MUX("Right PGA Mux", WM8971_PWR1
, 4, 0,
287 &wm8971_right_pga_controls
),
288 SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM
, 0, 0,
289 &wm8971_left_line_controls
),
290 SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM
, 0, 0,
291 &wm8971_right_line_controls
),
293 SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM
, 0, 0,
294 &wm8971_monomux_controls
),
295 SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM
, 0, 0,
296 &wm8971_monomux_controls
),
298 SND_SOC_DAPM_OUTPUT("LOUT1"),
299 SND_SOC_DAPM_OUTPUT("ROUT1"),
300 SND_SOC_DAPM_OUTPUT("LOUT2"),
301 SND_SOC_DAPM_OUTPUT("ROUT2"),
302 SND_SOC_DAPM_OUTPUT("MONO"),
304 SND_SOC_DAPM_INPUT("LINPUT1"),
305 SND_SOC_DAPM_INPUT("RINPUT1"),
306 SND_SOC_DAPM_INPUT("MIC"),
309 static const struct snd_soc_dapm_route audio_map
[] = {
311 {"Left Mixer", "Playback Switch", "Left DAC"},
312 {"Left Mixer", "Left Bypass Switch", "Left Line Mux"},
313 {"Left Mixer", "Right Playback Switch", "Right DAC"},
314 {"Left Mixer", "Right Bypass Switch", "Right Line Mux"},
317 {"Right Mixer", "Left Playback Switch", "Left DAC"},
318 {"Right Mixer", "Left Bypass Switch", "Left Line Mux"},
319 {"Right Mixer", "Playback Switch", "Right DAC"},
320 {"Right Mixer", "Right Bypass Switch", "Right Line Mux"},
323 {"Left Out 1", NULL
, "Left Mixer"},
324 {"LOUT1", NULL
, "Left Out 1"},
327 {"Left Out 2", NULL
, "Left Mixer"},
328 {"LOUT2", NULL
, "Left Out 2"},
331 {"Right Out 1", NULL
, "Right Mixer"},
332 {"ROUT1", NULL
, "Right Out 1"},
335 {"Right Out 2", NULL
, "Right Mixer"},
336 {"ROUT2", NULL
, "Right Out 2"},
339 {"Mono Mixer", "Left Playback Switch", "Left DAC"},
340 {"Mono Mixer", "Left Bypass Switch", "Left Line Mux"},
341 {"Mono Mixer", "Right Playback Switch", "Right DAC"},
342 {"Mono Mixer", "Right Bypass Switch", "Right Line Mux"},
345 {"Mono Out", NULL
, "Mono Mixer"},
346 {"MONO1", NULL
, "Mono Out"},
349 {"Left Line Mux", "Line", "LINPUT1"},
350 {"Left Line Mux", "PGA", "Left PGA Mux"},
351 {"Left Line Mux", "Differential", "Differential Mux"},
354 {"Right Line Mux", "Line", "RINPUT1"},
355 {"Right Line Mux", "Mic", "MIC"},
356 {"Right Line Mux", "PGA", "Right PGA Mux"},
357 {"Right Line Mux", "Differential", "Differential Mux"},
360 {"Left PGA Mux", "Line", "LINPUT1"},
361 {"Left PGA Mux", "Differential", "Differential Mux"},
364 {"Right PGA Mux", "Line", "RINPUT1"},
365 {"Right PGA Mux", "Differential", "Differential Mux"},
367 /* Differential Mux */
368 {"Differential Mux", "Line", "LINPUT1"},
369 {"Differential Mux", "Line", "RINPUT1"},
372 {"Left ADC Mux", "Stereo", "Left PGA Mux"},
373 {"Left ADC Mux", "Mono (Left)", "Left PGA Mux"},
374 {"Left ADC Mux", "Digital Mono", "Left PGA Mux"},
377 {"Right ADC Mux", "Stereo", "Right PGA Mux"},
378 {"Right ADC Mux", "Mono (Right)", "Right PGA Mux"},
379 {"Right ADC Mux", "Digital Mono", "Right PGA Mux"},
382 {"Left ADC", NULL
, "Left ADC Mux"},
383 {"Right ADC", NULL
, "Right ADC Mux"},
386 static int wm8971_add_widgets(struct snd_soc_codec
*codec
)
388 snd_soc_dapm_new_controls(codec
, wm8971_dapm_widgets
,
389 ARRAY_SIZE(wm8971_dapm_widgets
));
391 snd_soc_dapm_add_routes(codec
, audio_map
, ARRAY_SIZE(audio_map
));
393 snd_soc_dapm_new_widgets(codec
);
406 /* codec hifi mclk clock divider coefficients */
407 static const struct _coeff_div coeff_div
[] = {
409 {12288000, 8000, 1536, 0x6, 0x0},
410 {11289600, 8000, 1408, 0x16, 0x0},
411 {18432000, 8000, 2304, 0x7, 0x0},
412 {16934400, 8000, 2112, 0x17, 0x0},
413 {12000000, 8000, 1500, 0x6, 0x1},
416 {11289600, 11025, 1024, 0x18, 0x0},
417 {16934400, 11025, 1536, 0x19, 0x0},
418 {12000000, 11025, 1088, 0x19, 0x1},
421 {12288000, 16000, 768, 0xa, 0x0},
422 {18432000, 16000, 1152, 0xb, 0x0},
423 {12000000, 16000, 750, 0xa, 0x1},
426 {11289600, 22050, 512, 0x1a, 0x0},
427 {16934400, 22050, 768, 0x1b, 0x0},
428 {12000000, 22050, 544, 0x1b, 0x1},
431 {12288000, 32000, 384, 0xc, 0x0},
432 {18432000, 32000, 576, 0xd, 0x0},
433 {12000000, 32000, 375, 0xa, 0x1},
436 {11289600, 44100, 256, 0x10, 0x0},
437 {16934400, 44100, 384, 0x11, 0x0},
438 {12000000, 44100, 272, 0x11, 0x1},
441 {12288000, 48000, 256, 0x0, 0x0},
442 {18432000, 48000, 384, 0x1, 0x0},
443 {12000000, 48000, 250, 0x0, 0x1},
446 {11289600, 88200, 128, 0x1e, 0x0},
447 {16934400, 88200, 192, 0x1f, 0x0},
448 {12000000, 88200, 136, 0x1f, 0x1},
451 {12288000, 96000, 128, 0xe, 0x0},
452 {18432000, 96000, 192, 0xf, 0x0},
453 {12000000, 96000, 125, 0xe, 0x1},
456 static int get_coeff(int mclk
, int rate
)
460 for (i
= 0; i
< ARRAY_SIZE(coeff_div
); i
++) {
461 if (coeff_div
[i
].rate
== rate
&& coeff_div
[i
].mclk
== mclk
)
467 static int wm8971_set_dai_sysclk(struct snd_soc_dai
*codec_dai
,
468 int clk_id
, unsigned int freq
, int dir
)
470 struct snd_soc_codec
*codec
= codec_dai
->codec
;
471 struct wm8971_priv
*wm8971
= codec
->private_data
;
479 wm8971
->sysclk
= freq
;
485 static int wm8971_set_dai_fmt(struct snd_soc_dai
*codec_dai
,
488 struct snd_soc_codec
*codec
= codec_dai
->codec
;
491 /* set master/slave audio interface */
492 switch (fmt
& SND_SOC_DAIFMT_MASTER_MASK
) {
493 case SND_SOC_DAIFMT_CBM_CFM
:
496 case SND_SOC_DAIFMT_CBS_CFS
:
502 /* interface format */
503 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
504 case SND_SOC_DAIFMT_I2S
:
507 case SND_SOC_DAIFMT_RIGHT_J
:
509 case SND_SOC_DAIFMT_LEFT_J
:
512 case SND_SOC_DAIFMT_DSP_A
:
515 case SND_SOC_DAIFMT_DSP_B
:
522 /* clock inversion */
523 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
524 case SND_SOC_DAIFMT_NB_NF
:
526 case SND_SOC_DAIFMT_IB_IF
:
529 case SND_SOC_DAIFMT_IB_NF
:
532 case SND_SOC_DAIFMT_NB_IF
:
539 wm8971_write(codec
, WM8971_IFACE
, iface
);
543 static int wm8971_pcm_hw_params(struct snd_pcm_substream
*substream
,
544 struct snd_pcm_hw_params
*params
)
546 struct snd_soc_pcm_runtime
*rtd
= substream
->private_data
;
547 struct snd_soc_device
*socdev
= rtd
->socdev
;
548 struct snd_soc_codec
*codec
= socdev
->codec
;
549 struct wm8971_priv
*wm8971
= codec
->private_data
;
550 u16 iface
= wm8971_read_reg_cache(codec
, WM8971_IFACE
) & 0x1f3;
551 u16 srate
= wm8971_read_reg_cache(codec
, WM8971_SRATE
) & 0x1c0;
552 int coeff
= get_coeff(wm8971
->sysclk
, params_rate(params
));
555 switch (params_format(params
)) {
556 case SNDRV_PCM_FORMAT_S16_LE
:
558 case SNDRV_PCM_FORMAT_S20_3LE
:
561 case SNDRV_PCM_FORMAT_S24_LE
:
564 case SNDRV_PCM_FORMAT_S32_LE
:
569 /* set iface & srate */
570 wm8971_write(codec
, WM8971_IFACE
, iface
);
572 wm8971_write(codec
, WM8971_SRATE
, srate
|
573 (coeff_div
[coeff
].sr
<< 1) | coeff_div
[coeff
].usb
);
578 static int wm8971_mute(struct snd_soc_dai
*dai
, int mute
)
580 struct snd_soc_codec
*codec
= dai
->codec
;
581 u16 mute_reg
= wm8971_read_reg_cache(codec
, WM8971_ADCDAC
) & 0xfff7;
584 wm8971_write(codec
, WM8971_ADCDAC
, mute_reg
| 0x8);
586 wm8971_write(codec
, WM8971_ADCDAC
, mute_reg
);
590 static int wm8971_set_bias_level(struct snd_soc_codec
*codec
,
591 enum snd_soc_bias_level level
)
593 u16 pwr_reg
= wm8971_read_reg_cache(codec
, WM8971_PWR1
) & 0xfe3e;
596 case SND_SOC_BIAS_ON
:
597 /* set vmid to 50k and unmute dac */
598 wm8971_write(codec
, WM8971_PWR1
, pwr_reg
| 0x00c1);
600 case SND_SOC_BIAS_PREPARE
:
602 case SND_SOC_BIAS_STANDBY
:
603 /* mute dac and set vmid to 500k, enable VREF */
604 wm8971_write(codec
, WM8971_PWR1
, pwr_reg
| 0x0140);
606 case SND_SOC_BIAS_OFF
:
607 wm8971_write(codec
, WM8971_PWR1
, 0x0001);
610 codec
->bias_level
= level
;
614 #define WM8971_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
615 SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 | SNDRV_PCM_RATE_44100 | \
616 SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
618 #define WM8971_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
619 SNDRV_PCM_FMTBIT_S24_LE)
621 struct snd_soc_dai wm8971_dai
= {
624 .stream_name
= "Playback",
627 .rates
= WM8971_RATES
,
628 .formats
= WM8971_FORMATS
,},
630 .stream_name
= "Capture",
633 .rates
= WM8971_RATES
,
634 .formats
= WM8971_FORMATS
,},
636 .hw_params
= wm8971_pcm_hw_params
,
639 .digital_mute
= wm8971_mute
,
640 .set_fmt
= wm8971_set_dai_fmt
,
641 .set_sysclk
= wm8971_set_dai_sysclk
,
644 EXPORT_SYMBOL_GPL(wm8971_dai
);
646 static void wm8971_work(struct work_struct
*work
)
648 struct snd_soc_codec
*codec
=
649 container_of(work
, struct snd_soc_codec
, delayed_work
.work
);
650 wm8971_set_bias_level(codec
, codec
->bias_level
);
653 static int wm8971_suspend(struct platform_device
*pdev
, pm_message_t state
)
655 struct snd_soc_device
*socdev
= platform_get_drvdata(pdev
);
656 struct snd_soc_codec
*codec
= socdev
->codec
;
658 wm8971_set_bias_level(codec
, SND_SOC_BIAS_OFF
);
662 static int wm8971_resume(struct platform_device
*pdev
)
664 struct snd_soc_device
*socdev
= platform_get_drvdata(pdev
);
665 struct snd_soc_codec
*codec
= socdev
->codec
;
668 u16
*cache
= codec
->reg_cache
;
671 /* Sync reg_cache with the hardware */
672 for (i
= 0; i
< ARRAY_SIZE(wm8971_reg
); i
++) {
673 if (i
+ 1 == WM8971_RESET
)
675 data
[0] = (i
<< 1) | ((cache
[i
] >> 8) & 0x0001);
676 data
[1] = cache
[i
] & 0x00ff;
677 codec
->hw_write(codec
->control_data
, data
, 2);
680 wm8971_set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
682 /* charge wm8971 caps */
683 if (codec
->suspend_bias_level
== SND_SOC_BIAS_ON
) {
684 reg
= wm8971_read_reg_cache(codec
, WM8971_PWR1
) & 0xfe3e;
685 wm8971_write(codec
, WM8971_PWR1
, reg
| 0x01c0);
686 codec
->bias_level
= SND_SOC_BIAS_ON
;
687 queue_delayed_work(wm8971_workq
, &codec
->delayed_work
,
688 msecs_to_jiffies(1000));
694 static int wm8971_init(struct snd_soc_device
*socdev
)
696 struct snd_soc_codec
*codec
= socdev
->codec
;
699 codec
->name
= "WM8971";
700 codec
->owner
= THIS_MODULE
;
701 codec
->read
= wm8971_read_reg_cache
;
702 codec
->write
= wm8971_write
;
703 codec
->set_bias_level
= wm8971_set_bias_level
;
704 codec
->dai
= &wm8971_dai
;
705 codec
->reg_cache_size
= ARRAY_SIZE(wm8971_reg
);
707 codec
->reg_cache
= kmemdup(wm8971_reg
, sizeof(wm8971_reg
), GFP_KERNEL
);
709 if (codec
->reg_cache
== NULL
)
715 ret
= snd_soc_new_pcms(socdev
, SNDRV_DEFAULT_IDX1
, SNDRV_DEFAULT_STR1
);
717 printk(KERN_ERR
"wm8971: failed to create pcms\n");
721 /* charge output caps - set vmid to 5k for quick power up */
722 reg
= wm8971_read_reg_cache(codec
, WM8971_PWR1
) & 0xfe3e;
723 wm8971_write(codec
, WM8971_PWR1
, reg
| 0x01c0);
724 codec
->bias_level
= SND_SOC_BIAS_STANDBY
;
725 queue_delayed_work(wm8971_workq
, &codec
->delayed_work
,
726 msecs_to_jiffies(1000));
728 /* set the update bits */
729 reg
= wm8971_read_reg_cache(codec
, WM8971_LDAC
);
730 wm8971_write(codec
, WM8971_LDAC
, reg
| 0x0100);
731 reg
= wm8971_read_reg_cache(codec
, WM8971_RDAC
);
732 wm8971_write(codec
, WM8971_RDAC
, reg
| 0x0100);
734 reg
= wm8971_read_reg_cache(codec
, WM8971_LOUT1V
);
735 wm8971_write(codec
, WM8971_LOUT1V
, reg
| 0x0100);
736 reg
= wm8971_read_reg_cache(codec
, WM8971_ROUT1V
);
737 wm8971_write(codec
, WM8971_ROUT1V
, reg
| 0x0100);
739 reg
= wm8971_read_reg_cache(codec
, WM8971_LOUT2V
);
740 wm8971_write(codec
, WM8971_LOUT2V
, reg
| 0x0100);
741 reg
= wm8971_read_reg_cache(codec
, WM8971_ROUT2V
);
742 wm8971_write(codec
, WM8971_ROUT2V
, reg
| 0x0100);
744 reg
= wm8971_read_reg_cache(codec
, WM8971_LINVOL
);
745 wm8971_write(codec
, WM8971_LINVOL
, reg
| 0x0100);
746 reg
= wm8971_read_reg_cache(codec
, WM8971_RINVOL
);
747 wm8971_write(codec
, WM8971_RINVOL
, reg
| 0x0100);
749 wm8971_add_controls(codec
);
750 wm8971_add_widgets(codec
);
751 ret
= snd_soc_register_card(socdev
);
753 printk(KERN_ERR
"wm8971: failed to register card\n");
759 snd_soc_free_pcms(socdev
);
760 snd_soc_dapm_free(socdev
);
762 kfree(codec
->reg_cache
);
766 /* If the i2c layer weren't so broken, we could pass this kind of data
768 static struct snd_soc_device
*wm8971_socdev
;
770 #if defined (CONFIG_I2C) || defined (CONFIG_I2C_MODULE)
772 static int wm8971_i2c_probe(struct i2c_client
*i2c
,
773 const struct i2c_device_id
*id
)
775 struct snd_soc_device
*socdev
= wm8971_socdev
;
776 struct snd_soc_codec
*codec
= socdev
->codec
;
779 i2c_set_clientdata(i2c
, codec
);
781 codec
->control_data
= i2c
;
783 ret
= wm8971_init(socdev
);
785 pr_err("failed to initialise WM8971\n");
790 static int wm8971_i2c_remove(struct i2c_client
*client
)
792 struct snd_soc_codec
*codec
= i2c_get_clientdata(client
);
793 kfree(codec
->reg_cache
);
797 static const struct i2c_device_id wm8971_i2c_id
[] = {
801 MODULE_DEVICE_TABLE(i2c
, wm8971_i2c_id
);
803 static struct i2c_driver wm8971_i2c_driver
= {
805 .name
= "WM8971 I2C Codec",
806 .owner
= THIS_MODULE
,
808 .probe
= wm8971_i2c_probe
,
809 .remove
= wm8971_i2c_remove
,
810 .id_table
= wm8971_i2c_id
,
813 static int wm8971_add_i2c_device(struct platform_device
*pdev
,
814 const struct wm8971_setup_data
*setup
)
816 struct i2c_board_info info
;
817 struct i2c_adapter
*adapter
;
818 struct i2c_client
*client
;
821 ret
= i2c_add_driver(&wm8971_i2c_driver
);
823 dev_err(&pdev
->dev
, "can't add i2c driver\n");
827 memset(&info
, 0, sizeof(struct i2c_board_info
));
828 info
.addr
= setup
->i2c_address
;
829 strlcpy(info
.type
, "wm8971", I2C_NAME_SIZE
);
831 adapter
= i2c_get_adapter(setup
->i2c_bus
);
833 dev_err(&pdev
->dev
, "can't get i2c adapter %d\n",
838 client
= i2c_new_device(adapter
, &info
);
839 i2c_put_adapter(adapter
);
841 dev_err(&pdev
->dev
, "can't add i2c device at 0x%x\n",
842 (unsigned int)info
.addr
);
849 i2c_del_driver(&wm8971_i2c_driver
);
855 static int wm8971_probe(struct platform_device
*pdev
)
857 struct snd_soc_device
*socdev
= platform_get_drvdata(pdev
);
858 struct wm8971_setup_data
*setup
;
859 struct snd_soc_codec
*codec
;
860 struct wm8971_priv
*wm8971
;
863 pr_info("WM8971 Audio Codec %s", WM8971_VERSION
);
865 setup
= socdev
->codec_data
;
866 codec
= kzalloc(sizeof(struct snd_soc_codec
), GFP_KERNEL
);
870 wm8971
= kzalloc(sizeof(struct wm8971_priv
), GFP_KERNEL
);
871 if (wm8971
== NULL
) {
876 codec
->private_data
= wm8971
;
877 socdev
->codec
= codec
;
878 mutex_init(&codec
->mutex
);
879 INIT_LIST_HEAD(&codec
->dapm_widgets
);
880 INIT_LIST_HEAD(&codec
->dapm_paths
);
881 wm8971_socdev
= socdev
;
883 INIT_DELAYED_WORK(&codec
->delayed_work
, wm8971_work
);
884 wm8971_workq
= create_workqueue("wm8971");
885 if (wm8971_workq
== NULL
) {
886 kfree(codec
->private_data
);
891 #if defined (CONFIG_I2C) || defined (CONFIG_I2C_MODULE)
892 if (setup
->i2c_address
) {
893 codec
->hw_write
= (hw_write_t
)i2c_master_send
;
894 ret
= wm8971_add_i2c_device(pdev
, setup
);
897 /* Add other interfaces here */
900 destroy_workqueue(wm8971_workq
);
901 kfree(codec
->private_data
);
908 /* power down chip */
909 static int wm8971_remove(struct platform_device
*pdev
)
911 struct snd_soc_device
*socdev
= platform_get_drvdata(pdev
);
912 struct snd_soc_codec
*codec
= socdev
->codec
;
914 if (codec
->control_data
)
915 wm8971_set_bias_level(codec
, SND_SOC_BIAS_OFF
);
917 destroy_workqueue(wm8971_workq
);
918 snd_soc_free_pcms(socdev
);
919 snd_soc_dapm_free(socdev
);
920 #if defined (CONFIG_I2C) || defined (CONFIG_I2C_MODULE)
921 i2c_unregister_device(codec
->control_data
);
922 i2c_del_driver(&wm8971_i2c_driver
);
924 kfree(codec
->private_data
);
930 struct snd_soc_codec_device soc_codec_dev_wm8971
= {
931 .probe
= wm8971_probe
,
932 .remove
= wm8971_remove
,
933 .suspend
= wm8971_suspend
,
934 .resume
= wm8971_resume
,
937 EXPORT_SYMBOL_GPL(soc_codec_dev_wm8971
);
939 MODULE_DESCRIPTION("ASoC WM8971 driver");
940 MODULE_AUTHOR("Lab126");
941 MODULE_LICENSE("GPL");