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 */
31struct 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 */
42static 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 */
91static const char *wm8971_bass[] = { "Linear Control", "Adaptive Boost" };
92static const char *wm8971_bass_filter[] = { "130Hz @ 48kHz",
93	"200Hz @ 48kHz" };
94static const char *wm8971_treble[] = { "8kHz", "4kHz" };
95static const char *wm8971_alc_func[] = { "Off", "Right", "Left", "Stereo" };
96static const char *wm8971_ng_type[] = { "Constant PGA Gain",
97	"Mute ADC Output" };
98static const char *wm8971_deemp[] = { "None", "32kHz", "44.1kHz", "48kHz" };
99static const char *wm8971_mono_mux[] = {"Stereo", "Mono (Left)",
100	"Mono (Right)", "Digital Mono"};
101static const char *wm8971_dac_phase[] = { "Non Inverted", "Inverted" };
102static const char *wm8971_lline_mux[] = {"Line", "NC", "NC", "PGA",
103	"Differential"};
104static const char *wm8971_rline_mux[] = {"Line", "Mic", "NC", "PGA",
105	"Differential"};
106static const char *wm8971_lpga_sel[] = {"Line", "NC", "NC", "Differential"};
107static const char *wm8971_rpga_sel[] = {"Line", "Mic", "NC", "Differential"};
108static const char *wm8971_adcpol[] = {"Normal", "L Invert", "R Invert",
109	"L + R Invert"};
110
111static 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
128static 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 */
192static const struct snd_kcontrol_new wm8971_left_mixer_controls[] = {
193SOC_DAPM_SINGLE("Playback Switch", WM8971_LOUTM1, 8, 1, 0),
194SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_LOUTM1, 7, 1, 0),
195SOC_DAPM_SINGLE("Right Playback Switch", WM8971_LOUTM2, 8, 1, 0),
196SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_LOUTM2, 7, 1, 0),
197};
198
199/* Right Mixer */
200static const struct snd_kcontrol_new wm8971_right_mixer_controls[] = {
201SOC_DAPM_SINGLE("Left Playback Switch", WM8971_ROUTM1, 8, 1, 0),
202SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_ROUTM1, 7, 1, 0),
203SOC_DAPM_SINGLE("Playback Switch", WM8971_ROUTM2, 8, 1, 0),
204SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_ROUTM2, 7, 1, 0),
205};
206
207/* Mono Mixer */
208static const struct snd_kcontrol_new wm8971_mono_mixer_controls[] = {
209SOC_DAPM_SINGLE("Left Playback Switch", WM8971_MOUTM1, 8, 1, 0),
210SOC_DAPM_SINGLE("Left Bypass Switch", WM8971_MOUTM1, 7, 1, 0),
211SOC_DAPM_SINGLE("Right Playback Switch", WM8971_MOUTM2, 8, 1, 0),
212SOC_DAPM_SINGLE("Right Bypass Switch", WM8971_MOUTM2, 7, 1, 0),
213};
214
215/* Left Line Mux */
216static const struct snd_kcontrol_new wm8971_left_line_controls =
217SOC_DAPM_ENUM("Route", wm8971_enum[8]);
218
219/* Right Line Mux */
220static const struct snd_kcontrol_new wm8971_right_line_controls =
221SOC_DAPM_ENUM("Route", wm8971_enum[9]);
222
223/* Left PGA Mux */
224static const struct snd_kcontrol_new wm8971_left_pga_controls =
225SOC_DAPM_ENUM("Route", wm8971_enum[10]);
226
227/* Right PGA Mux */
228static const struct snd_kcontrol_new wm8971_right_pga_controls =
229SOC_DAPM_ENUM("Route", wm8971_enum[11]);
230
231/* Mono ADC Mux */
232static const struct snd_kcontrol_new wm8971_monomux_controls =
233SOC_DAPM_ENUM("Route", wm8971_enum[13]);
234
235static 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
283static 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
360struct _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 */
369static 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
418static 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
429static 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
447static 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
505static 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
539static 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
551static 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
560static 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
603static 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
611static 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
628static 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
649static 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};
663
664static const struct regmap_config wm8971_regmap = {
665	.reg_bits = 7,
666	.val_bits = 9,
667	.max_register = WM8971_MOUTV,
668
669	.reg_defaults = wm8971_reg_defaults,
670	.num_reg_defaults = ARRAY_SIZE(wm8971_reg_defaults),
671	.cache_type = REGCACHE_MAPLE,
672};
673
674static int wm8971_i2c_probe(struct i2c_client *i2c)
675{
676	struct wm8971_priv *wm8971;
677
678	wm8971 = devm_kzalloc(&i2c->dev, sizeof(struct wm8971_priv),
679			      GFP_KERNEL);
680	if (wm8971 == NULL)
681		return -ENOMEM;
682
683	wm8971->regmap = devm_regmap_init_i2c(i2c, &wm8971_regmap);
684	if (IS_ERR(wm8971->regmap))
685		return PTR_ERR(wm8971->regmap);
686
687	i2c_set_clientdata(i2c, wm8971);
688
689	return devm_snd_soc_register_component(&i2c->dev,
690			&soc_component_dev_wm8971, &wm8971_dai, 1);
691}
692
693static const struct i2c_device_id wm8971_i2c_id[] = {
694	{ "wm8971", 0 },
695	{ }
696};
697MODULE_DEVICE_TABLE(i2c, wm8971_i2c_id);
698
699static struct i2c_driver wm8971_i2c_driver = {
700	.driver = {
701		.name = "wm8971",
702	},
703	.probe = wm8971_i2c_probe,
704	.id_table = wm8971_i2c_id,
705};
706
707module_i2c_driver(wm8971_i2c_driver);
708
709MODULE_DESCRIPTION("ASoC WM8971 driver");
710MODULE_AUTHOR("Lab126");
711MODULE_LICENSE("GPL");
712