xref: /linux/sound/soc/codecs/wm8971.c (revision 97733180fafbeb7cc3fd1c8be60d05980615f5d6)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * wm8971.c  --  WM8971 ALSA SoC Audio driver
4  *
5  * Copyright 2005 Lab126, Inc.
6  *
7  * Author: Kenneth Kiraly <kiraly@lab126.com>
8  *
9  * Based on wm8753.c by Liam Girdwood
10  */
11 
12 #include <linux/module.h>
13 #include <linux/moduleparam.h>
14 #include <linux/init.h>
15 #include <linux/delay.h>
16 #include <linux/pm.h>
17 #include <linux/i2c.h>
18 #include <linux/regmap.h>
19 #include <linux/slab.h>
20 #include <sound/core.h>
21 #include <sound/pcm.h>
22 #include <sound/pcm_params.h>
23 #include <sound/soc.h>
24 #include <sound/initval.h>
25 
26 #include "wm8971.h"
27 
28 #define	WM8971_REG_COUNT		43
29 
30 /* codec private data */
31 struct wm8971_priv {
32 	unsigned int sysclk;
33 	struct delayed_work charge_work;
34 	struct regmap *regmap;
35 };
36 
37 /*
38  * wm8971 register cache
39  * We can't read the WM8971 register space when we
40  * are using 2 wire for device control, so we cache them instead.
41  */
42 static const struct reg_default wm8971_reg_defaults[] = {
43 	{  0, 0x0097 },
44 	{  1, 0x0097 },
45 	{  2, 0x0079 },
46 	{  3, 0x0079 },
47 	{  4, 0x0000 },
48 	{  5, 0x0008 },
49 	{  6, 0x0000 },
50 	{  7, 0x000a },
51 	{  8, 0x0000 },
52 	{  9, 0x0000 },
53 	{ 10, 0x00ff },
54 	{ 11, 0x00ff },
55 	{ 12, 0x000f },
56 	{ 13, 0x000f },
57 	{ 14, 0x0000 },
58 	{ 15, 0x0000 },
59 	{ 16, 0x0000 },
60 	{ 17, 0x007b },
61 	{ 18, 0x0000 },
62 	{ 19, 0x0032 },
63 	{ 20, 0x0000 },
64 	{ 21, 0x00c3 },
65 	{ 22, 0x00c3 },
66 	{ 23, 0x00c0 },
67 	{ 24, 0x0000 },
68 	{ 25, 0x0000 },
69 	{ 26, 0x0000 },
70 	{ 27, 0x0000 },
71 	{ 28, 0x0000 },
72 	{ 29, 0x0000 },
73 	{ 30, 0x0000 },
74 	{ 31, 0x0000 },
75 	{ 32, 0x0000 },
76 	{ 33, 0x0000 },
77 	{ 34, 0x0050 },
78 	{ 35, 0x0050 },
79 	{ 36, 0x0050 },
80 	{ 37, 0x0050 },
81 	{ 38, 0x0050 },
82 	{ 39, 0x0050 },
83 	{ 40, 0x0079 },
84 	{ 41, 0x0079 },
85 	{ 42, 0x0079 },
86 };
87 
88 #define wm8971_reset(c)	snd_soc_component_write(c, WM8971_RESET, 0)
89 
90 /* WM8971 Controls */
91 static const char *wm8971_bass[] = { "Linear Control", "Adaptive Boost" };
92 static const char *wm8971_bass_filter[] = { "130Hz @ 48kHz",
93 	"200Hz @ 48kHz" };
94 static const char *wm8971_treble[] = { "8kHz", "4kHz" };
95 static const char *wm8971_alc_func[] = { "Off", "Right", "Left", "Stereo" };
96 static const char *wm8971_ng_type[] = { "Constant PGA Gain",
97 	"Mute ADC Output" };
98 static const char *wm8971_deemp[] = { "None", "32kHz", "44.1kHz", "48kHz" };
99 static const char *wm8971_mono_mux[] = {"Stereo", "Mono (Left)",
100 	"Mono (Right)", "Digital Mono"};
101 static const char *wm8971_dac_phase[] = { "Non Inverted", "Inverted" };
102 static const char *wm8971_lline_mux[] = {"Line", "NC", "NC", "PGA",
103 	"Differential"};
104 static const char *wm8971_rline_mux[] = {"Line", "Mic", "NC", "PGA",
105 	"Differential"};
106 static const char *wm8971_lpga_sel[] = {"Line", "NC", "NC", "Differential"};
107 static const char *wm8971_rpga_sel[] = {"Line", "Mic", "NC", "Differential"};
108 static const char *wm8971_adcpol[] = {"Normal", "L Invert", "R Invert",
109 	"L + R Invert"};
110 
111 static const struct soc_enum wm8971_enum[] = {
112 	SOC_ENUM_SINGLE(WM8971_BASS, 7, 2, wm8971_bass),	/* 0 */
113 	SOC_ENUM_SINGLE(WM8971_BASS, 6, 2, wm8971_bass_filter),
114 	SOC_ENUM_SINGLE(WM8971_TREBLE, 6, 2, wm8971_treble),
115 	SOC_ENUM_SINGLE(WM8971_ALC1, 7, 4, wm8971_alc_func),
116 	SOC_ENUM_SINGLE(WM8971_NGATE, 1, 2, wm8971_ng_type),    /* 4 */
117 	SOC_ENUM_SINGLE(WM8971_ADCDAC, 1, 4, wm8971_deemp),
118 	SOC_ENUM_SINGLE(WM8971_ADCTL1, 4, 4, wm8971_mono_mux),
119 	SOC_ENUM_SINGLE(WM8971_ADCTL1, 1, 2, wm8971_dac_phase),
120 	SOC_ENUM_SINGLE(WM8971_LOUTM1, 0, 5, wm8971_lline_mux), /* 8 */
121 	SOC_ENUM_SINGLE(WM8971_ROUTM1, 0, 5, wm8971_rline_mux),
122 	SOC_ENUM_SINGLE(WM8971_LADCIN, 6, 4, wm8971_lpga_sel),
123 	SOC_ENUM_SINGLE(WM8971_RADCIN, 6, 4, wm8971_rpga_sel),
124 	SOC_ENUM_SINGLE(WM8971_ADCDAC, 5, 4, wm8971_adcpol),    /* 12 */
125 	SOC_ENUM_SINGLE(WM8971_ADCIN, 6, 4, wm8971_mono_mux),
126 };
127 
128 static const struct snd_kcontrol_new wm8971_snd_controls[] = {
129 	SOC_DOUBLE_R("Capture Volume", WM8971_LINVOL, WM8971_RINVOL, 0, 63, 0),
130 	SOC_DOUBLE_R("Capture ZC Switch", WM8971_LINVOL, WM8971_RINVOL,
131 		     6, 1, 0),
132 	SOC_DOUBLE_R("Capture Switch", WM8971_LINVOL, WM8971_RINVOL, 7, 1, 1),
133 
134 	SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8971_LOUT1V,
135 		WM8971_ROUT1V, 7, 1, 0),
136 	SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8971_LOUT2V,
137 		WM8971_ROUT2V, 7, 1, 0),
138 	SOC_SINGLE("Mono Playback ZC Switch", WM8971_MOUTV, 7, 1, 0),
139 
140 	SOC_DOUBLE_R("PCM Volume", WM8971_LDAC, WM8971_RDAC, 0, 255, 0),
141 
142 	SOC_DOUBLE_R("Bypass Left Playback Volume", WM8971_LOUTM1,
143 		WM8971_LOUTM2, 4, 7, 1),
144 	SOC_DOUBLE_R("Bypass Right Playback Volume", WM8971_ROUTM1,
145 		WM8971_ROUTM2, 4, 7, 1),
146 	SOC_DOUBLE_R("Bypass Mono Playback Volume", WM8971_MOUTM1,
147 		WM8971_MOUTM2, 4, 7, 1),
148 
149 	SOC_DOUBLE_R("Headphone Playback Volume", WM8971_LOUT1V,
150 		WM8971_ROUT1V, 0, 127, 0),
151 	SOC_DOUBLE_R("Speaker Playback Volume", WM8971_LOUT2V,
152 		WM8971_ROUT2V, 0, 127, 0),
153 
154 	SOC_ENUM("Bass Boost", wm8971_enum[0]),
155 	SOC_ENUM("Bass Filter", wm8971_enum[1]),
156 	SOC_SINGLE("Bass Volume", WM8971_BASS, 0, 7, 1),
157 
158 	SOC_SINGLE("Treble Volume", WM8971_TREBLE, 0, 7, 0),
159 	SOC_ENUM("Treble Cut-off", wm8971_enum[2]),
160 
161 	SOC_SINGLE("Capture Filter Switch", WM8971_ADCDAC, 0, 1, 1),
162 
163 	SOC_SINGLE("ALC Target Volume", WM8971_ALC1, 0, 7, 0),
164 	SOC_SINGLE("ALC Max Volume", WM8971_ALC1, 4, 7, 0),
165 
166 	SOC_SINGLE("ALC Capture Target Volume", WM8971_ALC1, 0, 7, 0),
167 	SOC_SINGLE("ALC Capture Max Volume", WM8971_ALC1, 4, 7, 0),
168 	SOC_ENUM("ALC Capture Function", wm8971_enum[3]),
169 	SOC_SINGLE("ALC Capture ZC Switch", WM8971_ALC2, 7, 1, 0),
170 	SOC_SINGLE("ALC Capture Hold Time", WM8971_ALC2, 0, 15, 0),
171 	SOC_SINGLE("ALC Capture Decay Time", WM8971_ALC3, 4, 15, 0),
172 	SOC_SINGLE("ALC Capture Attack Time", WM8971_ALC3, 0, 15, 0),
173 	SOC_SINGLE("ALC Capture NG Threshold", WM8971_NGATE, 3, 31, 0),
174 	SOC_ENUM("ALC Capture NG Type", wm8971_enum[4]),
175 	SOC_SINGLE("ALC Capture NG Switch", WM8971_NGATE, 0, 1, 0),
176 
177 	SOC_SINGLE("Capture 6dB Attenuate", WM8971_ADCDAC, 8, 1, 0),
178 	SOC_SINGLE("Playback 6dB Attenuate", WM8971_ADCDAC, 7, 1, 0),
179 
180 	SOC_ENUM("Playback De-emphasis", wm8971_enum[5]),
181 	SOC_ENUM("Playback Function", wm8971_enum[6]),
182 	SOC_ENUM("Playback Phase", wm8971_enum[7]),
183 
184 	SOC_DOUBLE_R("Mic Boost", WM8971_LADCIN, WM8971_RADCIN, 4, 3, 0),
185 };
186 
187 /*
188  * DAPM Controls
189  */
190 
191 /* Left Mixer */
192 static const struct snd_kcontrol_new wm8971_left_mixer_controls[] = {
193 SOC_DAPM_SINGLE("Playback Switch", WM8971_LOUTM1, 8, 1, 0),
194 SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_LOUTM1, 7, 1, 0),
195 SOC_DAPM_SINGLE("Right Playback Switch", WM8971_LOUTM2, 8, 1, 0),
196 SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_LOUTM2, 7, 1, 0),
197 };
198 
199 /* Right Mixer */
200 static const struct snd_kcontrol_new wm8971_right_mixer_controls[] = {
201 SOC_DAPM_SINGLE("Left Playback Switch", WM8971_ROUTM1, 8, 1, 0),
202 SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_ROUTM1, 7, 1, 0),
203 SOC_DAPM_SINGLE("Playback Switch", WM8971_ROUTM2, 8, 1, 0),
204 SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_ROUTM2, 7, 1, 0),
205 };
206 
207 /* Mono Mixer */
208 static const struct snd_kcontrol_new wm8971_mono_mixer_controls[] = {
209 SOC_DAPM_SINGLE("Left Playback Switch", WM8971_MOUTM1, 8, 1, 0),
210 SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_MOUTM1, 7, 1, 0),
211 SOC_DAPM_SINGLE("Right Playback Switch", WM8971_MOUTM2, 8, 1, 0),
212 SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_MOUTM2, 7, 1, 0),
213 };
214 
215 /* Left Line Mux */
216 static const struct snd_kcontrol_new wm8971_left_line_controls =
217 SOC_DAPM_ENUM("Route", wm8971_enum[8]);
218 
219 /* Right Line Mux */
220 static const struct snd_kcontrol_new wm8971_right_line_controls =
221 SOC_DAPM_ENUM("Route", wm8971_enum[9]);
222 
223 /* Left PGA Mux */
224 static const struct snd_kcontrol_new wm8971_left_pga_controls =
225 SOC_DAPM_ENUM("Route", wm8971_enum[10]);
226 
227 /* Right PGA Mux */
228 static const struct snd_kcontrol_new wm8971_right_pga_controls =
229 SOC_DAPM_ENUM("Route", wm8971_enum[11]);
230 
231 /* Mono ADC Mux */
232 static const struct snd_kcontrol_new wm8971_monomux_controls =
233 SOC_DAPM_ENUM("Route", wm8971_enum[13]);
234 
235 static const struct snd_soc_dapm_widget wm8971_dapm_widgets[] = {
236 	SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0,
237 		&wm8971_left_mixer_controls[0],
238 		ARRAY_SIZE(wm8971_left_mixer_controls)),
239 	SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0,
240 		&wm8971_right_mixer_controls[0],
241 		ARRAY_SIZE(wm8971_right_mixer_controls)),
242 	SND_SOC_DAPM_MIXER("Mono Mixer", WM8971_PWR2, 2, 0,
243 		&wm8971_mono_mixer_controls[0],
244 		ARRAY_SIZE(wm8971_mono_mixer_controls)),
245 
246 	SND_SOC_DAPM_PGA("Right Out 2", WM8971_PWR2, 3, 0, NULL, 0),
247 	SND_SOC_DAPM_PGA("Left Out 2", WM8971_PWR2, 4, 0, NULL, 0),
248 	SND_SOC_DAPM_PGA("Right Out 1", WM8971_PWR2, 5, 0, NULL, 0),
249 	SND_SOC_DAPM_PGA("Left Out 1", WM8971_PWR2, 6, 0, NULL, 0),
250 	SND_SOC_DAPM_DAC("Right DAC", "Right Playback", WM8971_PWR2, 7, 0),
251 	SND_SOC_DAPM_DAC("Left DAC", "Left Playback", WM8971_PWR2, 8, 0),
252 	SND_SOC_DAPM_PGA("Mono Out 1", WM8971_PWR2, 2, 0, NULL, 0),
253 
254 	SND_SOC_DAPM_SUPPLY("Mic Bias", WM8971_PWR1, 1, 0, NULL, 0),
255 	SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8971_PWR1, 2, 0),
256 	SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8971_PWR1, 3, 0),
257 
258 	SND_SOC_DAPM_MUX("Left PGA Mux", WM8971_PWR1, 5, 0,
259 		&wm8971_left_pga_controls),
260 	SND_SOC_DAPM_MUX("Right PGA Mux", WM8971_PWR1, 4, 0,
261 		&wm8971_right_pga_controls),
262 	SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0,
263 		&wm8971_left_line_controls),
264 	SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0,
265 		&wm8971_right_line_controls),
266 
267 	SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0,
268 		&wm8971_monomux_controls),
269 	SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0,
270 		&wm8971_monomux_controls),
271 
272 	SND_SOC_DAPM_OUTPUT("LOUT1"),
273 	SND_SOC_DAPM_OUTPUT("ROUT1"),
274 	SND_SOC_DAPM_OUTPUT("LOUT2"),
275 	SND_SOC_DAPM_OUTPUT("ROUT2"),
276 	SND_SOC_DAPM_OUTPUT("MONO"),
277 
278 	SND_SOC_DAPM_INPUT("LINPUT1"),
279 	SND_SOC_DAPM_INPUT("RINPUT1"),
280 	SND_SOC_DAPM_INPUT("MIC"),
281 };
282 
283 static const struct snd_soc_dapm_route wm8971_dapm_routes[] = {
284 	/* left mixer */
285 	{"Left Mixer", "Playback Switch", "Left DAC"},
286 	{"Left Mixer", "Left Bypass Switch", "Left Line Mux"},
287 	{"Left Mixer", "Right Playback Switch", "Right DAC"},
288 	{"Left Mixer", "Right Bypass Switch", "Right Line Mux"},
289 
290 	/* right mixer */
291 	{"Right Mixer", "Left Playback Switch", "Left DAC"},
292 	{"Right Mixer", "Left Bypass Switch", "Left Line Mux"},
293 	{"Right Mixer", "Playback Switch", "Right DAC"},
294 	{"Right Mixer", "Right Bypass Switch", "Right Line Mux"},
295 
296 	/* left out 1 */
297 	{"Left Out 1", NULL, "Left Mixer"},
298 	{"LOUT1", NULL, "Left Out 1"},
299 
300 	/* left out 2 */
301 	{"Left Out 2", NULL, "Left Mixer"},
302 	{"LOUT2", NULL, "Left Out 2"},
303 
304 	/* right out 1 */
305 	{"Right Out 1", NULL, "Right Mixer"},
306 	{"ROUT1", NULL, "Right Out 1"},
307 
308 	/* right out 2 */
309 	{"Right Out 2", NULL, "Right Mixer"},
310 	{"ROUT2", NULL, "Right Out 2"},
311 
312 	/* mono mixer */
313 	{"Mono Mixer", "Left Playback Switch", "Left DAC"},
314 	{"Mono Mixer", "Left Bypass Switch", "Left Line Mux"},
315 	{"Mono Mixer", "Right Playback Switch", "Right DAC"},
316 	{"Mono Mixer", "Right Bypass Switch", "Right Line Mux"},
317 
318 	/* mono out */
319 	{"Mono Out", NULL, "Mono Mixer"},
320 	{"MONO1", NULL, "Mono Out"},
321 
322 	/* Left Line Mux */
323 	{"Left Line Mux", "Line", "LINPUT1"},
324 	{"Left Line Mux", "PGA", "Left PGA Mux"},
325 	{"Left Line Mux", "Differential", "Differential Mux"},
326 
327 	/* Right Line Mux */
328 	{"Right Line Mux", "Line", "RINPUT1"},
329 	{"Right Line Mux", "Mic", "MIC"},
330 	{"Right Line Mux", "PGA", "Right PGA Mux"},
331 	{"Right Line Mux", "Differential", "Differential Mux"},
332 
333 	/* Left PGA Mux */
334 	{"Left PGA Mux", "Line", "LINPUT1"},
335 	{"Left PGA Mux", "Differential", "Differential Mux"},
336 
337 	/* Right PGA Mux */
338 	{"Right PGA Mux", "Line", "RINPUT1"},
339 	{"Right PGA Mux", "Differential", "Differential Mux"},
340 
341 	/* Differential Mux */
342 	{"Differential Mux", "Line", "LINPUT1"},
343 	{"Differential Mux", "Line", "RINPUT1"},
344 
345 	/* Left ADC Mux */
346 	{"Left ADC Mux", "Stereo", "Left PGA Mux"},
347 	{"Left ADC Mux", "Mono (Left)", "Left PGA Mux"},
348 	{"Left ADC Mux", "Digital Mono", "Left PGA Mux"},
349 
350 	/* Right ADC Mux */
351 	{"Right ADC Mux", "Stereo", "Right PGA Mux"},
352 	{"Right ADC Mux", "Mono (Right)", "Right PGA Mux"},
353 	{"Right ADC Mux", "Digital Mono", "Right PGA Mux"},
354 
355 	/* ADC */
356 	{"Left ADC", NULL, "Left ADC Mux"},
357 	{"Right ADC", NULL, "Right ADC Mux"},
358 };
359 
360 struct _coeff_div {
361 	u32 mclk;
362 	u32 rate;
363 	u16 fs;
364 	u8 sr:5;
365 	u8 usb:1;
366 };
367 
368 /* codec hifi mclk clock divider coefficients */
369 static const struct _coeff_div coeff_div[] = {
370 	/* 8k */
371 	{12288000, 8000, 1536, 0x6, 0x0},
372 	{11289600, 8000, 1408, 0x16, 0x0},
373 	{18432000, 8000, 2304, 0x7, 0x0},
374 	{16934400, 8000, 2112, 0x17, 0x0},
375 	{12000000, 8000, 1500, 0x6, 0x1},
376 
377 	/* 11.025k */
378 	{11289600, 11025, 1024, 0x18, 0x0},
379 	{16934400, 11025, 1536, 0x19, 0x0},
380 	{12000000, 11025, 1088, 0x19, 0x1},
381 
382 	/* 16k */
383 	{12288000, 16000, 768, 0xa, 0x0},
384 	{18432000, 16000, 1152, 0xb, 0x0},
385 	{12000000, 16000, 750, 0xa, 0x1},
386 
387 	/* 22.05k */
388 	{11289600, 22050, 512, 0x1a, 0x0},
389 	{16934400, 22050, 768, 0x1b, 0x0},
390 	{12000000, 22050, 544, 0x1b, 0x1},
391 
392 	/* 32k */
393 	{12288000, 32000, 384, 0xc, 0x0},
394 	{18432000, 32000, 576, 0xd, 0x0},
395 	{12000000, 32000, 375, 0xa, 0x1},
396 
397 	/* 44.1k */
398 	{11289600, 44100, 256, 0x10, 0x0},
399 	{16934400, 44100, 384, 0x11, 0x0},
400 	{12000000, 44100, 272, 0x11, 0x1},
401 
402 	/* 48k */
403 	{12288000, 48000, 256, 0x0, 0x0},
404 	{18432000, 48000, 384, 0x1, 0x0},
405 	{12000000, 48000, 250, 0x0, 0x1},
406 
407 	/* 88.2k */
408 	{11289600, 88200, 128, 0x1e, 0x0},
409 	{16934400, 88200, 192, 0x1f, 0x0},
410 	{12000000, 88200, 136, 0x1f, 0x1},
411 
412 	/* 96k */
413 	{12288000, 96000, 128, 0xe, 0x0},
414 	{18432000, 96000, 192, 0xf, 0x0},
415 	{12000000, 96000, 125, 0xe, 0x1},
416 };
417 
418 static int get_coeff(int mclk, int rate)
419 {
420 	int i;
421 
422 	for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
423 		if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
424 			return i;
425 	}
426 	return -EINVAL;
427 }
428 
429 static int wm8971_set_dai_sysclk(struct snd_soc_dai *codec_dai,
430 		int clk_id, unsigned int freq, int dir)
431 {
432 	struct snd_soc_component *component = codec_dai->component;
433 	struct wm8971_priv *wm8971 = snd_soc_component_get_drvdata(component);
434 
435 	switch (freq) {
436 	case 11289600:
437 	case 12000000:
438 	case 12288000:
439 	case 16934400:
440 	case 18432000:
441 		wm8971->sysclk = freq;
442 		return 0;
443 	}
444 	return -EINVAL;
445 }
446 
447 static int wm8971_set_dai_fmt(struct snd_soc_dai *codec_dai,
448 		unsigned int fmt)
449 {
450 	struct snd_soc_component *component = codec_dai->component;
451 	u16 iface = 0;
452 
453 	/* set master/slave audio interface */
454 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
455 	case SND_SOC_DAIFMT_CBM_CFM:
456 		iface = 0x0040;
457 		break;
458 	case SND_SOC_DAIFMT_CBS_CFS:
459 		break;
460 	default:
461 		return -EINVAL;
462 	}
463 
464 	/* interface format */
465 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
466 	case SND_SOC_DAIFMT_I2S:
467 		iface |= 0x0002;
468 		break;
469 	case SND_SOC_DAIFMT_RIGHT_J:
470 		break;
471 	case SND_SOC_DAIFMT_LEFT_J:
472 		iface |= 0x0001;
473 		break;
474 	case SND_SOC_DAIFMT_DSP_A:
475 		iface |= 0x0003;
476 		break;
477 	case SND_SOC_DAIFMT_DSP_B:
478 		iface |= 0x0013;
479 		break;
480 	default:
481 		return -EINVAL;
482 	}
483 
484 	/* clock inversion */
485 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
486 	case SND_SOC_DAIFMT_NB_NF:
487 		break;
488 	case SND_SOC_DAIFMT_IB_IF:
489 		iface |= 0x0090;
490 		break;
491 	case SND_SOC_DAIFMT_IB_NF:
492 		iface |= 0x0080;
493 		break;
494 	case SND_SOC_DAIFMT_NB_IF:
495 		iface |= 0x0010;
496 		break;
497 	default:
498 		return -EINVAL;
499 	}
500 
501 	snd_soc_component_write(component, WM8971_IFACE, iface);
502 	return 0;
503 }
504 
505 static int wm8971_pcm_hw_params(struct snd_pcm_substream *substream,
506 	struct snd_pcm_hw_params *params,
507 	struct snd_soc_dai *dai)
508 {
509 	struct snd_soc_component *component = dai->component;
510 	struct wm8971_priv *wm8971 = snd_soc_component_get_drvdata(component);
511 	u16 iface = snd_soc_component_read(component, WM8971_IFACE) & 0x1f3;
512 	u16 srate = snd_soc_component_read(component, WM8971_SRATE) & 0x1c0;
513 	int coeff = get_coeff(wm8971->sysclk, params_rate(params));
514 
515 	/* bit size */
516 	switch (params_width(params)) {
517 	case 16:
518 		break;
519 	case 20:
520 		iface |= 0x0004;
521 		break;
522 	case 24:
523 		iface |= 0x0008;
524 		break;
525 	case 32:
526 		iface |= 0x000c;
527 		break;
528 	}
529 
530 	/* set iface & srate */
531 	snd_soc_component_write(component, WM8971_IFACE, iface);
532 	if (coeff >= 0)
533 		snd_soc_component_write(component, WM8971_SRATE, srate |
534 			(coeff_div[coeff].sr << 1) | coeff_div[coeff].usb);
535 
536 	return 0;
537 }
538 
539 static int wm8971_mute(struct snd_soc_dai *dai, int mute, int direction)
540 {
541 	struct snd_soc_component *component = dai->component;
542 	u16 mute_reg = snd_soc_component_read(component, WM8971_ADCDAC) & 0xfff7;
543 
544 	if (mute)
545 		snd_soc_component_write(component, WM8971_ADCDAC, mute_reg | 0x8);
546 	else
547 		snd_soc_component_write(component, WM8971_ADCDAC, mute_reg);
548 	return 0;
549 }
550 
551 static void wm8971_charge_work(struct work_struct *work)
552 {
553 	struct wm8971_priv *wm8971 =
554 		container_of(work, struct wm8971_priv, charge_work.work);
555 
556 	/* Set to 500k */
557 	regmap_update_bits(wm8971->regmap, WM8971_PWR1, 0x0180, 0x0100);
558 }
559 
560 static int wm8971_set_bias_level(struct snd_soc_component *component,
561 	enum snd_soc_bias_level level)
562 {
563 	struct wm8971_priv *wm8971 = snd_soc_component_get_drvdata(component);
564 	u16 pwr_reg = snd_soc_component_read(component, WM8971_PWR1) & 0xfe3e;
565 
566 	switch (level) {
567 	case SND_SOC_BIAS_ON:
568 		/* set vmid to 50k and unmute dac */
569 		snd_soc_component_write(component, WM8971_PWR1, pwr_reg | 0x00c1);
570 		break;
571 	case SND_SOC_BIAS_PREPARE:
572 		/* Wait until fully charged */
573 		flush_delayed_work(&wm8971->charge_work);
574 		break;
575 	case SND_SOC_BIAS_STANDBY:
576 		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
577 			snd_soc_component_cache_sync(component);
578 			/* charge output caps - set vmid to 5k for quick power up */
579 			snd_soc_component_write(component, WM8971_PWR1, pwr_reg | 0x01c0);
580 			queue_delayed_work(system_power_efficient_wq,
581 				&wm8971->charge_work, msecs_to_jiffies(1000));
582 		} else {
583 			/* mute dac and set vmid to 500k, enable VREF */
584 			snd_soc_component_write(component, WM8971_PWR1, pwr_reg | 0x0140);
585 		}
586 
587 		break;
588 	case SND_SOC_BIAS_OFF:
589 		cancel_delayed_work_sync(&wm8971->charge_work);
590 		snd_soc_component_write(component, WM8971_PWR1, 0x0001);
591 		break;
592 	}
593 	return 0;
594 }
595 
596 #define WM8971_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
597 		SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 | SNDRV_PCM_RATE_44100 | \
598 		SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_88200 | SNDRV_PCM_RATE_96000)
599 
600 #define WM8971_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
601 	SNDRV_PCM_FMTBIT_S24_LE)
602 
603 static const struct snd_soc_dai_ops wm8971_dai_ops = {
604 	.hw_params	= wm8971_pcm_hw_params,
605 	.mute_stream	= wm8971_mute,
606 	.set_fmt	= wm8971_set_dai_fmt,
607 	.set_sysclk	= wm8971_set_dai_sysclk,
608 	.no_capture_mute = 1,
609 };
610 
611 static struct snd_soc_dai_driver wm8971_dai = {
612 	.name = "wm8971-hifi",
613 	.playback = {
614 		.stream_name = "Playback",
615 		.channels_min = 1,
616 		.channels_max = 2,
617 		.rates = WM8971_RATES,
618 		.formats = WM8971_FORMATS,},
619 	.capture = {
620 		.stream_name = "Capture",
621 		.channels_min = 1,
622 		.channels_max = 2,
623 		.rates = WM8971_RATES,
624 		.formats = WM8971_FORMATS,},
625 	.ops = &wm8971_dai_ops,
626 };
627 
628 static int wm8971_probe(struct snd_soc_component *component)
629 {
630 	struct wm8971_priv *wm8971 = snd_soc_component_get_drvdata(component);
631 
632 	INIT_DELAYED_WORK(&wm8971->charge_work, wm8971_charge_work);
633 
634 	wm8971_reset(component);
635 
636 	/* set the update bits */
637 	snd_soc_component_update_bits(component, WM8971_LDAC, 0x0100, 0x0100);
638 	snd_soc_component_update_bits(component, WM8971_RDAC, 0x0100, 0x0100);
639 	snd_soc_component_update_bits(component, WM8971_LOUT1V, 0x0100, 0x0100);
640 	snd_soc_component_update_bits(component, WM8971_ROUT1V, 0x0100, 0x0100);
641 	snd_soc_component_update_bits(component, WM8971_LOUT2V, 0x0100, 0x0100);
642 	snd_soc_component_update_bits(component, WM8971_ROUT2V, 0x0100, 0x0100);
643 	snd_soc_component_update_bits(component, WM8971_LINVOL, 0x0100, 0x0100);
644 	snd_soc_component_update_bits(component, WM8971_RINVOL, 0x0100, 0x0100);
645 
646 	return 0;
647 }
648 
649 static const struct snd_soc_component_driver soc_component_dev_wm8971 = {
650 	.probe			= wm8971_probe,
651 	.set_bias_level		= wm8971_set_bias_level,
652 	.controls		= wm8971_snd_controls,
653 	.num_controls		= ARRAY_SIZE(wm8971_snd_controls),
654 	.dapm_widgets		= wm8971_dapm_widgets,
655 	.num_dapm_widgets	= ARRAY_SIZE(wm8971_dapm_widgets),
656 	.dapm_routes		= wm8971_dapm_routes,
657 	.num_dapm_routes	= ARRAY_SIZE(wm8971_dapm_routes),
658 	.suspend_bias_off	= 1,
659 	.idle_bias_on		= 1,
660 	.use_pmdown_time	= 1,
661 	.endianness		= 1,
662 	.non_legacy_dai_naming	= 1,
663 };
664 
665 static const struct regmap_config wm8971_regmap = {
666 	.reg_bits = 7,
667 	.val_bits = 9,
668 	.max_register = WM8971_MOUTV,
669 
670 	.reg_defaults = wm8971_reg_defaults,
671 	.num_reg_defaults = ARRAY_SIZE(wm8971_reg_defaults),
672 	.cache_type = REGCACHE_RBTREE,
673 };
674 
675 static int wm8971_i2c_probe(struct i2c_client *i2c,
676 			    const struct i2c_device_id *id)
677 {
678 	struct wm8971_priv *wm8971;
679 	int ret;
680 
681 	wm8971 = devm_kzalloc(&i2c->dev, sizeof(struct wm8971_priv),
682 			      GFP_KERNEL);
683 	if (wm8971 == NULL)
684 		return -ENOMEM;
685 
686 	wm8971->regmap = devm_regmap_init_i2c(i2c, &wm8971_regmap);
687 	if (IS_ERR(wm8971->regmap))
688 		return PTR_ERR(wm8971->regmap);
689 
690 	i2c_set_clientdata(i2c, wm8971);
691 
692 	ret = devm_snd_soc_register_component(&i2c->dev,
693 			&soc_component_dev_wm8971, &wm8971_dai, 1);
694 
695 	return ret;
696 }
697 
698 static const struct i2c_device_id wm8971_i2c_id[] = {
699 	{ "wm8971", 0 },
700 	{ }
701 };
702 MODULE_DEVICE_TABLE(i2c, wm8971_i2c_id);
703 
704 static struct i2c_driver wm8971_i2c_driver = {
705 	.driver = {
706 		.name = "wm8971",
707 	},
708 	.probe =    wm8971_i2c_probe,
709 	.id_table = wm8971_i2c_id,
710 };
711 
712 module_i2c_driver(wm8971_i2c_driver);
713 
714 MODULE_DESCRIPTION("ASoC WM8971 driver");
715 MODULE_AUTHOR("Lab126");
716 MODULE_LICENSE("GPL");
717