xref: /openbmc/linux/sound/soc/codecs/wm8960.c (revision 3c01b9ee)
1f2644a2cSMark Brown /*
2f2644a2cSMark Brown  * wm8960.c  --  WM8960 ALSA SoC Audio driver
3f2644a2cSMark Brown  *
4656baaebSMark Brown  * Copyright 2007-11 Wolfson Microelectronics, plc
5656baaebSMark Brown  *
6f2644a2cSMark Brown  * Author: Liam Girdwood
7f2644a2cSMark Brown  *
8f2644a2cSMark Brown  * This program is free software; you can redistribute it and/or modify
9f2644a2cSMark Brown  * it under the terms of the GNU General Public License version 2 as
10f2644a2cSMark Brown  * published by the Free Software Foundation.
11f2644a2cSMark Brown  */
12f2644a2cSMark Brown 
13f2644a2cSMark Brown #include <linux/module.h>
14f2644a2cSMark Brown #include <linux/moduleparam.h>
15f2644a2cSMark Brown #include <linux/init.h>
16f2644a2cSMark Brown #include <linux/delay.h>
17f2644a2cSMark Brown #include <linux/pm.h>
1875aa8868SZidan Wang #include <linux/clk.h>
19f2644a2cSMark Brown #include <linux/i2c.h>
205a0e3ad6STejun Heo #include <linux/slab.h>
21f2644a2cSMark Brown #include <sound/core.h>
22f2644a2cSMark Brown #include <sound/pcm.h>
23f2644a2cSMark Brown #include <sound/pcm_params.h>
24f2644a2cSMark Brown #include <sound/soc.h>
25f2644a2cSMark Brown #include <sound/initval.h>
26f2644a2cSMark Brown #include <sound/tlv.h>
27b6877a47SMark Brown #include <sound/wm8960.h>
28f2644a2cSMark Brown 
29f2644a2cSMark Brown #include "wm8960.h"
30f2644a2cSMark Brown 
31f2644a2cSMark Brown /* R25 - Power 1 */
32913d7b4cSMark Brown #define WM8960_VMID_MASK 0x180
33f2644a2cSMark Brown #define WM8960_VREF      0x40
34f2644a2cSMark Brown 
35913d7b4cSMark Brown /* R26 - Power 2 */
36913d7b4cSMark Brown #define WM8960_PWR2_LOUT1	0x40
37913d7b4cSMark Brown #define WM8960_PWR2_ROUT1	0x20
38913d7b4cSMark Brown #define WM8960_PWR2_OUT3	0x02
39913d7b4cSMark Brown 
40f2644a2cSMark Brown /* R28 - Anti-pop 1 */
41f2644a2cSMark Brown #define WM8960_POBCTRL   0x80
42f2644a2cSMark Brown #define WM8960_BUFDCOPEN 0x10
43f2644a2cSMark Brown #define WM8960_BUFIOEN   0x08
44f2644a2cSMark Brown #define WM8960_SOFT_ST   0x04
45f2644a2cSMark Brown #define WM8960_HPSTBY    0x01
46f2644a2cSMark Brown 
47f2644a2cSMark Brown /* R29 - Anti-pop 2 */
48f2644a2cSMark Brown #define WM8960_DISOP     0x40
49913d7b4cSMark Brown #define WM8960_DRES_MASK 0x30
50f2644a2cSMark Brown 
513176bf2dSZidan Wang static bool is_pll_freq_available(unsigned int source, unsigned int target);
523176bf2dSZidan Wang static int wm8960_set_pll(struct snd_soc_codec *codec,
533176bf2dSZidan Wang 		unsigned int freq_in, unsigned int freq_out);
54f2644a2cSMark Brown /*
55f2644a2cSMark Brown  * wm8960 register cache
56f2644a2cSMark Brown  * We can't read the WM8960 register space when we are
57f2644a2cSMark Brown  * using 2 wire for device control, so we cache them instead.
58f2644a2cSMark Brown  */
590ebe36c6SMark Brown static const struct reg_default wm8960_reg_defaults[] = {
60b3df026eSMark Brown 	{  0x0, 0x00a7 },
61b3df026eSMark Brown 	{  0x1, 0x00a7 },
620ebe36c6SMark Brown 	{  0x2, 0x0000 },
630ebe36c6SMark Brown 	{  0x3, 0x0000 },
640ebe36c6SMark Brown 	{  0x4, 0x0000 },
650ebe36c6SMark Brown 	{  0x5, 0x0008 },
660ebe36c6SMark Brown 	{  0x6, 0x0000 },
670ebe36c6SMark Brown 	{  0x7, 0x000a },
680ebe36c6SMark Brown 	{  0x8, 0x01c0 },
690ebe36c6SMark Brown 	{  0x9, 0x0000 },
700ebe36c6SMark Brown 	{  0xa, 0x00ff },
710ebe36c6SMark Brown 	{  0xb, 0x00ff },
720ebe36c6SMark Brown 
730ebe36c6SMark Brown 	{ 0x10, 0x0000 },
740ebe36c6SMark Brown 	{ 0x11, 0x007b },
750ebe36c6SMark Brown 	{ 0x12, 0x0100 },
760ebe36c6SMark Brown 	{ 0x13, 0x0032 },
770ebe36c6SMark Brown 	{ 0x14, 0x0000 },
780ebe36c6SMark Brown 	{ 0x15, 0x00c3 },
790ebe36c6SMark Brown 	{ 0x16, 0x00c3 },
800ebe36c6SMark Brown 	{ 0x17, 0x01c0 },
810ebe36c6SMark Brown 	{ 0x18, 0x0000 },
820ebe36c6SMark Brown 	{ 0x19, 0x0000 },
830ebe36c6SMark Brown 	{ 0x1a, 0x0000 },
840ebe36c6SMark Brown 	{ 0x1b, 0x0000 },
850ebe36c6SMark Brown 	{ 0x1c, 0x0000 },
860ebe36c6SMark Brown 	{ 0x1d, 0x0000 },
870ebe36c6SMark Brown 
880ebe36c6SMark Brown 	{ 0x20, 0x0100 },
890ebe36c6SMark Brown 	{ 0x21, 0x0100 },
900ebe36c6SMark Brown 	{ 0x22, 0x0050 },
910ebe36c6SMark Brown 
920ebe36c6SMark Brown 	{ 0x25, 0x0050 },
930ebe36c6SMark Brown 	{ 0x26, 0x0000 },
940ebe36c6SMark Brown 	{ 0x27, 0x0000 },
950ebe36c6SMark Brown 	{ 0x28, 0x0000 },
960ebe36c6SMark Brown 	{ 0x29, 0x0000 },
970ebe36c6SMark Brown 	{ 0x2a, 0x0040 },
980ebe36c6SMark Brown 	{ 0x2b, 0x0000 },
990ebe36c6SMark Brown 	{ 0x2c, 0x0000 },
1000ebe36c6SMark Brown 	{ 0x2d, 0x0050 },
1010ebe36c6SMark Brown 	{ 0x2e, 0x0050 },
1020ebe36c6SMark Brown 	{ 0x2f, 0x0000 },
1030ebe36c6SMark Brown 	{ 0x30, 0x0002 },
1040ebe36c6SMark Brown 	{ 0x31, 0x0037 },
1050ebe36c6SMark Brown 
1060ebe36c6SMark Brown 	{ 0x33, 0x0080 },
1070ebe36c6SMark Brown 	{ 0x34, 0x0008 },
1080ebe36c6SMark Brown 	{ 0x35, 0x0031 },
1090ebe36c6SMark Brown 	{ 0x36, 0x0026 },
1100ebe36c6SMark Brown 	{ 0x37, 0x00e9 },
111f2644a2cSMark Brown };
112f2644a2cSMark Brown 
1130ebe36c6SMark Brown static bool wm8960_volatile(struct device *dev, unsigned int reg)
1140ebe36c6SMark Brown {
1150ebe36c6SMark Brown 	switch (reg) {
1160ebe36c6SMark Brown 	case WM8960_RESET:
1170ebe36c6SMark Brown 		return true;
1180ebe36c6SMark Brown 	default:
1190ebe36c6SMark Brown 		return false;
1200ebe36c6SMark Brown 	}
1210ebe36c6SMark Brown }
1220ebe36c6SMark Brown 
123f2644a2cSMark Brown struct wm8960_priv {
12475aa8868SZidan Wang 	struct clk *mclk;
1250ebe36c6SMark Brown 	struct regmap *regmap;
126f0fba2adSLiam Girdwood 	int (*set_bias_level)(struct snd_soc_codec *,
127f0fba2adSLiam Girdwood 			      enum snd_soc_bias_level level);
128913d7b4cSMark Brown 	struct snd_soc_dapm_widget *lout1;
129913d7b4cSMark Brown 	struct snd_soc_dapm_widget *rout1;
130913d7b4cSMark Brown 	struct snd_soc_dapm_widget *out3;
131afd6d36aSMark Brown 	bool deemph;
1323176bf2dSZidan Wang 	int lrclk;
1330e50b51aSZidan Wang 	int bclk;
1340e50b51aSZidan Wang 	int sysclk;
1353176bf2dSZidan Wang 	int clk_id;
1363176bf2dSZidan Wang 	int freq_in;
1373176bf2dSZidan Wang 	bool is_stream_in_use[2];
138e2280c90SZidan Wang 	struct wm8960_data pdata;
139f2644a2cSMark Brown };
140f2644a2cSMark Brown 
1413ad5e861SZidan Wang #define wm8960_reset(c)	regmap_write(c, WM8960_RESET, 0)
142f2644a2cSMark Brown 
143f2644a2cSMark Brown /* enumerated controls */
144f2644a2cSMark Brown static const char *wm8960_polarity[] = {"No Inversion", "Left Inverted",
145f2644a2cSMark Brown 	"Right Inverted", "Stereo Inversion"};
146f2644a2cSMark Brown static const char *wm8960_3d_upper_cutoff[] = {"High", "Low"};
147f2644a2cSMark Brown static const char *wm8960_3d_lower_cutoff[] = {"Low", "High"};
148f2644a2cSMark Brown static const char *wm8960_alcfunc[] = {"Off", "Right", "Left", "Stereo"};
149f2644a2cSMark Brown static const char *wm8960_alcmode[] = {"ALC", "Limiter"};
1504a5893cfSZidan Wang static const char *wm8960_adc_data_output_sel[] = {
1514a5893cfSZidan Wang 	"Left Data = Left ADC;  Right Data = Right ADC",
1524a5893cfSZidan Wang 	"Left Data = Left ADC;  Right Data = Left ADC",
1534a5893cfSZidan Wang 	"Left Data = Right ADC; Right Data = Right ADC",
1544a5893cfSZidan Wang 	"Left Data = Right ADC; Right Data = Left ADC",
1554a5893cfSZidan Wang };
156defbf708SZidan Wang static const char *wm8960_dmonomix[] = {"Stereo", "Mono"};
157f2644a2cSMark Brown 
158f2644a2cSMark Brown static const struct soc_enum wm8960_enum[] = {
159f2644a2cSMark Brown 	SOC_ENUM_SINGLE(WM8960_DACCTL1, 5, 4, wm8960_polarity),
160f2644a2cSMark Brown 	SOC_ENUM_SINGLE(WM8960_DACCTL2, 5, 4, wm8960_polarity),
161f2644a2cSMark Brown 	SOC_ENUM_SINGLE(WM8960_3D, 6, 2, wm8960_3d_upper_cutoff),
162f2644a2cSMark Brown 	SOC_ENUM_SINGLE(WM8960_3D, 5, 2, wm8960_3d_lower_cutoff),
163f2644a2cSMark Brown 	SOC_ENUM_SINGLE(WM8960_ALC1, 7, 4, wm8960_alcfunc),
164f2644a2cSMark Brown 	SOC_ENUM_SINGLE(WM8960_ALC3, 8, 2, wm8960_alcmode),
1654a5893cfSZidan Wang 	SOC_ENUM_SINGLE(WM8960_ADDCTL1, 2, 4, wm8960_adc_data_output_sel),
166defbf708SZidan Wang 	SOC_ENUM_SINGLE(WM8960_ADDCTL1, 4, 2, wm8960_dmonomix),
167f2644a2cSMark Brown };
168f2644a2cSMark Brown 
169afd6d36aSMark Brown static const int deemph_settings[] = { 0, 32000, 44100, 48000 };
170afd6d36aSMark Brown 
171afd6d36aSMark Brown static int wm8960_set_deemph(struct snd_soc_codec *codec)
172afd6d36aSMark Brown {
173afd6d36aSMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
174afd6d36aSMark Brown 	int val, i, best;
175afd6d36aSMark Brown 
176afd6d36aSMark Brown 	/* If we're using deemphasis select the nearest available sample
177afd6d36aSMark Brown 	 * rate.
178afd6d36aSMark Brown 	 */
179afd6d36aSMark Brown 	if (wm8960->deemph) {
180afd6d36aSMark Brown 		best = 1;
181afd6d36aSMark Brown 		for (i = 2; i < ARRAY_SIZE(deemph_settings); i++) {
1823176bf2dSZidan Wang 			if (abs(deemph_settings[i] - wm8960->lrclk) <
1833176bf2dSZidan Wang 			    abs(deemph_settings[best] - wm8960->lrclk))
184afd6d36aSMark Brown 				best = i;
185afd6d36aSMark Brown 		}
186afd6d36aSMark Brown 
187afd6d36aSMark Brown 		val = best << 1;
188afd6d36aSMark Brown 	} else {
189afd6d36aSMark Brown 		val = 0;
190afd6d36aSMark Brown 	}
191afd6d36aSMark Brown 
192afd6d36aSMark Brown 	dev_dbg(codec->dev, "Set deemphasis %d\n", val);
193afd6d36aSMark Brown 
194afd6d36aSMark Brown 	return snd_soc_update_bits(codec, WM8960_DACCTL1,
195afd6d36aSMark Brown 				   0x6, val);
196afd6d36aSMark Brown }
197afd6d36aSMark Brown 
198afd6d36aSMark Brown static int wm8960_get_deemph(struct snd_kcontrol *kcontrol,
199afd6d36aSMark Brown 			     struct snd_ctl_elem_value *ucontrol)
200afd6d36aSMark Brown {
201ea53bf77SLars-Peter Clausen 	struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
202afd6d36aSMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
203afd6d36aSMark Brown 
204b4a18c8bSTakashi Iwai 	ucontrol->value.integer.value[0] = wm8960->deemph;
2053f343f85SDmitry Artamonow 	return 0;
206afd6d36aSMark Brown }
207afd6d36aSMark Brown 
208afd6d36aSMark Brown static int wm8960_put_deemph(struct snd_kcontrol *kcontrol,
209afd6d36aSMark Brown 			     struct snd_ctl_elem_value *ucontrol)
210afd6d36aSMark Brown {
211ea53bf77SLars-Peter Clausen 	struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
212afd6d36aSMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
213c1fe81f2SDan Carpenter 	unsigned int deemph = ucontrol->value.integer.value[0];
214afd6d36aSMark Brown 
215afd6d36aSMark Brown 	if (deemph > 1)
216afd6d36aSMark Brown 		return -EINVAL;
217afd6d36aSMark Brown 
218afd6d36aSMark Brown 	wm8960->deemph = deemph;
219afd6d36aSMark Brown 
220afd6d36aSMark Brown 	return wm8960_set_deemph(codec);
221afd6d36aSMark Brown }
222afd6d36aSMark Brown 
2233758ff5fSZidan Wang static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1);
2247e90f9b2SZidan Wang static const DECLARE_TLV_DB_SCALE(inpga_tlv, -1725, 75, 0);
2253758ff5fSZidan Wang static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1);
226f2644a2cSMark Brown static const DECLARE_TLV_DB_SCALE(bypass_tlv, -2100, 300, 0);
227f2644a2cSMark Brown static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1);
2287e90f9b2SZidan Wang static const DECLARE_TLV_DB_SCALE(lineinboost_tlv, -1500, 300, 1);
229b269cebfSTakashi Sakamoto static const SNDRV_CTL_TLVD_DECLARE_DB_RANGE(micboost_tlv,
2307e90f9b2SZidan Wang 	0, 1, TLV_DB_SCALE_ITEM(0, 1300, 0),
2317e90f9b2SZidan Wang 	2, 3, TLV_DB_SCALE_ITEM(2000, 900, 0),
232b269cebfSTakashi Sakamoto );
233f2644a2cSMark Brown 
234f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_snd_controls[] = {
235f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Capture Volume", WM8960_LINVOL, WM8960_RINVOL,
2367e90f9b2SZidan Wang 		 0, 63, 0, inpga_tlv),
237f2644a2cSMark Brown SOC_DOUBLE_R("Capture Volume ZC Switch", WM8960_LINVOL, WM8960_RINVOL,
238f2644a2cSMark Brown 	6, 1, 0),
239f2644a2cSMark Brown SOC_DOUBLE_R("Capture Switch", WM8960_LINVOL, WM8960_RINVOL,
24041a59caeSJongHo Kim 	7, 1, 1),
241f2644a2cSMark Brown 
24221eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT3 Volume",
24395826a37SStuart Henderson 	       WM8960_INBMIX1, 4, 7, 0, lineinboost_tlv),
24421eb2693SMark Brown SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT2 Volume",
24595826a37SStuart Henderson 	       WM8960_INBMIX1, 1, 7, 0, lineinboost_tlv),
24695826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT3 Volume",
24795826a37SStuart Henderson 	       WM8960_INBMIX2, 4, 7, 0, lineinboost_tlv),
24895826a37SStuart Henderson SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT2 Volume",
2497e90f9b2SZidan Wang 	       WM8960_INBMIX2, 1, 7, 0, lineinboost_tlv),
2507e90f9b2SZidan Wang SOC_SINGLE_TLV("Right Input Boost Mixer RINPUT1 Volume",
2518524bb0cSZidan Wang 		WM8960_RINPATH, 4, 3, 0, micboost_tlv),
2527e90f9b2SZidan Wang SOC_SINGLE_TLV("Left Input Boost Mixer LINPUT1 Volume",
2538524bb0cSZidan Wang 		WM8960_LINPATH, 4, 3, 0, micboost_tlv),
25421eb2693SMark Brown 
255f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Playback Volume", WM8960_LDAC, WM8960_RDAC,
256f2644a2cSMark Brown 		 0, 255, 0, dac_tlv),
257f2644a2cSMark Brown 
258f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Headphone Playback Volume", WM8960_LOUT1, WM8960_ROUT1,
259f2644a2cSMark Brown 		 0, 127, 0, out_tlv),
260f2644a2cSMark Brown SOC_DOUBLE_R("Headphone Playback ZC Switch", WM8960_LOUT1, WM8960_ROUT1,
261f2644a2cSMark Brown 	7, 1, 0),
262f2644a2cSMark Brown 
263f2644a2cSMark Brown SOC_DOUBLE_R_TLV("Speaker Playback Volume", WM8960_LOUT2, WM8960_ROUT2,
264f2644a2cSMark Brown 		 0, 127, 0, out_tlv),
265f2644a2cSMark Brown SOC_DOUBLE_R("Speaker Playback ZC Switch", WM8960_LOUT2, WM8960_ROUT2,
266f2644a2cSMark Brown 	7, 1, 0),
267f2644a2cSMark Brown SOC_SINGLE("Speaker DC Volume", WM8960_CLASSD3, 3, 5, 0),
268f2644a2cSMark Brown SOC_SINGLE("Speaker AC Volume", WM8960_CLASSD3, 0, 5, 0),
269f2644a2cSMark Brown 
270f2644a2cSMark Brown SOC_SINGLE("PCM Playback -6dB Switch", WM8960_DACCTL1, 7, 1, 0),
2714faaa8d9SMark Brown SOC_ENUM("ADC Polarity", wm8960_enum[0]),
272f2644a2cSMark Brown SOC_SINGLE("ADC High Pass Filter Switch", WM8960_DACCTL1, 0, 1, 0),
273f2644a2cSMark Brown 
274a077e81eSZidan Wang SOC_ENUM("DAC Polarity", wm8960_enum[1]),
275afd6d36aSMark Brown SOC_SINGLE_BOOL_EXT("DAC Deemphasis Switch", 0,
276afd6d36aSMark Brown 		    wm8960_get_deemph, wm8960_put_deemph),
277f2644a2cSMark Brown 
2784faaa8d9SMark Brown SOC_ENUM("3D Filter Upper Cut-Off", wm8960_enum[2]),
2794faaa8d9SMark Brown SOC_ENUM("3D Filter Lower Cut-Off", wm8960_enum[3]),
280f2644a2cSMark Brown SOC_SINGLE("3D Volume", WM8960_3D, 1, 15, 0),
281f2644a2cSMark Brown SOC_SINGLE("3D Switch", WM8960_3D, 0, 1, 0),
282f2644a2cSMark Brown 
2834faaa8d9SMark Brown SOC_ENUM("ALC Function", wm8960_enum[4]),
284f2644a2cSMark Brown SOC_SINGLE("ALC Max Gain", WM8960_ALC1, 4, 7, 0),
285f2644a2cSMark Brown SOC_SINGLE("ALC Target", WM8960_ALC1, 0, 15, 1),
286f2644a2cSMark Brown SOC_SINGLE("ALC Min Gain", WM8960_ALC2, 4, 7, 0),
287f2644a2cSMark Brown SOC_SINGLE("ALC Hold Time", WM8960_ALC2, 0, 15, 0),
2884faaa8d9SMark Brown SOC_ENUM("ALC Mode", wm8960_enum[5]),
289f2644a2cSMark Brown SOC_SINGLE("ALC Decay", WM8960_ALC3, 4, 15, 0),
290f2644a2cSMark Brown SOC_SINGLE("ALC Attack", WM8960_ALC3, 0, 15, 0),
291f2644a2cSMark Brown 
292f2644a2cSMark Brown SOC_SINGLE("Noise Gate Threshold", WM8960_NOISEG, 3, 31, 0),
293f2644a2cSMark Brown SOC_SINGLE("Noise Gate Switch", WM8960_NOISEG, 0, 1, 0),
294f2644a2cSMark Brown 
295c324aac0SMa Haijun SOC_DOUBLE_R_TLV("ADC PCM Capture Volume", WM8960_LADC, WM8960_RADC,
296c324aac0SMa Haijun 	0, 255, 0, adc_tlv),
297f2644a2cSMark Brown 
298f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer Boost Bypass Volume",
299f2644a2cSMark Brown 	       WM8960_BYPASS1, 4, 7, 1, bypass_tlv),
300f2644a2cSMark Brown SOC_SINGLE_TLV("Left Output Mixer LINPUT3 Volume",
301f2644a2cSMark Brown 	       WM8960_LOUTMIX, 4, 7, 1, bypass_tlv),
302f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer Boost Bypass Volume",
303f2644a2cSMark Brown 	       WM8960_BYPASS2, 4, 7, 1, bypass_tlv),
304f2644a2cSMark Brown SOC_SINGLE_TLV("Right Output Mixer RINPUT3 Volume",
305f2644a2cSMark Brown 	       WM8960_ROUTMIX, 4, 7, 1, bypass_tlv),
3064a5893cfSZidan Wang 
3074a5893cfSZidan Wang SOC_ENUM("ADC Data Output Select", wm8960_enum[6]),
308defbf708SZidan Wang SOC_ENUM("DAC Mono Mix", wm8960_enum[7]),
309f2644a2cSMark Brown };
310f2644a2cSMark Brown 
311f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin_boost[] = {
312f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT2 Switch", WM8960_LINPATH, 6, 1, 0),
313f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LINPATH, 7, 1, 0),
314f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT1 Switch", WM8960_LINPATH, 8, 1, 0),
315f2644a2cSMark Brown };
316f2644a2cSMark Brown 
317f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_lin[] = {
318f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_LINPATH, 3, 1, 0),
319f2644a2cSMark Brown };
320f2644a2cSMark Brown 
321f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin_boost[] = {
322f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT2 Switch", WM8960_RINPATH, 6, 1, 0),
323f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_RINPATH, 7, 1, 0),
324f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT1 Switch", WM8960_RINPATH, 8, 1, 0),
325f2644a2cSMark Brown };
326f2644a2cSMark Brown 
327f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_rin[] = {
328f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Switch", WM8960_RINPATH, 3, 1, 0),
329f2644a2cSMark Brown };
330f2644a2cSMark Brown 
331f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_loutput_mixer[] = {
332f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_LOUTMIX, 8, 1, 0),
333f2644a2cSMark Brown SOC_DAPM_SINGLE("LINPUT3 Switch", WM8960_LOUTMIX, 7, 1, 0),
334f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS1, 7, 1, 0),
335f2644a2cSMark Brown };
336f2644a2cSMark Brown 
337f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_routput_mixer[] = {
338f2644a2cSMark Brown SOC_DAPM_SINGLE("PCM Playback Switch", WM8960_ROUTMIX, 8, 1, 0),
339f2644a2cSMark Brown SOC_DAPM_SINGLE("RINPUT3 Switch", WM8960_ROUTMIX, 7, 1, 0),
340f2644a2cSMark Brown SOC_DAPM_SINGLE("Boost Bypass Switch", WM8960_BYPASS2, 7, 1, 0),
341f2644a2cSMark Brown };
342f2644a2cSMark Brown 
343f2644a2cSMark Brown static const struct snd_kcontrol_new wm8960_mono_out[] = {
344f2644a2cSMark Brown SOC_DAPM_SINGLE("Left Switch", WM8960_MONOMIX1, 7, 1, 0),
345f2644a2cSMark Brown SOC_DAPM_SINGLE("Right Switch", WM8960_MONOMIX2, 7, 1, 0),
346f2644a2cSMark Brown };
347f2644a2cSMark Brown 
348f2644a2cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets[] = {
349f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT1"),
350f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT1"),
351f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT2"),
352f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT2"),
353f2644a2cSMark Brown SND_SOC_DAPM_INPUT("LINPUT3"),
354f2644a2cSMark Brown SND_SOC_DAPM_INPUT("RINPUT3"),
355f2644a2cSMark Brown 
356187774cbSMark Brown SND_SOC_DAPM_SUPPLY("MICB", WM8960_POWER1, 1, 0, NULL, 0),
357f2644a2cSMark Brown 
358f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Boost Mixer", WM8960_POWER1, 5, 0,
359f2644a2cSMark Brown 		   wm8960_lin_boost, ARRAY_SIZE(wm8960_lin_boost)),
360f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Boost Mixer", WM8960_POWER1, 4, 0,
361f2644a2cSMark Brown 		   wm8960_rin_boost, ARRAY_SIZE(wm8960_rin_boost)),
362f2644a2cSMark Brown 
363f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Input Mixer", WM8960_POWER3, 5, 0,
364f2644a2cSMark Brown 		   wm8960_lin, ARRAY_SIZE(wm8960_lin)),
365f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Input Mixer", WM8960_POWER3, 4, 0,
366f2644a2cSMark Brown 		   wm8960_rin, ARRAY_SIZE(wm8960_rin)),
367f2644a2cSMark Brown 
36844426de4SMark Brown SND_SOC_DAPM_ADC("Left ADC", "Capture", WM8960_POWER1, 3, 0),
36944426de4SMark Brown SND_SOC_DAPM_ADC("Right ADC", "Capture", WM8960_POWER1, 2, 0),
370f2644a2cSMark Brown 
371f2644a2cSMark Brown SND_SOC_DAPM_DAC("Left DAC", "Playback", WM8960_POWER2, 8, 0),
372f2644a2cSMark Brown SND_SOC_DAPM_DAC("Right DAC", "Playback", WM8960_POWER2, 7, 0),
373f2644a2cSMark Brown 
374f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Left Output Mixer", WM8960_POWER3, 3, 0,
375f2644a2cSMark Brown 	&wm8960_loutput_mixer[0],
376f2644a2cSMark Brown 	ARRAY_SIZE(wm8960_loutput_mixer)),
377f2644a2cSMark Brown SND_SOC_DAPM_MIXER("Right Output Mixer", WM8960_POWER3, 2, 0,
378f2644a2cSMark Brown 	&wm8960_routput_mixer[0],
379f2644a2cSMark Brown 	ARRAY_SIZE(wm8960_routput_mixer)),
380f2644a2cSMark Brown 
381f2644a2cSMark Brown SND_SOC_DAPM_PGA("LOUT1 PGA", WM8960_POWER2, 6, 0, NULL, 0),
382f2644a2cSMark Brown SND_SOC_DAPM_PGA("ROUT1 PGA", WM8960_POWER2, 5, 0, NULL, 0),
383f2644a2cSMark Brown 
384f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker PGA", WM8960_POWER2, 4, 0, NULL, 0),
385f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker PGA", WM8960_POWER2, 3, 0, NULL, 0),
386f2644a2cSMark Brown 
387f2644a2cSMark Brown SND_SOC_DAPM_PGA("Right Speaker Output", WM8960_CLASSD1, 7, 0, NULL, 0),
388f2644a2cSMark Brown SND_SOC_DAPM_PGA("Left Speaker Output", WM8960_CLASSD1, 6, 0, NULL, 0),
389f2644a2cSMark Brown 
390f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LP"),
391f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_LN"),
392f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_L"),
393f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("HP_R"),
394f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RP"),
395f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("SPK_RN"),
396f2644a2cSMark Brown SND_SOC_DAPM_OUTPUT("OUT3"),
397f2644a2cSMark Brown };
398f2644a2cSMark Brown 
399913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_out3[] = {
400913d7b4cSMark Brown SND_SOC_DAPM_MIXER("Mono Output Mixer", WM8960_POWER2, 1, 0,
401913d7b4cSMark Brown 	&wm8960_mono_out[0],
402913d7b4cSMark Brown 	ARRAY_SIZE(wm8960_mono_out)),
403913d7b4cSMark Brown };
404913d7b4cSMark Brown 
405913d7b4cSMark Brown /* Represent OUT3 as a PGA so that it gets turned on with LOUT1/ROUT1 */
406913d7b4cSMark Brown static const struct snd_soc_dapm_widget wm8960_dapm_widgets_capless[] = {
407913d7b4cSMark Brown SND_SOC_DAPM_PGA("OUT3 VMID", WM8960_POWER2, 1, 0, NULL, 0),
408913d7b4cSMark Brown };
409913d7b4cSMark Brown 
410f2644a2cSMark Brown static const struct snd_soc_dapm_route audio_paths[] = {
411f2644a2cSMark Brown 	{ "Left Boost Mixer", "LINPUT1 Switch", "LINPUT1" },
412f2644a2cSMark Brown 	{ "Left Boost Mixer", "LINPUT2 Switch", "LINPUT2" },
413f2644a2cSMark Brown 	{ "Left Boost Mixer", "LINPUT3 Switch", "LINPUT3" },
414f2644a2cSMark Brown 
4152d4a3260SZidan Wang 	{ "Left Input Mixer", "Boost Switch", "Left Boost Mixer" },
4162d4a3260SZidan Wang 	{ "Left Input Mixer", "Boost Switch", "LINPUT1" },  /* Really Boost Switch */
417f2644a2cSMark Brown 	{ "Left Input Mixer", NULL, "LINPUT2" },
418f2644a2cSMark Brown 	{ "Left Input Mixer", NULL, "LINPUT3" },
419f2644a2cSMark Brown 
420f2644a2cSMark Brown 	{ "Right Boost Mixer", "RINPUT1 Switch", "RINPUT1" },
421f2644a2cSMark Brown 	{ "Right Boost Mixer", "RINPUT2 Switch", "RINPUT2" },
422f2644a2cSMark Brown 	{ "Right Boost Mixer", "RINPUT3 Switch", "RINPUT3" },
423f2644a2cSMark Brown 
4242d4a3260SZidan Wang 	{ "Right Input Mixer", "Boost Switch", "Right Boost Mixer" },
4252d4a3260SZidan Wang 	{ "Right Input Mixer", "Boost Switch", "RINPUT1" },  /* Really Boost Switch */
426f2644a2cSMark Brown 	{ "Right Input Mixer", NULL, "RINPUT2" },
42785e36a1fSZidan Wang 	{ "Right Input Mixer", NULL, "RINPUT3" },
428f2644a2cSMark Brown 
429f2644a2cSMark Brown 	{ "Left ADC", NULL, "Left Input Mixer" },
430f2644a2cSMark Brown 	{ "Right ADC", NULL, "Right Input Mixer" },
431f2644a2cSMark Brown 
432f2644a2cSMark Brown 	{ "Left Output Mixer", "LINPUT3 Switch", "LINPUT3" },
433f2644a2cSMark Brown 	{ "Left Output Mixer", "Boost Bypass Switch", "Left Boost Mixer" },
434f2644a2cSMark Brown 	{ "Left Output Mixer", "PCM Playback Switch", "Left DAC" },
435f2644a2cSMark Brown 
436f2644a2cSMark Brown 	{ "Right Output Mixer", "RINPUT3 Switch", "RINPUT3" },
437f2644a2cSMark Brown 	{ "Right Output Mixer", "Boost Bypass Switch", "Right Boost Mixer" },
438f2644a2cSMark Brown 	{ "Right Output Mixer", "PCM Playback Switch", "Right DAC" },
439f2644a2cSMark Brown 
440f2644a2cSMark Brown 	{ "LOUT1 PGA", NULL, "Left Output Mixer" },
441f2644a2cSMark Brown 	{ "ROUT1 PGA", NULL, "Right Output Mixer" },
442f2644a2cSMark Brown 
443f2644a2cSMark Brown 	{ "HP_L", NULL, "LOUT1 PGA" },
444f2644a2cSMark Brown 	{ "HP_R", NULL, "ROUT1 PGA" },
445f2644a2cSMark Brown 
446f2644a2cSMark Brown 	{ "Left Speaker PGA", NULL, "Left Output Mixer" },
447f2644a2cSMark Brown 	{ "Right Speaker PGA", NULL, "Right Output Mixer" },
448f2644a2cSMark Brown 
449f2644a2cSMark Brown 	{ "Left Speaker Output", NULL, "Left Speaker PGA" },
450f2644a2cSMark Brown 	{ "Right Speaker Output", NULL, "Right Speaker PGA" },
451f2644a2cSMark Brown 
452f2644a2cSMark Brown 	{ "SPK_LN", NULL, "Left Speaker Output" },
453f2644a2cSMark Brown 	{ "SPK_LP", NULL, "Left Speaker Output" },
454f2644a2cSMark Brown 	{ "SPK_RN", NULL, "Right Speaker Output" },
455f2644a2cSMark Brown 	{ "SPK_RP", NULL, "Right Speaker Output" },
456913d7b4cSMark Brown };
457913d7b4cSMark Brown 
458913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_out3[] = {
459913d7b4cSMark Brown 	{ "Mono Output Mixer", "Left Switch", "Left Output Mixer" },
460913d7b4cSMark Brown 	{ "Mono Output Mixer", "Right Switch", "Right Output Mixer" },
461f2644a2cSMark Brown 
462f2644a2cSMark Brown 	{ "OUT3", NULL, "Mono Output Mixer", }
463f2644a2cSMark Brown };
464f2644a2cSMark Brown 
465913d7b4cSMark Brown static const struct snd_soc_dapm_route audio_paths_capless[] = {
466913d7b4cSMark Brown 	{ "HP_L", NULL, "OUT3 VMID" },
467913d7b4cSMark Brown 	{ "HP_R", NULL, "OUT3 VMID" },
468913d7b4cSMark Brown 
469913d7b4cSMark Brown 	{ "OUT3 VMID", NULL, "Left Output Mixer" },
470913d7b4cSMark Brown 	{ "OUT3 VMID", NULL, "Right Output Mixer" },
471913d7b4cSMark Brown };
472913d7b4cSMark Brown 
473f2644a2cSMark Brown static int wm8960_add_widgets(struct snd_soc_codec *codec)
474f2644a2cSMark Brown {
475b2c812e2SMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
476e2280c90SZidan Wang 	struct wm8960_data *pdata = &wm8960->pdata;
47793f32f53SLars-Peter Clausen 	struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
478913d7b4cSMark Brown 	struct snd_soc_dapm_widget *w;
479913d7b4cSMark Brown 
480ce6120ccSLiam Girdwood 	snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets,
481f2644a2cSMark Brown 				  ARRAY_SIZE(wm8960_dapm_widgets));
482f2644a2cSMark Brown 
483ce6120ccSLiam Girdwood 	snd_soc_dapm_add_routes(dapm, audio_paths, ARRAY_SIZE(audio_paths));
484f2644a2cSMark Brown 
485913d7b4cSMark Brown 	/* In capless mode OUT3 is used to provide VMID for the
486913d7b4cSMark Brown 	 * headphone outputs, otherwise it is used as a mono mixer.
487913d7b4cSMark Brown 	 */
488913d7b4cSMark Brown 	if (pdata && pdata->capless) {
489ce6120ccSLiam Girdwood 		snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_capless,
490913d7b4cSMark Brown 					  ARRAY_SIZE(wm8960_dapm_widgets_capless));
491913d7b4cSMark Brown 
492ce6120ccSLiam Girdwood 		snd_soc_dapm_add_routes(dapm, audio_paths_capless,
493913d7b4cSMark Brown 					ARRAY_SIZE(audio_paths_capless));
494913d7b4cSMark Brown 	} else {
495ce6120ccSLiam Girdwood 		snd_soc_dapm_new_controls(dapm, wm8960_dapm_widgets_out3,
496913d7b4cSMark Brown 					  ARRAY_SIZE(wm8960_dapm_widgets_out3));
497913d7b4cSMark Brown 
498ce6120ccSLiam Girdwood 		snd_soc_dapm_add_routes(dapm, audio_paths_out3,
499913d7b4cSMark Brown 					ARRAY_SIZE(audio_paths_out3));
500913d7b4cSMark Brown 	}
501913d7b4cSMark Brown 
502913d7b4cSMark Brown 	/* We need to power up the headphone output stage out of
503913d7b4cSMark Brown 	 * sequence for capless mode.  To save scanning the widget
504913d7b4cSMark Brown 	 * list each time to find the desired power state do so now
505913d7b4cSMark Brown 	 * and save the result.
506913d7b4cSMark Brown 	 */
50700200107SLars-Peter Clausen 	list_for_each_entry(w, &codec->component.card->widgets, list) {
50893f32f53SLars-Peter Clausen 		if (w->dapm != dapm)
50997c866deSJarkko Nikula 			continue;
510913d7b4cSMark Brown 		if (strcmp(w->name, "LOUT1 PGA") == 0)
511913d7b4cSMark Brown 			wm8960->lout1 = w;
512913d7b4cSMark Brown 		if (strcmp(w->name, "ROUT1 PGA") == 0)
513913d7b4cSMark Brown 			wm8960->rout1 = w;
514913d7b4cSMark Brown 		if (strcmp(w->name, "OUT3 VMID") == 0)
515913d7b4cSMark Brown 			wm8960->out3 = w;
516913d7b4cSMark Brown 	}
517913d7b4cSMark Brown 
518f2644a2cSMark Brown 	return 0;
519f2644a2cSMark Brown }
520f2644a2cSMark Brown 
521f2644a2cSMark Brown static int wm8960_set_dai_fmt(struct snd_soc_dai *codec_dai,
522f2644a2cSMark Brown 		unsigned int fmt)
523f2644a2cSMark Brown {
524f2644a2cSMark Brown 	struct snd_soc_codec *codec = codec_dai->codec;
525f2644a2cSMark Brown 	u16 iface = 0;
526f2644a2cSMark Brown 
527f2644a2cSMark Brown 	/* set master/slave audio interface */
528f2644a2cSMark Brown 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
529f2644a2cSMark Brown 	case SND_SOC_DAIFMT_CBM_CFM:
530f2644a2cSMark Brown 		iface |= 0x0040;
531f2644a2cSMark Brown 		break;
532f2644a2cSMark Brown 	case SND_SOC_DAIFMT_CBS_CFS:
533f2644a2cSMark Brown 		break;
534f2644a2cSMark Brown 	default:
535f2644a2cSMark Brown 		return -EINVAL;
536f2644a2cSMark Brown 	}
537f2644a2cSMark Brown 
538f2644a2cSMark Brown 	/* interface format */
539f2644a2cSMark Brown 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
540f2644a2cSMark Brown 	case SND_SOC_DAIFMT_I2S:
541f2644a2cSMark Brown 		iface |= 0x0002;
542f2644a2cSMark Brown 		break;
543f2644a2cSMark Brown 	case SND_SOC_DAIFMT_RIGHT_J:
544f2644a2cSMark Brown 		break;
545f2644a2cSMark Brown 	case SND_SOC_DAIFMT_LEFT_J:
546f2644a2cSMark Brown 		iface |= 0x0001;
547f2644a2cSMark Brown 		break;
548f2644a2cSMark Brown 	case SND_SOC_DAIFMT_DSP_A:
549f2644a2cSMark Brown 		iface |= 0x0003;
550f2644a2cSMark Brown 		break;
551f2644a2cSMark Brown 	case SND_SOC_DAIFMT_DSP_B:
552f2644a2cSMark Brown 		iface |= 0x0013;
553f2644a2cSMark Brown 		break;
554f2644a2cSMark Brown 	default:
555f2644a2cSMark Brown 		return -EINVAL;
556f2644a2cSMark Brown 	}
557f2644a2cSMark Brown 
558f2644a2cSMark Brown 	/* clock inversion */
559f2644a2cSMark Brown 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
560f2644a2cSMark Brown 	case SND_SOC_DAIFMT_NB_NF:
561f2644a2cSMark Brown 		break;
562f2644a2cSMark Brown 	case SND_SOC_DAIFMT_IB_IF:
563f2644a2cSMark Brown 		iface |= 0x0090;
564f2644a2cSMark Brown 		break;
565f2644a2cSMark Brown 	case SND_SOC_DAIFMT_IB_NF:
566f2644a2cSMark Brown 		iface |= 0x0080;
567f2644a2cSMark Brown 		break;
568f2644a2cSMark Brown 	case SND_SOC_DAIFMT_NB_IF:
569f2644a2cSMark Brown 		iface |= 0x0010;
570f2644a2cSMark Brown 		break;
571f2644a2cSMark Brown 	default:
572f2644a2cSMark Brown 		return -EINVAL;
573f2644a2cSMark Brown 	}
574f2644a2cSMark Brown 
575f2644a2cSMark Brown 	/* set iface */
57617a52fd6SMark Brown 	snd_soc_write(codec, WM8960_IFACE1, iface);
577f2644a2cSMark Brown 	return 0;
578f2644a2cSMark Brown }
579f2644a2cSMark Brown 
580db059c0fSMark Brown static struct {
581db059c0fSMark Brown 	int rate;
582db059c0fSMark Brown 	unsigned int val;
583db059c0fSMark Brown } alc_rates[] = {
584db059c0fSMark Brown 	{ 48000, 0 },
585db059c0fSMark Brown 	{ 44100, 0 },
586db059c0fSMark Brown 	{ 32000, 1 },
587db059c0fSMark Brown 	{ 22050, 2 },
588db059c0fSMark Brown 	{ 24000, 2 },
589db059c0fSMark Brown 	{ 16000, 3 },
59022ee76daSZidan Wang 	{ 11025, 4 },
591db059c0fSMark Brown 	{ 12000, 4 },
592db059c0fSMark Brown 	{  8000, 5 },
593db059c0fSMark Brown };
594db059c0fSMark Brown 
5953176bf2dSZidan Wang /* -1 for reserved value */
5963176bf2dSZidan Wang static const int sysclk_divs[] = { 1, -1, 2, -1 };
5973176bf2dSZidan Wang 
5980e50b51aSZidan Wang /* Multiply 256 for internal 256 div */
5990e50b51aSZidan Wang static const int dac_divs[] = { 256, 384, 512, 768, 1024, 1408, 1536 };
6000e50b51aSZidan Wang 
6010e50b51aSZidan Wang /* Multiply 10 to eliminate decimials */
6020e50b51aSZidan Wang static const int bclk_divs[] = {
6030e50b51aSZidan Wang 	10, 15, 20, 30, 40, 55, 60, 80, 110,
6040e50b51aSZidan Wang 	120, 160, 220, 240, 320, 320, 320
6050e50b51aSZidan Wang };
6060e50b51aSZidan Wang 
6073ddc9721SDaniel Baluta /**
6083ddc9721SDaniel Baluta  * wm8960_configure_sysclk - checks if there is a sysclk frequency available
6093ddc9721SDaniel Baluta  *	The sysclk must be chosen such that:
6103ddc9721SDaniel Baluta  *		- sysclk     = MCLK / sysclk_divs
6113ddc9721SDaniel Baluta  *		- lrclk      = sysclk / dac_divs
6123ddc9721SDaniel Baluta  *		- 10 * bclk  = sysclk / bclk_divs
6133ddc9721SDaniel Baluta  *
6143c01b9eeSDaniel Baluta  *	If we cannot find an exact match for (sysclk, lrclk, bclk)
6153c01b9eeSDaniel Baluta  *	triplet, we relax the bclk such that bclk is chosen as the
6163c01b9eeSDaniel Baluta  *	closest available frequency greater than expected bclk.
6173c01b9eeSDaniel Baluta  *
6183ddc9721SDaniel Baluta  * @wm8960_priv: wm8960 codec private data
6193ddc9721SDaniel Baluta  * @mclk: MCLK used to derive sysclk
6203ddc9721SDaniel Baluta  * @sysclk_idx: sysclk_divs index for found sysclk
6213ddc9721SDaniel Baluta  * @dac_idx: dac_divs index for found lrclk
6223ddc9721SDaniel Baluta  * @bclk_idx: bclk_divs index for found bclk
6233ddc9721SDaniel Baluta  *
6243ddc9721SDaniel Baluta  * Returns:
6253ddc9721SDaniel Baluta  *  -1, in case no sysclk frequency available found
6263c01b9eeSDaniel Baluta  * >=0, in case we could derive bclk and lrclk from sysclk using
6273c01b9eeSDaniel Baluta  *      (@sysclk_idx, @dac_idx, @bclk_idx) dividers
6283ddc9721SDaniel Baluta  */
6293ddc9721SDaniel Baluta static
6303ddc9721SDaniel Baluta int wm8960_configure_sysclk(struct wm8960_priv *wm8960, int mclk,
6313ddc9721SDaniel Baluta 			    int *sysclk_idx, int *dac_idx, int *bclk_idx)
6323ddc9721SDaniel Baluta {
6333ddc9721SDaniel Baluta 	int sysclk, bclk, lrclk;
6343ddc9721SDaniel Baluta 	int i, j, k;
6353c01b9eeSDaniel Baluta 	int diff, closest = mclk;
6363c01b9eeSDaniel Baluta 
6373c01b9eeSDaniel Baluta 	/* marker for no match */
6383c01b9eeSDaniel Baluta 	*bclk_idx = -1;
6393ddc9721SDaniel Baluta 
6403ddc9721SDaniel Baluta 	bclk = wm8960->bclk;
6413ddc9721SDaniel Baluta 	lrclk = wm8960->lrclk;
6423ddc9721SDaniel Baluta 
6433ddc9721SDaniel Baluta 	/* check if the sysclk frequency is available. */
6443ddc9721SDaniel Baluta 	for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) {
6453ddc9721SDaniel Baluta 		if (sysclk_divs[i] == -1)
6463ddc9721SDaniel Baluta 			continue;
6473ddc9721SDaniel Baluta 		sysclk = mclk / sysclk_divs[i];
6483ddc9721SDaniel Baluta 		for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) {
6493ddc9721SDaniel Baluta 			if (sysclk != dac_divs[j] * lrclk)
6503ddc9721SDaniel Baluta 				continue;
6513ddc9721SDaniel Baluta 			for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) {
6523ddc9721SDaniel Baluta 				diff = sysclk - bclk * bclk_divs[k] / 10;
6533ddc9721SDaniel Baluta 				if (diff == 0) {
6543ddc9721SDaniel Baluta 					*sysclk_idx = i;
6553ddc9721SDaniel Baluta 					*dac_idx = j;
6563ddc9721SDaniel Baluta 					*bclk_idx = k;
6573ddc9721SDaniel Baluta 					break;
6583ddc9721SDaniel Baluta 				}
6593c01b9eeSDaniel Baluta 				if (diff > 0 && closest > diff) {
6603c01b9eeSDaniel Baluta 					*sysclk_idx = i;
6613c01b9eeSDaniel Baluta 					*dac_idx = j;
6623c01b9eeSDaniel Baluta 					*bclk_idx = k;
6633c01b9eeSDaniel Baluta 					closest = diff;
6643c01b9eeSDaniel Baluta 				}
6653ddc9721SDaniel Baluta 			}
6663ddc9721SDaniel Baluta 			if (k != ARRAY_SIZE(bclk_divs))
6673ddc9721SDaniel Baluta 				break;
6683ddc9721SDaniel Baluta 		}
6693ddc9721SDaniel Baluta 		if (j != ARRAY_SIZE(dac_divs))
6703ddc9721SDaniel Baluta 			break;
6713ddc9721SDaniel Baluta 	}
6723c01b9eeSDaniel Baluta 	return *bclk_idx;
6733ddc9721SDaniel Baluta }
6743ddc9721SDaniel Baluta 
6753176bf2dSZidan Wang static int wm8960_configure_clocking(struct snd_soc_codec *codec)
6760e50b51aSZidan Wang {
6770e50b51aSZidan Wang 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
6783176bf2dSZidan Wang 	int sysclk, bclk, lrclk, freq_out, freq_in;
6790e50b51aSZidan Wang 	u16 iface1 = snd_soc_read(codec, WM8960_IFACE1);
6803176bf2dSZidan Wang 	int i, j, k;
6813ddc9721SDaniel Baluta 	int ret;
6820e50b51aSZidan Wang 
6830e50b51aSZidan Wang 	if (!(iface1 & (1<<6))) {
6840e50b51aSZidan Wang 		dev_dbg(codec->dev,
6850e50b51aSZidan Wang 			"Codec is slave mode, no need to configure clock\n");
6863176bf2dSZidan Wang 		return 0;
6870e50b51aSZidan Wang 	}
6880e50b51aSZidan Wang 
6893176bf2dSZidan Wang 	if (wm8960->clk_id != WM8960_SYSCLK_MCLK && !wm8960->freq_in) {
6903176bf2dSZidan Wang 		dev_err(codec->dev, "No MCLK configured\n");
6913176bf2dSZidan Wang 		return -EINVAL;
6920e50b51aSZidan Wang 	}
6930e50b51aSZidan Wang 
6943176bf2dSZidan Wang 	freq_in = wm8960->freq_in;
6953176bf2dSZidan Wang 	bclk = wm8960->bclk;
6963176bf2dSZidan Wang 	lrclk = wm8960->lrclk;
6970e50b51aSZidan Wang 	/*
6983176bf2dSZidan Wang 	 * If it's sysclk auto mode, check if the MCLK can provide sysclk or
6993176bf2dSZidan Wang 	 * not. If MCLK can provide sysclk, using MCLK to provide sysclk
7003176bf2dSZidan Wang 	 * directly. Otherwise, auto select a available pll out frequency
7013176bf2dSZidan Wang 	 * and set PLL.
7020e50b51aSZidan Wang 	 */
7033176bf2dSZidan Wang 	if (wm8960->clk_id == WM8960_SYSCLK_AUTO) {
7043176bf2dSZidan Wang 		/* disable the PLL and using MCLK to provide sysclk */
7053176bf2dSZidan Wang 		wm8960_set_pll(codec, 0, 0);
7063176bf2dSZidan Wang 		freq_out = freq_in;
7073176bf2dSZidan Wang 	} else if (wm8960->sysclk) {
7083176bf2dSZidan Wang 		freq_out = wm8960->sysclk;
7093176bf2dSZidan Wang 	} else {
7103176bf2dSZidan Wang 		dev_err(codec->dev, "No SYSCLK configured\n");
7113176bf2dSZidan Wang 		return -EINVAL;
7123176bf2dSZidan Wang 	}
7133176bf2dSZidan Wang 
7146bb74514SStuart Henderson 	if (wm8960->clk_id != WM8960_SYSCLK_PLL) {
7153ddc9721SDaniel Baluta 		ret = wm8960_configure_sysclk(wm8960, freq_out, &i, &j, &k);
7163c01b9eeSDaniel Baluta 		if (ret >= 0) {
7173176bf2dSZidan Wang 			goto configure_clock;
7183176bf2dSZidan Wang 		} else if (wm8960->clk_id != WM8960_SYSCLK_AUTO) {
7193176bf2dSZidan Wang 			dev_err(codec->dev, "failed to configure clock\n");
7203176bf2dSZidan Wang 			return -EINVAL;
7213176bf2dSZidan Wang 		}
7226bb74514SStuart Henderson 	}
7233176bf2dSZidan Wang 	/* get a available pll out frequency and set pll */
7243176bf2dSZidan Wang 	for (i = 0; i < ARRAY_SIZE(sysclk_divs); ++i) {
7253176bf2dSZidan Wang 		if (sysclk_divs[i] == -1)
7263176bf2dSZidan Wang 			continue;
7273176bf2dSZidan Wang 		for (j = 0; j < ARRAY_SIZE(dac_divs); ++j) {
7283176bf2dSZidan Wang 			sysclk = lrclk * dac_divs[j];
7293176bf2dSZidan Wang 			freq_out = sysclk * sysclk_divs[i];
7303176bf2dSZidan Wang 
7313176bf2dSZidan Wang 			for (k = 0; k < ARRAY_SIZE(bclk_divs); ++k) {
7323176bf2dSZidan Wang 				if (sysclk == bclk * bclk_divs[k] / 10 &&
7333176bf2dSZidan Wang 				    is_pll_freq_available(freq_in, freq_out)) {
7343176bf2dSZidan Wang 					wm8960_set_pll(codec,
7353176bf2dSZidan Wang 						       freq_in, freq_out);
7363176bf2dSZidan Wang 					break;
7373176bf2dSZidan Wang 				} else {
7383176bf2dSZidan Wang 					continue;
7393176bf2dSZidan Wang 				}
7403176bf2dSZidan Wang 			}
7413176bf2dSZidan Wang 			if (k != ARRAY_SIZE(bclk_divs))
7423176bf2dSZidan Wang 				break;
7433176bf2dSZidan Wang 		}
7443176bf2dSZidan Wang 		if (j != ARRAY_SIZE(dac_divs))
7453176bf2dSZidan Wang 			break;
7463176bf2dSZidan Wang 	}
7473176bf2dSZidan Wang 
7483176bf2dSZidan Wang 	if (i == ARRAY_SIZE(sysclk_divs)) {
7493176bf2dSZidan Wang 		dev_err(codec->dev, "failed to configure clock\n");
7503176bf2dSZidan Wang 		return -EINVAL;
7513176bf2dSZidan Wang 	}
7523176bf2dSZidan Wang 
7533176bf2dSZidan Wang configure_clock:
7543176bf2dSZidan Wang 	/* configure sysclk clock */
7553176bf2dSZidan Wang 	snd_soc_update_bits(codec, WM8960_CLOCK1, 3 << 1, i << 1);
7563176bf2dSZidan Wang 
7573176bf2dSZidan Wang 	/* configure frame clock */
7583176bf2dSZidan Wang 	snd_soc_update_bits(codec, WM8960_CLOCK1, 0x7 << 3, j << 3);
7593176bf2dSZidan Wang 	snd_soc_update_bits(codec, WM8960_CLOCK1, 0x7 << 6, j << 6);
7600e50b51aSZidan Wang 
7610e50b51aSZidan Wang 	/* configure bit clock */
7623176bf2dSZidan Wang 	snd_soc_update_bits(codec, WM8960_CLOCK2, 0xf, k);
7633176bf2dSZidan Wang 
7643176bf2dSZidan Wang 	return 0;
7650e50b51aSZidan Wang }
7660e50b51aSZidan Wang 
767f2644a2cSMark Brown static int wm8960_hw_params(struct snd_pcm_substream *substream,
768f2644a2cSMark Brown 			    struct snd_pcm_hw_params *params,
769f2644a2cSMark Brown 			    struct snd_soc_dai *dai)
770f2644a2cSMark Brown {
771e6968a17SMark Brown 	struct snd_soc_codec *codec = dai->codec;
772afd6d36aSMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
77317a52fd6SMark Brown 	u16 iface = snd_soc_read(codec, WM8960_IFACE1) & 0xfff3;
7740e50b51aSZidan Wang 	bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
775db059c0fSMark Brown 	int i;
776f2644a2cSMark Brown 
7770e50b51aSZidan Wang 	wm8960->bclk = snd_soc_params_to_bclk(params);
7780e50b51aSZidan Wang 	if (params_channels(params) == 1)
7790e50b51aSZidan Wang 		wm8960->bclk *= 2;
7800e50b51aSZidan Wang 
781f2644a2cSMark Brown 	/* bit size */
78239e9cc46SMark Brown 	switch (params_width(params)) {
78339e9cc46SMark Brown 	case 16:
784f2644a2cSMark Brown 		break;
78539e9cc46SMark Brown 	case 20:
786f2644a2cSMark Brown 		iface |= 0x0004;
787f2644a2cSMark Brown 		break;
78839e9cc46SMark Brown 	case 24:
789f2644a2cSMark Brown 		iface |= 0x0008;
790f2644a2cSMark Brown 		break;
7917a8c7867SZidan Wang 	case 32:
7927a8c7867SZidan Wang 		/* right justify mode does not support 32 word length */
7937a8c7867SZidan Wang 		if ((iface & 0x3) != 0) {
7947a8c7867SZidan Wang 			iface |= 0x000c;
7957a8c7867SZidan Wang 			break;
7967a8c7867SZidan Wang 		}
7974c2474c0STimur Tabi 	default:
79839e9cc46SMark Brown 		dev_err(codec->dev, "unsupported width %d\n",
79939e9cc46SMark Brown 			params_width(params));
8004c2474c0STimur Tabi 		return -EINVAL;
801f2644a2cSMark Brown 	}
802f2644a2cSMark Brown 
8033176bf2dSZidan Wang 	wm8960->lrclk = params_rate(params);
804afd6d36aSMark Brown 	/* Update filters for the new rate */
8053176bf2dSZidan Wang 	if (tx) {
806afd6d36aSMark Brown 		wm8960_set_deemph(codec);
807db059c0fSMark Brown 	} else {
808db059c0fSMark Brown 		for (i = 0; i < ARRAY_SIZE(alc_rates); i++)
809db059c0fSMark Brown 			if (alc_rates[i].rate == params_rate(params))
810db059c0fSMark Brown 				snd_soc_update_bits(codec,
811db059c0fSMark Brown 						    WM8960_ADDCTL3, 0x7,
812db059c0fSMark Brown 						    alc_rates[i].val);
813afd6d36aSMark Brown 	}
814afd6d36aSMark Brown 
815f2644a2cSMark Brown 	/* set iface */
81617a52fd6SMark Brown 	snd_soc_write(codec, WM8960_IFACE1, iface);
8170e50b51aSZidan Wang 
8183176bf2dSZidan Wang 	wm8960->is_stream_in_use[tx] = true;
8193176bf2dSZidan Wang 
8203176bf2dSZidan Wang 	if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_ON &&
8213176bf2dSZidan Wang 	    !wm8960->is_stream_in_use[!tx])
8223176bf2dSZidan Wang 		return wm8960_configure_clocking(codec);
8233176bf2dSZidan Wang 
8243176bf2dSZidan Wang 	return 0;
8253176bf2dSZidan Wang }
8263176bf2dSZidan Wang 
8273176bf2dSZidan Wang static int wm8960_hw_free(struct snd_pcm_substream *substream,
8283176bf2dSZidan Wang 		struct snd_soc_dai *dai)
8293176bf2dSZidan Wang {
8303176bf2dSZidan Wang 	struct snd_soc_codec *codec = dai->codec;
8313176bf2dSZidan Wang 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
8323176bf2dSZidan Wang 	bool tx = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
8333176bf2dSZidan Wang 
8343176bf2dSZidan Wang 	wm8960->is_stream_in_use[tx] = false;
8350e50b51aSZidan Wang 
836f2644a2cSMark Brown 	return 0;
837f2644a2cSMark Brown }
838f2644a2cSMark Brown 
839f2644a2cSMark Brown static int wm8960_mute(struct snd_soc_dai *dai, int mute)
840f2644a2cSMark Brown {
841f2644a2cSMark Brown 	struct snd_soc_codec *codec = dai->codec;
842f2644a2cSMark Brown 
843f2644a2cSMark Brown 	if (mute)
84416b24881SAxel Lin 		snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0x8);
845f2644a2cSMark Brown 	else
84616b24881SAxel Lin 		snd_soc_update_bits(codec, WM8960_DACCTL1, 0x8, 0);
847f2644a2cSMark Brown 	return 0;
848f2644a2cSMark Brown }
849f2644a2cSMark Brown 
850913d7b4cSMark Brown static int wm8960_set_bias_level_out3(struct snd_soc_codec *codec,
851f2644a2cSMark Brown 				      enum snd_soc_bias_level level)
852f2644a2cSMark Brown {
8530ebe36c6SMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
8543176bf2dSZidan Wang 	u16 pm2 = snd_soc_read(codec, WM8960_POWER2);
85575aa8868SZidan Wang 	int ret;
8560ebe36c6SMark Brown 
857f2644a2cSMark Brown 	switch (level) {
858f2644a2cSMark Brown 	case SND_SOC_BIAS_ON:
859f2644a2cSMark Brown 		break;
860f2644a2cSMark Brown 
861f2644a2cSMark Brown 	case SND_SOC_BIAS_PREPARE:
86293f32f53SLars-Peter Clausen 		switch (snd_soc_codec_get_bias_level(codec)) {
86375aa8868SZidan Wang 		case SND_SOC_BIAS_STANDBY:
86475aa8868SZidan Wang 			if (!IS_ERR(wm8960->mclk)) {
86575aa8868SZidan Wang 				ret = clk_prepare_enable(wm8960->mclk);
86675aa8868SZidan Wang 				if (ret) {
86775aa8868SZidan Wang 					dev_err(codec->dev,
86875aa8868SZidan Wang 						"Failed to enable MCLK: %d\n",
86975aa8868SZidan Wang 						ret);
87075aa8868SZidan Wang 					return ret;
87175aa8868SZidan Wang 				}
87275aa8868SZidan Wang 			}
87375aa8868SZidan Wang 
8743176bf2dSZidan Wang 			ret = wm8960_configure_clocking(codec);
8753176bf2dSZidan Wang 			if (ret)
8763176bf2dSZidan Wang 				return ret;
8773176bf2dSZidan Wang 
878f2644a2cSMark Brown 			/* Set VMID to 2x50k */
87916b24881SAxel Lin 			snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x80);
880f2644a2cSMark Brown 			break;
881f2644a2cSMark Brown 
88275aa8868SZidan Wang 		case SND_SOC_BIAS_ON:
8833176bf2dSZidan Wang 			/*
8843176bf2dSZidan Wang 			 * If it's sysclk auto mode, and the pll is enabled,
8853176bf2dSZidan Wang 			 * disable the pll
8863176bf2dSZidan Wang 			 */
8873176bf2dSZidan Wang 			if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1))
8883176bf2dSZidan Wang 				wm8960_set_pll(codec, 0, 0);
8893176bf2dSZidan Wang 
89075aa8868SZidan Wang 			if (!IS_ERR(wm8960->mclk))
89175aa8868SZidan Wang 				clk_disable_unprepare(wm8960->mclk);
89275aa8868SZidan Wang 			break;
89375aa8868SZidan Wang 
89475aa8868SZidan Wang 		default:
89575aa8868SZidan Wang 			break;
89675aa8868SZidan Wang 		}
89775aa8868SZidan Wang 
89875aa8868SZidan Wang 		break;
89975aa8868SZidan Wang 
900f2644a2cSMark Brown 	case SND_SOC_BIAS_STANDBY:
90193f32f53SLars-Peter Clausen 		if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF) {
9020ebe36c6SMark Brown 			regcache_sync(wm8960->regmap);
903bc45df2dSAxel Lin 
904f2644a2cSMark Brown 			/* Enable anti-pop features */
90517a52fd6SMark Brown 			snd_soc_write(codec, WM8960_APOP1,
906f2644a2cSMark Brown 				      WM8960_POBCTRL | WM8960_SOFT_ST |
907f2644a2cSMark Brown 				      WM8960_BUFDCOPEN | WM8960_BUFIOEN);
908f2644a2cSMark Brown 
909f2644a2cSMark Brown 			/* Enable & ramp VMID at 2x50k */
91016b24881SAxel Lin 			snd_soc_update_bits(codec, WM8960_POWER1, 0x80, 0x80);
911f2644a2cSMark Brown 			msleep(100);
912f2644a2cSMark Brown 
913f2644a2cSMark Brown 			/* Enable VREF */
91416b24881SAxel Lin 			snd_soc_update_bits(codec, WM8960_POWER1, WM8960_VREF,
91516b24881SAxel Lin 					    WM8960_VREF);
916f2644a2cSMark Brown 
917f2644a2cSMark Brown 			/* Disable anti-pop features */
91817a52fd6SMark Brown 			snd_soc_write(codec, WM8960_APOP1, WM8960_BUFIOEN);
919f2644a2cSMark Brown 		}
920f2644a2cSMark Brown 
921f2644a2cSMark Brown 		/* Set VMID to 2x250k */
92216b24881SAxel Lin 		snd_soc_update_bits(codec, WM8960_POWER1, 0x180, 0x100);
923f2644a2cSMark Brown 		break;
924f2644a2cSMark Brown 
925f2644a2cSMark Brown 	case SND_SOC_BIAS_OFF:
926f2644a2cSMark Brown 		/* Enable anti-pop features */
92717a52fd6SMark Brown 		snd_soc_write(codec, WM8960_APOP1,
928f2644a2cSMark Brown 			     WM8960_POBCTRL | WM8960_SOFT_ST |
929f2644a2cSMark Brown 			     WM8960_BUFDCOPEN | WM8960_BUFIOEN);
930f2644a2cSMark Brown 
931f2644a2cSMark Brown 		/* Disable VMID and VREF, let them discharge */
93217a52fd6SMark Brown 		snd_soc_write(codec, WM8960_POWER1, 0);
933f2644a2cSMark Brown 		msleep(600);
934913d7b4cSMark Brown 		break;
935913d7b4cSMark Brown 	}
936f2644a2cSMark Brown 
937913d7b4cSMark Brown 	return 0;
938913d7b4cSMark Brown }
939913d7b4cSMark Brown 
940913d7b4cSMark Brown static int wm8960_set_bias_level_capless(struct snd_soc_codec *codec,
941913d7b4cSMark Brown 					 enum snd_soc_bias_level level)
942913d7b4cSMark Brown {
943b2c812e2SMark Brown 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
9443176bf2dSZidan Wang 	u16 pm2 = snd_soc_read(codec, WM8960_POWER2);
94575aa8868SZidan Wang 	int reg, ret;
946913d7b4cSMark Brown 
947913d7b4cSMark Brown 	switch (level) {
948913d7b4cSMark Brown 	case SND_SOC_BIAS_ON:
949913d7b4cSMark Brown 		break;
950913d7b4cSMark Brown 
951913d7b4cSMark Brown 	case SND_SOC_BIAS_PREPARE:
95293f32f53SLars-Peter Clausen 		switch (snd_soc_codec_get_bias_level(codec)) {
953913d7b4cSMark Brown 		case SND_SOC_BIAS_STANDBY:
954913d7b4cSMark Brown 			/* Enable anti pop mode */
955913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_APOP1,
956913d7b4cSMark Brown 					    WM8960_POBCTRL | WM8960_SOFT_ST |
957913d7b4cSMark Brown 					    WM8960_BUFDCOPEN,
958913d7b4cSMark Brown 					    WM8960_POBCTRL | WM8960_SOFT_ST |
959913d7b4cSMark Brown 					    WM8960_BUFDCOPEN);
960913d7b4cSMark Brown 
961913d7b4cSMark Brown 			/* Enable LOUT1, ROUT1 and OUT3 if they're enabled */
962913d7b4cSMark Brown 			reg = 0;
963913d7b4cSMark Brown 			if (wm8960->lout1 && wm8960->lout1->power)
964913d7b4cSMark Brown 				reg |= WM8960_PWR2_LOUT1;
965913d7b4cSMark Brown 			if (wm8960->rout1 && wm8960->rout1->power)
966913d7b4cSMark Brown 				reg |= WM8960_PWR2_ROUT1;
967913d7b4cSMark Brown 			if (wm8960->out3 && wm8960->out3->power)
968913d7b4cSMark Brown 				reg |= WM8960_PWR2_OUT3;
969913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_POWER2,
970913d7b4cSMark Brown 					    WM8960_PWR2_LOUT1 |
971913d7b4cSMark Brown 					    WM8960_PWR2_ROUT1 |
972913d7b4cSMark Brown 					    WM8960_PWR2_OUT3, reg);
973913d7b4cSMark Brown 
974913d7b4cSMark Brown 			/* Enable VMID at 2*50k */
975913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_POWER1,
976913d7b4cSMark Brown 					    WM8960_VMID_MASK, 0x80);
977913d7b4cSMark Brown 
978913d7b4cSMark Brown 			/* Ramp */
979913d7b4cSMark Brown 			msleep(100);
980913d7b4cSMark Brown 
981913d7b4cSMark Brown 			/* Enable VREF */
982913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_POWER1,
983913d7b4cSMark Brown 					    WM8960_VREF, WM8960_VREF);
984913d7b4cSMark Brown 
985913d7b4cSMark Brown 			msleep(100);
98675aa8868SZidan Wang 
98775aa8868SZidan Wang 			if (!IS_ERR(wm8960->mclk)) {
98875aa8868SZidan Wang 				ret = clk_prepare_enable(wm8960->mclk);
98975aa8868SZidan Wang 				if (ret) {
99075aa8868SZidan Wang 					dev_err(codec->dev,
99175aa8868SZidan Wang 						"Failed to enable MCLK: %d\n",
99275aa8868SZidan Wang 						ret);
99375aa8868SZidan Wang 					return ret;
99475aa8868SZidan Wang 				}
99575aa8868SZidan Wang 			}
9963176bf2dSZidan Wang 
9973176bf2dSZidan Wang 			ret = wm8960_configure_clocking(codec);
9983176bf2dSZidan Wang 			if (ret)
9993176bf2dSZidan Wang 				return ret;
10003176bf2dSZidan Wang 
1001913d7b4cSMark Brown 			break;
1002913d7b4cSMark Brown 
1003913d7b4cSMark Brown 		case SND_SOC_BIAS_ON:
10043176bf2dSZidan Wang 			/*
10053176bf2dSZidan Wang 			 * If it's sysclk auto mode, and the pll is enabled,
10063176bf2dSZidan Wang 			 * disable the pll
10073176bf2dSZidan Wang 			 */
10083176bf2dSZidan Wang 			if (wm8960->clk_id == WM8960_SYSCLK_AUTO && (pm2 & 0x1))
10093176bf2dSZidan Wang 				wm8960_set_pll(codec, 0, 0);
10103176bf2dSZidan Wang 
101175aa8868SZidan Wang 			if (!IS_ERR(wm8960->mclk))
101275aa8868SZidan Wang 				clk_disable_unprepare(wm8960->mclk);
101375aa8868SZidan Wang 
1014913d7b4cSMark Brown 			/* Enable anti-pop mode */
1015913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_APOP1,
1016913d7b4cSMark Brown 					    WM8960_POBCTRL | WM8960_SOFT_ST |
1017913d7b4cSMark Brown 					    WM8960_BUFDCOPEN,
1018913d7b4cSMark Brown 					    WM8960_POBCTRL | WM8960_SOFT_ST |
1019913d7b4cSMark Brown 					    WM8960_BUFDCOPEN);
1020913d7b4cSMark Brown 
1021913d7b4cSMark Brown 			/* Disable VMID and VREF */
1022913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_POWER1,
1023913d7b4cSMark Brown 					    WM8960_VREF | WM8960_VMID_MASK, 0);
1024913d7b4cSMark Brown 			break;
1025913d7b4cSMark Brown 
1026bc45df2dSAxel Lin 		case SND_SOC_BIAS_OFF:
10270ebe36c6SMark Brown 			regcache_sync(wm8960->regmap);
1028bc45df2dSAxel Lin 			break;
1029913d7b4cSMark Brown 		default:
1030913d7b4cSMark Brown 			break;
1031913d7b4cSMark Brown 		}
1032913d7b4cSMark Brown 		break;
1033913d7b4cSMark Brown 
1034913d7b4cSMark Brown 	case SND_SOC_BIAS_STANDBY:
103593f32f53SLars-Peter Clausen 		switch (snd_soc_codec_get_bias_level(codec)) {
1036913d7b4cSMark Brown 		case SND_SOC_BIAS_PREPARE:
1037913d7b4cSMark Brown 			/* Disable HP discharge */
1038913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_APOP2,
1039913d7b4cSMark Brown 					    WM8960_DISOP | WM8960_DRES_MASK,
1040913d7b4cSMark Brown 					    0);
1041913d7b4cSMark Brown 
1042913d7b4cSMark Brown 			/* Disable anti-pop features */
1043913d7b4cSMark Brown 			snd_soc_update_bits(codec, WM8960_APOP1,
1044913d7b4cSMark Brown 					    WM8960_POBCTRL | WM8960_SOFT_ST |
1045913d7b4cSMark Brown 					    WM8960_BUFDCOPEN,
1046913d7b4cSMark Brown 					    WM8960_POBCTRL | WM8960_SOFT_ST |
1047913d7b4cSMark Brown 					    WM8960_BUFDCOPEN);
1048913d7b4cSMark Brown 			break;
1049913d7b4cSMark Brown 
1050913d7b4cSMark Brown 		default:
1051913d7b4cSMark Brown 			break;
1052913d7b4cSMark Brown 		}
1053913d7b4cSMark Brown 		break;
1054913d7b4cSMark Brown 
1055913d7b4cSMark Brown 	case SND_SOC_BIAS_OFF:
1056f2644a2cSMark Brown 		break;
1057f2644a2cSMark Brown 	}
1058f2644a2cSMark Brown 
1059f2644a2cSMark Brown 	return 0;
1060f2644a2cSMark Brown }
1061f2644a2cSMark Brown 
1062f2644a2cSMark Brown /* PLL divisors */
1063f2644a2cSMark Brown struct _pll_div {
1064f2644a2cSMark Brown 	u32 pre_div:1;
1065f2644a2cSMark Brown 	u32 n:4;
1066f2644a2cSMark Brown 	u32 k:24;
1067f2644a2cSMark Brown };
1068f2644a2cSMark Brown 
10693176bf2dSZidan Wang static bool is_pll_freq_available(unsigned int source, unsigned int target)
10703176bf2dSZidan Wang {
10713176bf2dSZidan Wang 	unsigned int Ndiv;
10723176bf2dSZidan Wang 
10733176bf2dSZidan Wang 	if (source == 0 || target == 0)
10743176bf2dSZidan Wang 		return false;
10753176bf2dSZidan Wang 
10763176bf2dSZidan Wang 	/* Scale up target to PLL operating frequency */
10773176bf2dSZidan Wang 	target *= 4;
10783176bf2dSZidan Wang 	Ndiv = target / source;
10793176bf2dSZidan Wang 
10803176bf2dSZidan Wang 	if (Ndiv < 6) {
10813176bf2dSZidan Wang 		source >>= 1;
10823176bf2dSZidan Wang 		Ndiv = target / source;
10833176bf2dSZidan Wang 	}
10843176bf2dSZidan Wang 
10853176bf2dSZidan Wang 	if ((Ndiv < 6) || (Ndiv > 12))
10863176bf2dSZidan Wang 		return false;
10873176bf2dSZidan Wang 
10883176bf2dSZidan Wang 	return true;
10893176bf2dSZidan Wang }
10903176bf2dSZidan Wang 
1091f2644a2cSMark Brown /* The size in bits of the pll divide multiplied by 10
1092f2644a2cSMark Brown  * to allow rounding later */
1093f2644a2cSMark Brown #define FIXED_PLL_SIZE ((1 << 24) * 10)
1094f2644a2cSMark Brown 
1095f2644a2cSMark Brown static int pll_factors(unsigned int source, unsigned int target,
1096f2644a2cSMark Brown 		       struct _pll_div *pll_div)
1097f2644a2cSMark Brown {
1098f2644a2cSMark Brown 	unsigned long long Kpart;
1099f2644a2cSMark Brown 	unsigned int K, Ndiv, Nmod;
1100f2644a2cSMark Brown 
1101f2644a2cSMark Brown 	pr_debug("WM8960 PLL: setting %dHz->%dHz\n", source, target);
1102f2644a2cSMark Brown 
1103f2644a2cSMark Brown 	/* Scale up target to PLL operating frequency */
1104f2644a2cSMark Brown 	target *= 4;
1105f2644a2cSMark Brown 
1106f2644a2cSMark Brown 	Ndiv = target / source;
1107f2644a2cSMark Brown 	if (Ndiv < 6) {
1108f2644a2cSMark Brown 		source >>= 1;
1109f2644a2cSMark Brown 		pll_div->pre_div = 1;
1110f2644a2cSMark Brown 		Ndiv = target / source;
1111f2644a2cSMark Brown 	} else
1112f2644a2cSMark Brown 		pll_div->pre_div = 0;
1113f2644a2cSMark Brown 
1114f2644a2cSMark Brown 	if ((Ndiv < 6) || (Ndiv > 12)) {
1115f2644a2cSMark Brown 		pr_err("WM8960 PLL: Unsupported N=%d\n", Ndiv);
1116f2644a2cSMark Brown 		return -EINVAL;
1117f2644a2cSMark Brown 	}
1118f2644a2cSMark Brown 
1119f2644a2cSMark Brown 	pll_div->n = Ndiv;
1120f2644a2cSMark Brown 	Nmod = target % source;
1121f2644a2cSMark Brown 	Kpart = FIXED_PLL_SIZE * (long long)Nmod;
1122f2644a2cSMark Brown 
1123f2644a2cSMark Brown 	do_div(Kpart, source);
1124f2644a2cSMark Brown 
1125f2644a2cSMark Brown 	K = Kpart & 0xFFFFFFFF;
1126f2644a2cSMark Brown 
1127f2644a2cSMark Brown 	/* Check if we need to round */
1128f2644a2cSMark Brown 	if ((K % 10) >= 5)
1129f2644a2cSMark Brown 		K += 5;
1130f2644a2cSMark Brown 
1131f2644a2cSMark Brown 	/* Move down to proper range now rounding is done */
1132f2644a2cSMark Brown 	K /= 10;
1133f2644a2cSMark Brown 
1134f2644a2cSMark Brown 	pll_div->k = K;
1135f2644a2cSMark Brown 
1136f2644a2cSMark Brown 	pr_debug("WM8960 PLL: N=%x K=%x pre_div=%d\n",
1137f2644a2cSMark Brown 		 pll_div->n, pll_div->k, pll_div->pre_div);
1138f2644a2cSMark Brown 
1139f2644a2cSMark Brown 	return 0;
1140f2644a2cSMark Brown }
1141f2644a2cSMark Brown 
11423176bf2dSZidan Wang static int wm8960_set_pll(struct snd_soc_codec *codec,
11433176bf2dSZidan Wang 		unsigned int freq_in, unsigned int freq_out)
1144f2644a2cSMark Brown {
1145f2644a2cSMark Brown 	u16 reg;
1146f2644a2cSMark Brown 	static struct _pll_div pll_div;
1147f2644a2cSMark Brown 	int ret;
1148f2644a2cSMark Brown 
1149f2644a2cSMark Brown 	if (freq_in && freq_out) {
1150f2644a2cSMark Brown 		ret = pll_factors(freq_in, freq_out, &pll_div);
1151f2644a2cSMark Brown 		if (ret != 0)
1152f2644a2cSMark Brown 			return ret;
1153f2644a2cSMark Brown 	}
1154f2644a2cSMark Brown 
1155f2644a2cSMark Brown 	/* Disable the PLL: even if we are changing the frequency the
1156f2644a2cSMark Brown 	 * PLL needs to be disabled while we do so. */
115716b24881SAxel Lin 	snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0);
115816b24881SAxel Lin 	snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0);
1159f2644a2cSMark Brown 
1160f2644a2cSMark Brown 	if (!freq_in || !freq_out)
1161f2644a2cSMark Brown 		return 0;
1162f2644a2cSMark Brown 
116317a52fd6SMark Brown 	reg = snd_soc_read(codec, WM8960_PLL1) & ~0x3f;
1164f2644a2cSMark Brown 	reg |= pll_div.pre_div << 4;
1165f2644a2cSMark Brown 	reg |= pll_div.n;
1166f2644a2cSMark Brown 
1167f2644a2cSMark Brown 	if (pll_div.k) {
1168f2644a2cSMark Brown 		reg |= 0x20;
1169f2644a2cSMark Brown 
117085fa532bSMike Dyer 		snd_soc_write(codec, WM8960_PLL2, (pll_div.k >> 16) & 0xff);
117185fa532bSMike Dyer 		snd_soc_write(codec, WM8960_PLL3, (pll_div.k >> 8) & 0xff);
117285fa532bSMike Dyer 		snd_soc_write(codec, WM8960_PLL4, pll_div.k & 0xff);
1173f2644a2cSMark Brown 	}
117417a52fd6SMark Brown 	snd_soc_write(codec, WM8960_PLL1, reg);
1175f2644a2cSMark Brown 
1176f2644a2cSMark Brown 	/* Turn it on */
117716b24881SAxel Lin 	snd_soc_update_bits(codec, WM8960_POWER2, 0x1, 0x1);
1178f2644a2cSMark Brown 	msleep(250);
117916b24881SAxel Lin 	snd_soc_update_bits(codec, WM8960_CLOCK1, 0x1, 0x1);
1180f2644a2cSMark Brown 
1181f2644a2cSMark Brown 	return 0;
1182f2644a2cSMark Brown }
1183f2644a2cSMark Brown 
11843176bf2dSZidan Wang static int wm8960_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
11853176bf2dSZidan Wang 		int source, unsigned int freq_in, unsigned int freq_out)
11863176bf2dSZidan Wang {
11873176bf2dSZidan Wang 	struct snd_soc_codec *codec = codec_dai->codec;
11883176bf2dSZidan Wang 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
11893176bf2dSZidan Wang 
11903176bf2dSZidan Wang 	wm8960->freq_in = freq_in;
11913176bf2dSZidan Wang 
11923176bf2dSZidan Wang 	if (pll_id == WM8960_SYSCLK_AUTO)
11933176bf2dSZidan Wang 		return 0;
11943176bf2dSZidan Wang 
11953176bf2dSZidan Wang 	return wm8960_set_pll(codec, freq_in, freq_out);
11963176bf2dSZidan Wang }
11973176bf2dSZidan Wang 
1198f2644a2cSMark Brown static int wm8960_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
1199f2644a2cSMark Brown 		int div_id, int div)
1200f2644a2cSMark Brown {
1201f2644a2cSMark Brown 	struct snd_soc_codec *codec = codec_dai->codec;
1202f2644a2cSMark Brown 	u16 reg;
1203f2644a2cSMark Brown 
1204f2644a2cSMark Brown 	switch (div_id) {
1205f2644a2cSMark Brown 	case WM8960_SYSCLKDIV:
120617a52fd6SMark Brown 		reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1f9;
120717a52fd6SMark Brown 		snd_soc_write(codec, WM8960_CLOCK1, reg | div);
1208f2644a2cSMark Brown 		break;
1209f2644a2cSMark Brown 	case WM8960_DACDIV:
121017a52fd6SMark Brown 		reg = snd_soc_read(codec, WM8960_CLOCK1) & 0x1c7;
121117a52fd6SMark Brown 		snd_soc_write(codec, WM8960_CLOCK1, reg | div);
1212f2644a2cSMark Brown 		break;
1213f2644a2cSMark Brown 	case WM8960_OPCLKDIV:
121417a52fd6SMark Brown 		reg = snd_soc_read(codec, WM8960_PLL1) & 0x03f;
121517a52fd6SMark Brown 		snd_soc_write(codec, WM8960_PLL1, reg | div);
1216f2644a2cSMark Brown 		break;
1217f2644a2cSMark Brown 	case WM8960_DCLKDIV:
121817a52fd6SMark Brown 		reg = snd_soc_read(codec, WM8960_CLOCK2) & 0x03f;
121917a52fd6SMark Brown 		snd_soc_write(codec, WM8960_CLOCK2, reg | div);
1220f2644a2cSMark Brown 		break;
1221f2644a2cSMark Brown 	case WM8960_TOCLKSEL:
122217a52fd6SMark Brown 		reg = snd_soc_read(codec, WM8960_ADDCTL1) & 0x1fd;
122317a52fd6SMark Brown 		snd_soc_write(codec, WM8960_ADDCTL1, reg | div);
1224f2644a2cSMark Brown 		break;
1225f2644a2cSMark Brown 	default:
1226f2644a2cSMark Brown 		return -EINVAL;
1227f2644a2cSMark Brown 	}
1228f2644a2cSMark Brown 
1229f2644a2cSMark Brown 	return 0;
1230f2644a2cSMark Brown }
1231f2644a2cSMark Brown 
1232f0fba2adSLiam Girdwood static int wm8960_set_bias_level(struct snd_soc_codec *codec,
1233f0fba2adSLiam Girdwood 				 enum snd_soc_bias_level level)
1234f0fba2adSLiam Girdwood {
1235f0fba2adSLiam Girdwood 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
1236f0fba2adSLiam Girdwood 
1237f0fba2adSLiam Girdwood 	return wm8960->set_bias_level(codec, level);
1238f0fba2adSLiam Girdwood }
1239f0fba2adSLiam Girdwood 
12400e50b51aSZidan Wang static int wm8960_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id,
12410e50b51aSZidan Wang 					unsigned int freq, int dir)
12420e50b51aSZidan Wang {
12430e50b51aSZidan Wang 	struct snd_soc_codec *codec = dai->codec;
12440e50b51aSZidan Wang 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
12450e50b51aSZidan Wang 
12460e50b51aSZidan Wang 	switch (clk_id) {
12470e50b51aSZidan Wang 	case WM8960_SYSCLK_MCLK:
12480e50b51aSZidan Wang 		snd_soc_update_bits(codec, WM8960_CLOCK1,
12490e50b51aSZidan Wang 					0x1, WM8960_SYSCLK_MCLK);
12500e50b51aSZidan Wang 		break;
12510e50b51aSZidan Wang 	case WM8960_SYSCLK_PLL:
12520e50b51aSZidan Wang 		snd_soc_update_bits(codec, WM8960_CLOCK1,
12530e50b51aSZidan Wang 					0x1, WM8960_SYSCLK_PLL);
12540e50b51aSZidan Wang 		break;
12553176bf2dSZidan Wang 	case WM8960_SYSCLK_AUTO:
12563176bf2dSZidan Wang 		break;
12570e50b51aSZidan Wang 	default:
12580e50b51aSZidan Wang 		return -EINVAL;
12590e50b51aSZidan Wang 	}
12600e50b51aSZidan Wang 
12610e50b51aSZidan Wang 	wm8960->sysclk = freq;
12623176bf2dSZidan Wang 	wm8960->clk_id = clk_id;
12630e50b51aSZidan Wang 
12640e50b51aSZidan Wang 	return 0;
12650e50b51aSZidan Wang }
12660e50b51aSZidan Wang 
1267f2644a2cSMark Brown #define WM8960_RATES SNDRV_PCM_RATE_8000_48000
1268f2644a2cSMark Brown 
1269f2644a2cSMark Brown #define WM8960_FORMATS \
1270f2644a2cSMark Brown 	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
12717a8c7867SZidan Wang 	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
1272f2644a2cSMark Brown 
127385e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops wm8960_dai_ops = {
1274f2644a2cSMark Brown 	.hw_params = wm8960_hw_params,
12753176bf2dSZidan Wang 	.hw_free = wm8960_hw_free,
1276f2644a2cSMark Brown 	.digital_mute = wm8960_mute,
1277f2644a2cSMark Brown 	.set_fmt = wm8960_set_dai_fmt,
1278f2644a2cSMark Brown 	.set_clkdiv = wm8960_set_dai_clkdiv,
1279f2644a2cSMark Brown 	.set_pll = wm8960_set_dai_pll,
12800e50b51aSZidan Wang 	.set_sysclk = wm8960_set_dai_sysclk,
1281f2644a2cSMark Brown };
1282f2644a2cSMark Brown 
1283f0fba2adSLiam Girdwood static struct snd_soc_dai_driver wm8960_dai = {
1284f0fba2adSLiam Girdwood 	.name = "wm8960-hifi",
1285f2644a2cSMark Brown 	.playback = {
1286f2644a2cSMark Brown 		.stream_name = "Playback",
1287f2644a2cSMark Brown 		.channels_min = 1,
1288f2644a2cSMark Brown 		.channels_max = 2,
1289f2644a2cSMark Brown 		.rates = WM8960_RATES,
1290f2644a2cSMark Brown 		.formats = WM8960_FORMATS,},
1291f2644a2cSMark Brown 	.capture = {
1292f2644a2cSMark Brown 		.stream_name = "Capture",
1293f2644a2cSMark Brown 		.channels_min = 1,
1294f2644a2cSMark Brown 		.channels_max = 2,
1295f2644a2cSMark Brown 		.rates = WM8960_RATES,
1296f2644a2cSMark Brown 		.formats = WM8960_FORMATS,},
1297f2644a2cSMark Brown 	.ops = &wm8960_dai_ops,
1298f2644a2cSMark Brown 	.symmetric_rates = 1,
1299f2644a2cSMark Brown };
1300f2644a2cSMark Brown 
1301f0fba2adSLiam Girdwood static int wm8960_probe(struct snd_soc_codec *codec)
1302f2644a2cSMark Brown {
1303f0fba2adSLiam Girdwood 	struct wm8960_priv *wm8960 = snd_soc_codec_get_drvdata(codec);
1304e2280c90SZidan Wang 	struct wm8960_data *pdata = &wm8960->pdata;
1305f2644a2cSMark Brown 
1306913d7b4cSMark Brown 	if (pdata->capless)
1307f0fba2adSLiam Girdwood 		wm8960->set_bias_level = wm8960_set_bias_level_capless;
1308e2280c90SZidan Wang 	else
1309e2280c90SZidan Wang 		wm8960->set_bias_level = wm8960_set_bias_level_out3;
1310f2644a2cSMark Brown 
1311022658beSLiam Girdwood 	snd_soc_add_codec_controls(codec, wm8960_snd_controls,
1312f0fba2adSLiam Girdwood 				     ARRAY_SIZE(wm8960_snd_controls));
1313f0fba2adSLiam Girdwood 	wm8960_add_widgets(codec);
1314f2644a2cSMark Brown 
1315f2644a2cSMark Brown 	return 0;
1316f2644a2cSMark Brown }
1317f2644a2cSMark Brown 
1318f802d6c0SJulia Lawall static const struct snd_soc_codec_driver soc_codec_dev_wm8960 = {
1319f0fba2adSLiam Girdwood 	.probe =	wm8960_probe,
1320f0fba2adSLiam Girdwood 	.set_bias_level = wm8960_set_bias_level,
13210a87a6e1SLars-Peter Clausen 	.suspend_bias_off = true,
13220ebe36c6SMark Brown };
13230ebe36c6SMark Brown 
13240ebe36c6SMark Brown static const struct regmap_config wm8960_regmap = {
13250ebe36c6SMark Brown 	.reg_bits = 7,
13260ebe36c6SMark Brown 	.val_bits = 9,
13270ebe36c6SMark Brown 	.max_register = WM8960_PLL4,
13280ebe36c6SMark Brown 
13290ebe36c6SMark Brown 	.reg_defaults = wm8960_reg_defaults,
13300ebe36c6SMark Brown 	.num_reg_defaults = ARRAY_SIZE(wm8960_reg_defaults),
13310ebe36c6SMark Brown 	.cache_type = REGCACHE_RBTREE,
13320ebe36c6SMark Brown 
13330ebe36c6SMark Brown 	.volatile_reg = wm8960_volatile,
1334f0fba2adSLiam Girdwood };
1335f0fba2adSLiam Girdwood 
1336e2280c90SZidan Wang static void wm8960_set_pdata_from_of(struct i2c_client *i2c,
1337e2280c90SZidan Wang 				struct wm8960_data *pdata)
1338e2280c90SZidan Wang {
1339e2280c90SZidan Wang 	const struct device_node *np = i2c->dev.of_node;
1340e2280c90SZidan Wang 
1341e2280c90SZidan Wang 	if (of_property_read_bool(np, "wlf,capless"))
1342e2280c90SZidan Wang 		pdata->capless = true;
1343e2280c90SZidan Wang 
1344e2280c90SZidan Wang 	if (of_property_read_bool(np, "wlf,shared-lrclk"))
1345e2280c90SZidan Wang 		pdata->shared_lrclk = true;
1346e2280c90SZidan Wang }
1347e2280c90SZidan Wang 
13487a79e94eSBill Pemberton static int wm8960_i2c_probe(struct i2c_client *i2c,
1349f2644a2cSMark Brown 			    const struct i2c_device_id *id)
1350f2644a2cSMark Brown {
135137061631SMark Brown 	struct wm8960_data *pdata = dev_get_platdata(&i2c->dev);
1352f2644a2cSMark Brown 	struct wm8960_priv *wm8960;
1353f0fba2adSLiam Girdwood 	int ret;
1354f2644a2cSMark Brown 
1355b9791c01SMark Brown 	wm8960 = devm_kzalloc(&i2c->dev, sizeof(struct wm8960_priv),
1356b9791c01SMark Brown 			      GFP_KERNEL);
1357f2644a2cSMark Brown 	if (wm8960 == NULL)
1358f2644a2cSMark Brown 		return -ENOMEM;
1359f2644a2cSMark Brown 
136075aa8868SZidan Wang 	wm8960->mclk = devm_clk_get(&i2c->dev, "mclk");
136175aa8868SZidan Wang 	if (IS_ERR(wm8960->mclk)) {
136275aa8868SZidan Wang 		if (PTR_ERR(wm8960->mclk) == -EPROBE_DEFER)
136375aa8868SZidan Wang 			return -EPROBE_DEFER;
136475aa8868SZidan Wang 	}
136575aa8868SZidan Wang 
1366c5e6f5faSSachin Kamat 	wm8960->regmap = devm_regmap_init_i2c(i2c, &wm8960_regmap);
13670ebe36c6SMark Brown 	if (IS_ERR(wm8960->regmap))
13680ebe36c6SMark Brown 		return PTR_ERR(wm8960->regmap);
13690ebe36c6SMark Brown 
1370e2280c90SZidan Wang 	if (pdata)
1371e2280c90SZidan Wang 		memcpy(&wm8960->pdata, pdata, sizeof(struct wm8960_data));
1372e2280c90SZidan Wang 	else if (i2c->dev.of_node)
1373e2280c90SZidan Wang 		wm8960_set_pdata_from_of(i2c, &wm8960->pdata);
1374e2280c90SZidan Wang 
13753ad5e861SZidan Wang 	ret = wm8960_reset(wm8960->regmap);
13763ad5e861SZidan Wang 	if (ret != 0) {
13773ad5e861SZidan Wang 		dev_err(&i2c->dev, "Failed to issue reset\n");
13783ad5e861SZidan Wang 		return ret;
13793ad5e861SZidan Wang 	}
13803ad5e861SZidan Wang 
13813ad5e861SZidan Wang 	if (wm8960->pdata.shared_lrclk) {
138237061631SMark Brown 		ret = regmap_update_bits(wm8960->regmap, WM8960_ADDCTL2,
138337061631SMark Brown 					 0x4, 0x4);
138437061631SMark Brown 		if (ret != 0) {
138537061631SMark Brown 			dev_err(&i2c->dev, "Failed to enable LRCM: %d\n",
138637061631SMark Brown 				ret);
138737061631SMark Brown 			return ret;
138837061631SMark Brown 		}
138937061631SMark Brown 	}
139037061631SMark Brown 
13913ad5e861SZidan Wang 	/* Latch the update bits */
13923ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_LINVOL, 0x100, 0x100);
13933ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_RINVOL, 0x100, 0x100);
13943ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_LADC, 0x100, 0x100);
13953ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_RADC, 0x100, 0x100);
13963ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_LDAC, 0x100, 0x100);
13973ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_RDAC, 0x100, 0x100);
13983ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_LOUT1, 0x100, 0x100);
13993ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_ROUT1, 0x100, 0x100);
14003ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_LOUT2, 0x100, 0x100);
14013ad5e861SZidan Wang 	regmap_update_bits(wm8960->regmap, WM8960_ROUT2, 0x100, 0x100);
14023ad5e861SZidan Wang 
1403f2644a2cSMark Brown 	i2c_set_clientdata(i2c, wm8960);
1404f2644a2cSMark Brown 
1405f0fba2adSLiam Girdwood 	ret = snd_soc_register_codec(&i2c->dev,
1406f0fba2adSLiam Girdwood 			&soc_codec_dev_wm8960, &wm8960_dai, 1);
1407b9791c01SMark Brown 
1408f0fba2adSLiam Girdwood 	return ret;
1409f2644a2cSMark Brown }
1410f2644a2cSMark Brown 
14117a79e94eSBill Pemberton static int wm8960_i2c_remove(struct i2c_client *client)
1412f2644a2cSMark Brown {
1413f0fba2adSLiam Girdwood 	snd_soc_unregister_codec(&client->dev);
1414f2644a2cSMark Brown 	return 0;
1415f2644a2cSMark Brown }
1416f2644a2cSMark Brown 
1417f2644a2cSMark Brown static const struct i2c_device_id wm8960_i2c_id[] = {
1418f2644a2cSMark Brown 	{ "wm8960", 0 },
1419f2644a2cSMark Brown 	{ }
1420f2644a2cSMark Brown };
1421f2644a2cSMark Brown MODULE_DEVICE_TABLE(i2c, wm8960_i2c_id);
1422f2644a2cSMark Brown 
1423e2280c90SZidan Wang static const struct of_device_id wm8960_of_match[] = {
1424e2280c90SZidan Wang        { .compatible = "wlf,wm8960", },
1425e2280c90SZidan Wang        { }
1426e2280c90SZidan Wang };
1427e2280c90SZidan Wang MODULE_DEVICE_TABLE(of, wm8960_of_match);
1428e2280c90SZidan Wang 
1429f2644a2cSMark Brown static struct i2c_driver wm8960_i2c_driver = {
1430f2644a2cSMark Brown 	.driver = {
1431091edccfSMark Brown 		.name = "wm8960",
1432e2280c90SZidan Wang 		.of_match_table = wm8960_of_match,
1433f2644a2cSMark Brown 	},
1434f2644a2cSMark Brown 	.probe =    wm8960_i2c_probe,
14357a79e94eSBill Pemberton 	.remove =   wm8960_i2c_remove,
1436f2644a2cSMark Brown 	.id_table = wm8960_i2c_id,
1437f2644a2cSMark Brown };
1438f2644a2cSMark Brown 
14393c010e60SSachin Kamat module_i2c_driver(wm8960_i2c_driver);
1440f2644a2cSMark Brown 
1441f2644a2cSMark Brown MODULE_DESCRIPTION("ASoC WM8960 driver");
1442f2644a2cSMark Brown MODULE_AUTHOR("Liam Girdwood");
1443f2644a2cSMark Brown MODULE_LICENSE("GPL");
1444