xref: /OK3568_Linux_fs/kernel/sound/soc/codecs/cs35l34.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * cs35l34.c -- CS35l34 ALSA SoC audio driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2016 Cirrus Logic, Inc.
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Author: Paul Handrigan <Paul.Handrigan@cirrus.com>
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/module.h>
11*4882a593Smuzhiyun #include <linux/moduleparam.h>
12*4882a593Smuzhiyun #include <linux/kernel.h>
13*4882a593Smuzhiyun #include <linux/init.h>
14*4882a593Smuzhiyun #include <linux/delay.h>
15*4882a593Smuzhiyun #include <linux/i2c.h>
16*4882a593Smuzhiyun #include <linux/slab.h>
17*4882a593Smuzhiyun #include <linux/workqueue.h>
18*4882a593Smuzhiyun #include <linux/platform_device.h>
19*4882a593Smuzhiyun #include <linux/regulator/consumer.h>
20*4882a593Smuzhiyun #include <linux/regulator/machine.h>
21*4882a593Smuzhiyun #include <linux/pm_runtime.h>
22*4882a593Smuzhiyun #include <linux/of_device.h>
23*4882a593Smuzhiyun #include <linux/of_gpio.h>
24*4882a593Smuzhiyun #include <linux/of_irq.h>
25*4882a593Smuzhiyun #include <sound/core.h>
26*4882a593Smuzhiyun #include <sound/pcm.h>
27*4882a593Smuzhiyun #include <sound/pcm_params.h>
28*4882a593Smuzhiyun #include <sound/soc.h>
29*4882a593Smuzhiyun #include <sound/soc-dapm.h>
30*4882a593Smuzhiyun #include <linux/gpio.h>
31*4882a593Smuzhiyun #include <linux/gpio/consumer.h>
32*4882a593Smuzhiyun #include <sound/initval.h>
33*4882a593Smuzhiyun #include <sound/tlv.h>
34*4882a593Smuzhiyun #include <sound/cs35l34.h>
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #include "cs35l34.h"
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun #define PDN_DONE_ATTEMPTS 10
39*4882a593Smuzhiyun #define CS35L34_START_DELAY 50
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun struct  cs35l34_private {
42*4882a593Smuzhiyun 	struct snd_soc_component *component;
43*4882a593Smuzhiyun 	struct cs35l34_platform_data pdata;
44*4882a593Smuzhiyun 	struct regmap *regmap;
45*4882a593Smuzhiyun 	struct regulator_bulk_data core_supplies[2];
46*4882a593Smuzhiyun 	int num_core_supplies;
47*4882a593Smuzhiyun 	int mclk_int;
48*4882a593Smuzhiyun 	bool tdm_mode;
49*4882a593Smuzhiyun 	struct gpio_desc *reset_gpio;	/* Active-low reset GPIO */
50*4882a593Smuzhiyun };
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun static const struct reg_default cs35l34_reg[] = {
53*4882a593Smuzhiyun 	{CS35L34_PWRCTL1, 0x01},
54*4882a593Smuzhiyun 	{CS35L34_PWRCTL2, 0x19},
55*4882a593Smuzhiyun 	{CS35L34_PWRCTL3, 0x01},
56*4882a593Smuzhiyun 	{CS35L34_ADSP_CLK_CTL, 0x08},
57*4882a593Smuzhiyun 	{CS35L34_MCLK_CTL, 0x11},
58*4882a593Smuzhiyun 	{CS35L34_AMP_INP_DRV_CTL, 0x01},
59*4882a593Smuzhiyun 	{CS35L34_AMP_DIG_VOL_CTL, 0x12},
60*4882a593Smuzhiyun 	{CS35L34_AMP_DIG_VOL, 0x00},
61*4882a593Smuzhiyun 	{CS35L34_AMP_ANLG_GAIN_CTL, 0x0F},
62*4882a593Smuzhiyun 	{CS35L34_PROTECT_CTL, 0x06},
63*4882a593Smuzhiyun 	{CS35L34_AMP_KEEP_ALIVE_CTL, 0x04},
64*4882a593Smuzhiyun 	{CS35L34_BST_CVTR_V_CTL, 0x00},
65*4882a593Smuzhiyun 	{CS35L34_BST_PEAK_I, 0x10},
66*4882a593Smuzhiyun 	{CS35L34_BST_RAMP_CTL, 0x87},
67*4882a593Smuzhiyun 	{CS35L34_BST_CONV_COEF_1, 0x24},
68*4882a593Smuzhiyun 	{CS35L34_BST_CONV_COEF_2, 0x24},
69*4882a593Smuzhiyun 	{CS35L34_BST_CONV_SLOPE_COMP, 0x4E},
70*4882a593Smuzhiyun 	{CS35L34_BST_CONV_SW_FREQ, 0x08},
71*4882a593Smuzhiyun 	{CS35L34_CLASS_H_CTL, 0x0D},
72*4882a593Smuzhiyun 	{CS35L34_CLASS_H_HEADRM_CTL, 0x0D},
73*4882a593Smuzhiyun 	{CS35L34_CLASS_H_RELEASE_RATE, 0x08},
74*4882a593Smuzhiyun 	{CS35L34_CLASS_H_FET_DRIVE_CTL, 0x41},
75*4882a593Smuzhiyun 	{CS35L34_CLASS_H_STATUS, 0x05},
76*4882a593Smuzhiyun 	{CS35L34_VPBR_CTL, 0x0A},
77*4882a593Smuzhiyun 	{CS35L34_VPBR_VOL_CTL, 0x90},
78*4882a593Smuzhiyun 	{CS35L34_VPBR_TIMING_CTL, 0x6A},
79*4882a593Smuzhiyun 	{CS35L34_PRED_MAX_ATTEN_SPK_LOAD, 0x95},
80*4882a593Smuzhiyun 	{CS35L34_PRED_BROWNOUT_THRESH, 0x1C},
81*4882a593Smuzhiyun 	{CS35L34_PRED_BROWNOUT_VOL_CTL, 0x00},
82*4882a593Smuzhiyun 	{CS35L34_PRED_BROWNOUT_RATE_CTL, 0x10},
83*4882a593Smuzhiyun 	{CS35L34_PRED_WAIT_CTL, 0x10},
84*4882a593Smuzhiyun 	{CS35L34_PRED_ZVP_INIT_IMP_CTL, 0x08},
85*4882a593Smuzhiyun 	{CS35L34_PRED_MAN_SAFE_VPI_CTL, 0x80},
86*4882a593Smuzhiyun 	{CS35L34_VPBR_ATTEN_STATUS, 0x00},
87*4882a593Smuzhiyun 	{CS35L34_PRED_BRWNOUT_ATT_STATUS, 0x00},
88*4882a593Smuzhiyun 	{CS35L34_SPKR_MON_CTL, 0xC6},
89*4882a593Smuzhiyun 	{CS35L34_ADSP_I2S_CTL, 0x00},
90*4882a593Smuzhiyun 	{CS35L34_ADSP_TDM_CTL, 0x00},
91*4882a593Smuzhiyun 	{CS35L34_TDM_TX_CTL_1_VMON, 0x00},
92*4882a593Smuzhiyun 	{CS35L34_TDM_TX_CTL_2_IMON, 0x04},
93*4882a593Smuzhiyun 	{CS35L34_TDM_TX_CTL_3_VPMON, 0x03},
94*4882a593Smuzhiyun 	{CS35L34_TDM_TX_CTL_4_VBSTMON, 0x07},
95*4882a593Smuzhiyun 	{CS35L34_TDM_TX_CTL_5_FLAG1, 0x08},
96*4882a593Smuzhiyun 	{CS35L34_TDM_TX_CTL_6_FLAG2, 0x09},
97*4882a593Smuzhiyun 	{CS35L34_TDM_TX_SLOT_EN_1, 0x00},
98*4882a593Smuzhiyun 	{CS35L34_TDM_TX_SLOT_EN_2, 0x00},
99*4882a593Smuzhiyun 	{CS35L34_TDM_TX_SLOT_EN_3, 0x00},
100*4882a593Smuzhiyun 	{CS35L34_TDM_TX_SLOT_EN_4, 0x00},
101*4882a593Smuzhiyun 	{CS35L34_TDM_RX_CTL_1_AUDIN, 0x40},
102*4882a593Smuzhiyun 	{CS35L34_TDM_RX_CTL_3_ALIVE, 0x04},
103*4882a593Smuzhiyun 	{CS35L34_MULT_DEV_SYNCH1, 0x00},
104*4882a593Smuzhiyun 	{CS35L34_MULT_DEV_SYNCH2, 0x80},
105*4882a593Smuzhiyun 	{CS35L34_PROT_RELEASE_CTL, 0x00},
106*4882a593Smuzhiyun 	{CS35L34_DIAG_MODE_REG_LOCK, 0x00},
107*4882a593Smuzhiyun 	{CS35L34_DIAG_MODE_CTL_1, 0x00},
108*4882a593Smuzhiyun 	{CS35L34_DIAG_MODE_CTL_2, 0x00},
109*4882a593Smuzhiyun 	{CS35L34_INT_MASK_1, 0xFF},
110*4882a593Smuzhiyun 	{CS35L34_INT_MASK_2, 0xFF},
111*4882a593Smuzhiyun 	{CS35L34_INT_MASK_3, 0xFF},
112*4882a593Smuzhiyun 	{CS35L34_INT_MASK_4, 0xFF},
113*4882a593Smuzhiyun 	{CS35L34_INT_STATUS_1, 0x30},
114*4882a593Smuzhiyun 	{CS35L34_INT_STATUS_2, 0x05},
115*4882a593Smuzhiyun 	{CS35L34_INT_STATUS_3, 0x00},
116*4882a593Smuzhiyun 	{CS35L34_INT_STATUS_4, 0x00},
117*4882a593Smuzhiyun 	{CS35L34_OTP_TRIM_STATUS, 0x00},
118*4882a593Smuzhiyun };
119*4882a593Smuzhiyun 
cs35l34_volatile_register(struct device * dev,unsigned int reg)120*4882a593Smuzhiyun static bool cs35l34_volatile_register(struct device *dev, unsigned int reg)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun 	switch (reg) {
123*4882a593Smuzhiyun 	case CS35L34_DEVID_AB:
124*4882a593Smuzhiyun 	case CS35L34_DEVID_CD:
125*4882a593Smuzhiyun 	case CS35L34_DEVID_E:
126*4882a593Smuzhiyun 	case CS35L34_FAB_ID:
127*4882a593Smuzhiyun 	case CS35L34_REV_ID:
128*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_1:
129*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_2:
130*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_3:
131*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_4:
132*4882a593Smuzhiyun 	case CS35L34_CLASS_H_STATUS:
133*4882a593Smuzhiyun 	case CS35L34_VPBR_ATTEN_STATUS:
134*4882a593Smuzhiyun 	case CS35L34_OTP_TRIM_STATUS:
135*4882a593Smuzhiyun 		return true;
136*4882a593Smuzhiyun 	default:
137*4882a593Smuzhiyun 		return false;
138*4882a593Smuzhiyun 	}
139*4882a593Smuzhiyun }
140*4882a593Smuzhiyun 
cs35l34_readable_register(struct device * dev,unsigned int reg)141*4882a593Smuzhiyun static bool cs35l34_readable_register(struct device *dev, unsigned int reg)
142*4882a593Smuzhiyun {
143*4882a593Smuzhiyun 	switch (reg) {
144*4882a593Smuzhiyun 	case	CS35L34_DEVID_AB:
145*4882a593Smuzhiyun 	case	CS35L34_DEVID_CD:
146*4882a593Smuzhiyun 	case	CS35L34_DEVID_E:
147*4882a593Smuzhiyun 	case	CS35L34_FAB_ID:
148*4882a593Smuzhiyun 	case	CS35L34_REV_ID:
149*4882a593Smuzhiyun 	case	CS35L34_PWRCTL1:
150*4882a593Smuzhiyun 	case	CS35L34_PWRCTL2:
151*4882a593Smuzhiyun 	case	CS35L34_PWRCTL3:
152*4882a593Smuzhiyun 	case	CS35L34_ADSP_CLK_CTL:
153*4882a593Smuzhiyun 	case	CS35L34_MCLK_CTL:
154*4882a593Smuzhiyun 	case	CS35L34_AMP_INP_DRV_CTL:
155*4882a593Smuzhiyun 	case	CS35L34_AMP_DIG_VOL_CTL:
156*4882a593Smuzhiyun 	case	CS35L34_AMP_DIG_VOL:
157*4882a593Smuzhiyun 	case	CS35L34_AMP_ANLG_GAIN_CTL:
158*4882a593Smuzhiyun 	case	CS35L34_PROTECT_CTL:
159*4882a593Smuzhiyun 	case	CS35L34_AMP_KEEP_ALIVE_CTL:
160*4882a593Smuzhiyun 	case	CS35L34_BST_CVTR_V_CTL:
161*4882a593Smuzhiyun 	case	CS35L34_BST_PEAK_I:
162*4882a593Smuzhiyun 	case	CS35L34_BST_RAMP_CTL:
163*4882a593Smuzhiyun 	case	CS35L34_BST_CONV_COEF_1:
164*4882a593Smuzhiyun 	case	CS35L34_BST_CONV_COEF_2:
165*4882a593Smuzhiyun 	case	CS35L34_BST_CONV_SLOPE_COMP:
166*4882a593Smuzhiyun 	case	CS35L34_BST_CONV_SW_FREQ:
167*4882a593Smuzhiyun 	case	CS35L34_CLASS_H_CTL:
168*4882a593Smuzhiyun 	case	CS35L34_CLASS_H_HEADRM_CTL:
169*4882a593Smuzhiyun 	case	CS35L34_CLASS_H_RELEASE_RATE:
170*4882a593Smuzhiyun 	case	CS35L34_CLASS_H_FET_DRIVE_CTL:
171*4882a593Smuzhiyun 	case	CS35L34_CLASS_H_STATUS:
172*4882a593Smuzhiyun 	case	CS35L34_VPBR_CTL:
173*4882a593Smuzhiyun 	case	CS35L34_VPBR_VOL_CTL:
174*4882a593Smuzhiyun 	case	CS35L34_VPBR_TIMING_CTL:
175*4882a593Smuzhiyun 	case	CS35L34_PRED_MAX_ATTEN_SPK_LOAD:
176*4882a593Smuzhiyun 	case	CS35L34_PRED_BROWNOUT_THRESH:
177*4882a593Smuzhiyun 	case	CS35L34_PRED_BROWNOUT_VOL_CTL:
178*4882a593Smuzhiyun 	case	CS35L34_PRED_BROWNOUT_RATE_CTL:
179*4882a593Smuzhiyun 	case	CS35L34_PRED_WAIT_CTL:
180*4882a593Smuzhiyun 	case	CS35L34_PRED_ZVP_INIT_IMP_CTL:
181*4882a593Smuzhiyun 	case	CS35L34_PRED_MAN_SAFE_VPI_CTL:
182*4882a593Smuzhiyun 	case	CS35L34_VPBR_ATTEN_STATUS:
183*4882a593Smuzhiyun 	case	CS35L34_PRED_BRWNOUT_ATT_STATUS:
184*4882a593Smuzhiyun 	case	CS35L34_SPKR_MON_CTL:
185*4882a593Smuzhiyun 	case	CS35L34_ADSP_I2S_CTL:
186*4882a593Smuzhiyun 	case	CS35L34_ADSP_TDM_CTL:
187*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_CTL_1_VMON:
188*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_CTL_2_IMON:
189*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_CTL_3_VPMON:
190*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_CTL_4_VBSTMON:
191*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_CTL_5_FLAG1:
192*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_CTL_6_FLAG2:
193*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_SLOT_EN_1:
194*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_SLOT_EN_2:
195*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_SLOT_EN_3:
196*4882a593Smuzhiyun 	case	CS35L34_TDM_TX_SLOT_EN_4:
197*4882a593Smuzhiyun 	case	CS35L34_TDM_RX_CTL_1_AUDIN:
198*4882a593Smuzhiyun 	case	CS35L34_TDM_RX_CTL_3_ALIVE:
199*4882a593Smuzhiyun 	case	CS35L34_MULT_DEV_SYNCH1:
200*4882a593Smuzhiyun 	case	CS35L34_MULT_DEV_SYNCH2:
201*4882a593Smuzhiyun 	case	CS35L34_PROT_RELEASE_CTL:
202*4882a593Smuzhiyun 	case	CS35L34_DIAG_MODE_REG_LOCK:
203*4882a593Smuzhiyun 	case	CS35L34_DIAG_MODE_CTL_1:
204*4882a593Smuzhiyun 	case	CS35L34_DIAG_MODE_CTL_2:
205*4882a593Smuzhiyun 	case	CS35L34_INT_MASK_1:
206*4882a593Smuzhiyun 	case	CS35L34_INT_MASK_2:
207*4882a593Smuzhiyun 	case	CS35L34_INT_MASK_3:
208*4882a593Smuzhiyun 	case	CS35L34_INT_MASK_4:
209*4882a593Smuzhiyun 	case	CS35L34_INT_STATUS_1:
210*4882a593Smuzhiyun 	case	CS35L34_INT_STATUS_2:
211*4882a593Smuzhiyun 	case	CS35L34_INT_STATUS_3:
212*4882a593Smuzhiyun 	case	CS35L34_INT_STATUS_4:
213*4882a593Smuzhiyun 	case	CS35L34_OTP_TRIM_STATUS:
214*4882a593Smuzhiyun 		return true;
215*4882a593Smuzhiyun 	default:
216*4882a593Smuzhiyun 		return false;
217*4882a593Smuzhiyun 	}
218*4882a593Smuzhiyun }
219*4882a593Smuzhiyun 
cs35l34_precious_register(struct device * dev,unsigned int reg)220*4882a593Smuzhiyun static bool cs35l34_precious_register(struct device *dev, unsigned int reg)
221*4882a593Smuzhiyun {
222*4882a593Smuzhiyun 	switch (reg) {
223*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_1:
224*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_2:
225*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_3:
226*4882a593Smuzhiyun 	case CS35L34_INT_STATUS_4:
227*4882a593Smuzhiyun 		return true;
228*4882a593Smuzhiyun 	default:
229*4882a593Smuzhiyun 		return false;
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun }
232*4882a593Smuzhiyun 
cs35l34_sdin_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)233*4882a593Smuzhiyun static int cs35l34_sdin_event(struct snd_soc_dapm_widget *w,
234*4882a593Smuzhiyun 		struct snd_kcontrol *kcontrol, int event)
235*4882a593Smuzhiyun {
236*4882a593Smuzhiyun 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
237*4882a593Smuzhiyun 	struct cs35l34_private *priv = snd_soc_component_get_drvdata(component);
238*4882a593Smuzhiyun 	int ret;
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 	switch (event) {
241*4882a593Smuzhiyun 	case SND_SOC_DAPM_PRE_PMU:
242*4882a593Smuzhiyun 		if (priv->tdm_mode)
243*4882a593Smuzhiyun 			regmap_update_bits(priv->regmap, CS35L34_PWRCTL3,
244*4882a593Smuzhiyun 						CS35L34_PDN_TDM, 0x00);
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 		ret = regmap_update_bits(priv->regmap, CS35L34_PWRCTL1,
247*4882a593Smuzhiyun 						CS35L34_PDN_ALL, 0);
248*4882a593Smuzhiyun 		if (ret < 0) {
249*4882a593Smuzhiyun 			dev_err(component->dev, "Cannot set Power bits %d\n", ret);
250*4882a593Smuzhiyun 			return ret;
251*4882a593Smuzhiyun 		}
252*4882a593Smuzhiyun 		usleep_range(5000, 5100);
253*4882a593Smuzhiyun 	break;
254*4882a593Smuzhiyun 	case SND_SOC_DAPM_POST_PMD:
255*4882a593Smuzhiyun 		if (priv->tdm_mode) {
256*4882a593Smuzhiyun 			regmap_update_bits(priv->regmap, CS35L34_PWRCTL3,
257*4882a593Smuzhiyun 					CS35L34_PDN_TDM, CS35L34_PDN_TDM);
258*4882a593Smuzhiyun 		}
259*4882a593Smuzhiyun 		ret = regmap_update_bits(priv->regmap, CS35L34_PWRCTL1,
260*4882a593Smuzhiyun 					CS35L34_PDN_ALL, CS35L34_PDN_ALL);
261*4882a593Smuzhiyun 	break;
262*4882a593Smuzhiyun 	default:
263*4882a593Smuzhiyun 		pr_err("Invalid event = 0x%x\n", event);
264*4882a593Smuzhiyun 	}
265*4882a593Smuzhiyun 	return 0;
266*4882a593Smuzhiyun }
267*4882a593Smuzhiyun 
cs35l34_set_tdm_slot(struct snd_soc_dai * dai,unsigned int tx_mask,unsigned int rx_mask,int slots,int slot_width)268*4882a593Smuzhiyun static int cs35l34_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
269*4882a593Smuzhiyun 				unsigned int rx_mask, int slots, int slot_width)
270*4882a593Smuzhiyun {
271*4882a593Smuzhiyun 	struct snd_soc_component *component = dai->component;
272*4882a593Smuzhiyun 	struct cs35l34_private *priv = snd_soc_component_get_drvdata(component);
273*4882a593Smuzhiyun 	unsigned int reg, bit_pos;
274*4882a593Smuzhiyun 	int slot, slot_num;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	if (slot_width != 8)
277*4882a593Smuzhiyun 		return -EINVAL;
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	priv->tdm_mode = true;
280*4882a593Smuzhiyun 	/* scan rx_mask for aud slot */
281*4882a593Smuzhiyun 	slot = ffs(rx_mask) - 1;
282*4882a593Smuzhiyun 	if (slot >= 0)
283*4882a593Smuzhiyun 		snd_soc_component_update_bits(component, CS35L34_TDM_RX_CTL_1_AUDIN,
284*4882a593Smuzhiyun 					CS35L34_X_LOC, slot);
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	/* scan tx_mask: vmon(2 slots); imon (2 slots); vpmon (1 slot)
287*4882a593Smuzhiyun 	 * vbstmon (1 slot)
288*4882a593Smuzhiyun 	 */
289*4882a593Smuzhiyun 	slot = ffs(tx_mask) - 1;
290*4882a593Smuzhiyun 	slot_num = 0;
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun 	/* disable vpmon/vbstmon: enable later if set in tx_mask */
293*4882a593Smuzhiyun 	snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_3_VPMON,
294*4882a593Smuzhiyun 				CS35L34_X_STATE | CS35L34_X_LOC,
295*4882a593Smuzhiyun 				CS35L34_X_STATE | CS35L34_X_LOC);
296*4882a593Smuzhiyun 	snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_4_VBSTMON,
297*4882a593Smuzhiyun 				CS35L34_X_STATE | CS35L34_X_LOC,
298*4882a593Smuzhiyun 				CS35L34_X_STATE | CS35L34_X_LOC);
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	/* disconnect {vp,vbst}_mon routes: eanble later if set in tx_mask*/
301*4882a593Smuzhiyun 	while (slot >= 0) {
302*4882a593Smuzhiyun 		/* configure VMON_TX_LOC */
303*4882a593Smuzhiyun 		if (slot_num == 0)
304*4882a593Smuzhiyun 			snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_1_VMON,
305*4882a593Smuzhiyun 					CS35L34_X_STATE | CS35L34_X_LOC, slot);
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 		/* configure IMON_TX_LOC */
308*4882a593Smuzhiyun 		if (slot_num == 4) {
309*4882a593Smuzhiyun 			snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_2_IMON,
310*4882a593Smuzhiyun 					CS35L34_X_STATE | CS35L34_X_LOC, slot);
311*4882a593Smuzhiyun 		}
312*4882a593Smuzhiyun 		/* configure VPMON_TX_LOC */
313*4882a593Smuzhiyun 		if (slot_num == 3) {
314*4882a593Smuzhiyun 			snd_soc_component_update_bits(component, CS35L34_TDM_TX_CTL_3_VPMON,
315*4882a593Smuzhiyun 					CS35L34_X_STATE | CS35L34_X_LOC, slot);
316*4882a593Smuzhiyun 		}
317*4882a593Smuzhiyun 		/* configure VBSTMON_TX_LOC */
318*4882a593Smuzhiyun 		if (slot_num == 7) {
319*4882a593Smuzhiyun 			snd_soc_component_update_bits(component,
320*4882a593Smuzhiyun 				CS35L34_TDM_TX_CTL_4_VBSTMON,
321*4882a593Smuzhiyun 				CS35L34_X_STATE | CS35L34_X_LOC, slot);
322*4882a593Smuzhiyun 		}
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 		/* Enable the relevant tx slot */
325*4882a593Smuzhiyun 		reg = CS35L34_TDM_TX_SLOT_EN_4 - (slot/8);
326*4882a593Smuzhiyun 		bit_pos = slot - ((slot / 8) * (8));
327*4882a593Smuzhiyun 		snd_soc_component_update_bits(component, reg,
328*4882a593Smuzhiyun 			1 << bit_pos, 1 << bit_pos);
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 		tx_mask &= ~(1 << slot);
331*4882a593Smuzhiyun 		slot = ffs(tx_mask) - 1;
332*4882a593Smuzhiyun 		slot_num++;
333*4882a593Smuzhiyun 	}
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 	return 0;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun 
cs35l34_main_amp_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)338*4882a593Smuzhiyun static int cs35l34_main_amp_event(struct snd_soc_dapm_widget *w,
339*4882a593Smuzhiyun 		struct snd_kcontrol *kcontrol, int event)
340*4882a593Smuzhiyun {
341*4882a593Smuzhiyun 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
342*4882a593Smuzhiyun 	struct cs35l34_private *priv = snd_soc_component_get_drvdata(component);
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	switch (event) {
345*4882a593Smuzhiyun 	case SND_SOC_DAPM_POST_PMU:
346*4882a593Smuzhiyun 		regmap_update_bits(priv->regmap, CS35L34_BST_CVTR_V_CTL,
347*4882a593Smuzhiyun 				CS35L34_BST_CVTL_MASK, priv->pdata.boost_vtge);
348*4882a593Smuzhiyun 		usleep_range(5000, 5100);
349*4882a593Smuzhiyun 		regmap_update_bits(priv->regmap, CS35L34_PROTECT_CTL,
350*4882a593Smuzhiyun 						CS35L34_MUTE, 0);
351*4882a593Smuzhiyun 		break;
352*4882a593Smuzhiyun 	case SND_SOC_DAPM_POST_PMD:
353*4882a593Smuzhiyun 		regmap_update_bits(priv->regmap, CS35L34_BST_CVTR_V_CTL,
354*4882a593Smuzhiyun 			CS35L34_BST_CVTL_MASK, 0);
355*4882a593Smuzhiyun 		regmap_update_bits(priv->regmap, CS35L34_PROTECT_CTL,
356*4882a593Smuzhiyun 			CS35L34_MUTE, CS35L34_MUTE);
357*4882a593Smuzhiyun 		usleep_range(5000, 5100);
358*4882a593Smuzhiyun 		break;
359*4882a593Smuzhiyun 	default:
360*4882a593Smuzhiyun 		pr_err("Invalid event = 0x%x\n", event);
361*4882a593Smuzhiyun 	}
362*4882a593Smuzhiyun 	return 0;
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun static DECLARE_TLV_DB_SCALE(dig_vol_tlv, -10200, 50, 0);
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun static DECLARE_TLV_DB_SCALE(amp_gain_tlv, 300, 100, 0);
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun static const struct snd_kcontrol_new cs35l34_snd_controls[] = {
371*4882a593Smuzhiyun 	SOC_SINGLE_SX_TLV("Digital Volume", CS35L34_AMP_DIG_VOL,
372*4882a593Smuzhiyun 		      0, 0x34, 0xE4, dig_vol_tlv),
373*4882a593Smuzhiyun 	SOC_SINGLE_TLV("Amp Gain Volume", CS35L34_AMP_ANLG_GAIN_CTL,
374*4882a593Smuzhiyun 		      0, 0xF, 0, amp_gain_tlv),
375*4882a593Smuzhiyun };
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 
cs35l34_mclk_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)378*4882a593Smuzhiyun static int cs35l34_mclk_event(struct snd_soc_dapm_widget *w,
379*4882a593Smuzhiyun 		struct snd_kcontrol *kcontrol, int event)
380*4882a593Smuzhiyun {
381*4882a593Smuzhiyun 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
382*4882a593Smuzhiyun 	struct cs35l34_private *priv = snd_soc_component_get_drvdata(component);
383*4882a593Smuzhiyun 	int ret, i;
384*4882a593Smuzhiyun 	unsigned int reg;
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	switch (event) {
387*4882a593Smuzhiyun 	case SND_SOC_DAPM_PRE_PMD:
388*4882a593Smuzhiyun 		ret = regmap_read(priv->regmap, CS35L34_AMP_DIG_VOL_CTL,
389*4882a593Smuzhiyun 			&reg);
390*4882a593Smuzhiyun 		if (ret != 0) {
391*4882a593Smuzhiyun 			pr_err("%s regmap read failure %d\n", __func__, ret);
392*4882a593Smuzhiyun 			return ret;
393*4882a593Smuzhiyun 		}
394*4882a593Smuzhiyun 		if (reg & CS35L34_AMP_DIGSFT)
395*4882a593Smuzhiyun 			msleep(40);
396*4882a593Smuzhiyun 		else
397*4882a593Smuzhiyun 			usleep_range(2000, 2100);
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 		for (i = 0; i < PDN_DONE_ATTEMPTS; i++) {
400*4882a593Smuzhiyun 			ret = regmap_read(priv->regmap, CS35L34_INT_STATUS_2,
401*4882a593Smuzhiyun 				&reg);
402*4882a593Smuzhiyun 			if (ret != 0) {
403*4882a593Smuzhiyun 				pr_err("%s regmap read failure %d\n",
404*4882a593Smuzhiyun 					__func__, ret);
405*4882a593Smuzhiyun 				return ret;
406*4882a593Smuzhiyun 			}
407*4882a593Smuzhiyun 			if (reg & CS35L34_PDN_DONE)
408*4882a593Smuzhiyun 				break;
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 			usleep_range(5000, 5100);
411*4882a593Smuzhiyun 		}
412*4882a593Smuzhiyun 		if (i == PDN_DONE_ATTEMPTS)
413*4882a593Smuzhiyun 			pr_err("%s Device did not power down properly\n",
414*4882a593Smuzhiyun 				__func__);
415*4882a593Smuzhiyun 		break;
416*4882a593Smuzhiyun 	default:
417*4882a593Smuzhiyun 		pr_err("Invalid event = 0x%x\n", event);
418*4882a593Smuzhiyun 		break;
419*4882a593Smuzhiyun 	}
420*4882a593Smuzhiyun 	return 0;
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun 
423*4882a593Smuzhiyun static const struct snd_soc_dapm_widget cs35l34_dapm_widgets[] = {
424*4882a593Smuzhiyun 	SND_SOC_DAPM_AIF_IN_E("SDIN", NULL, 0, CS35L34_PWRCTL3,
425*4882a593Smuzhiyun 					1, 1, cs35l34_sdin_event,
426*4882a593Smuzhiyun 					SND_SOC_DAPM_PRE_PMU |
427*4882a593Smuzhiyun 					SND_SOC_DAPM_POST_PMD),
428*4882a593Smuzhiyun 	SND_SOC_DAPM_AIF_OUT("SDOUT", NULL, 0, CS35L34_PWRCTL3, 2, 1),
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 	SND_SOC_DAPM_SUPPLY("EXTCLK", CS35L34_PWRCTL3, 7, 1,
431*4882a593Smuzhiyun 		cs35l34_mclk_event, SND_SOC_DAPM_PRE_PMD),
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	SND_SOC_DAPM_OUTPUT("SPK"),
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	SND_SOC_DAPM_INPUT("VP"),
436*4882a593Smuzhiyun 	SND_SOC_DAPM_INPUT("VPST"),
437*4882a593Smuzhiyun 	SND_SOC_DAPM_INPUT("ISENSE"),
438*4882a593Smuzhiyun 	SND_SOC_DAPM_INPUT("VSENSE"),
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	SND_SOC_DAPM_ADC("VMON ADC", NULL, CS35L34_PWRCTL2, 7, 1),
441*4882a593Smuzhiyun 	SND_SOC_DAPM_ADC("IMON ADC", NULL, CS35L34_PWRCTL2, 6, 1),
442*4882a593Smuzhiyun 	SND_SOC_DAPM_ADC("VPMON ADC", NULL, CS35L34_PWRCTL3, 3, 1),
443*4882a593Smuzhiyun 	SND_SOC_DAPM_ADC("VBSTMON ADC", NULL, CS35L34_PWRCTL3, 4, 1),
444*4882a593Smuzhiyun 	SND_SOC_DAPM_ADC("CLASS H", NULL, CS35L34_PWRCTL2, 5, 1),
445*4882a593Smuzhiyun 	SND_SOC_DAPM_ADC("BOOST", NULL, CS35L34_PWRCTL2, 2, 1),
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 	SND_SOC_DAPM_OUT_DRV_E("Main AMP", CS35L34_PWRCTL2, 0, 1, NULL, 0,
448*4882a593Smuzhiyun 		cs35l34_main_amp_event, SND_SOC_DAPM_POST_PMU |
449*4882a593Smuzhiyun 			SND_SOC_DAPM_POST_PMD),
450*4882a593Smuzhiyun };
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun static const struct snd_soc_dapm_route cs35l34_audio_map[] = {
453*4882a593Smuzhiyun 	{"SDIN", NULL, "AMP Playback"},
454*4882a593Smuzhiyun 	{"BOOST", NULL, "SDIN"},
455*4882a593Smuzhiyun 	{"CLASS H", NULL, "BOOST"},
456*4882a593Smuzhiyun 	{"Main AMP", NULL, "CLASS H"},
457*4882a593Smuzhiyun 	{"SPK", NULL, "Main AMP"},
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 	{"VPMON ADC", NULL, "CLASS H"},
460*4882a593Smuzhiyun 	{"VBSTMON ADC", NULL, "CLASS H"},
461*4882a593Smuzhiyun 	{"SPK", NULL, "VPMON ADC"},
462*4882a593Smuzhiyun 	{"SPK", NULL, "VBSTMON ADC"},
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	{"IMON ADC", NULL, "ISENSE"},
465*4882a593Smuzhiyun 	{"VMON ADC", NULL, "VSENSE"},
466*4882a593Smuzhiyun 	{"SDOUT", NULL, "IMON ADC"},
467*4882a593Smuzhiyun 	{"SDOUT", NULL, "VMON ADC"},
468*4882a593Smuzhiyun 	{"AMP Capture", NULL, "SDOUT"},
469*4882a593Smuzhiyun 
470*4882a593Smuzhiyun 	{"SDIN", NULL, "EXTCLK"},
471*4882a593Smuzhiyun 	{"SDOUT", NULL, "EXTCLK"},
472*4882a593Smuzhiyun };
473*4882a593Smuzhiyun 
474*4882a593Smuzhiyun struct cs35l34_mclk_div {
475*4882a593Smuzhiyun 	int mclk;
476*4882a593Smuzhiyun 	int srate;
477*4882a593Smuzhiyun 	u8 adsp_rate;
478*4882a593Smuzhiyun };
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun static struct cs35l34_mclk_div cs35l34_mclk_coeffs[] = {
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun 	/* MCLK, Sample Rate, adsp_rate */
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 	{5644800, 11025, 0x1},
485*4882a593Smuzhiyun 	{5644800, 22050, 0x4},
486*4882a593Smuzhiyun 	{5644800, 44100, 0x7},
487*4882a593Smuzhiyun 
488*4882a593Smuzhiyun 	{6000000,  8000, 0x0},
489*4882a593Smuzhiyun 	{6000000, 11025, 0x1},
490*4882a593Smuzhiyun 	{6000000, 12000, 0x2},
491*4882a593Smuzhiyun 	{6000000, 16000, 0x3},
492*4882a593Smuzhiyun 	{6000000, 22050, 0x4},
493*4882a593Smuzhiyun 	{6000000, 24000, 0x5},
494*4882a593Smuzhiyun 	{6000000, 32000, 0x6},
495*4882a593Smuzhiyun 	{6000000, 44100, 0x7},
496*4882a593Smuzhiyun 	{6000000, 48000, 0x8},
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	{6144000,  8000, 0x0},
499*4882a593Smuzhiyun 	{6144000, 11025, 0x1},
500*4882a593Smuzhiyun 	{6144000, 12000, 0x2},
501*4882a593Smuzhiyun 	{6144000, 16000, 0x3},
502*4882a593Smuzhiyun 	{6144000, 22050, 0x4},
503*4882a593Smuzhiyun 	{6144000, 24000, 0x5},
504*4882a593Smuzhiyun 	{6144000, 32000, 0x6},
505*4882a593Smuzhiyun 	{6144000, 44100, 0x7},
506*4882a593Smuzhiyun 	{6144000, 48000, 0x8},
507*4882a593Smuzhiyun };
508*4882a593Smuzhiyun 
cs35l34_get_mclk_coeff(int mclk,int srate)509*4882a593Smuzhiyun static int cs35l34_get_mclk_coeff(int mclk, int srate)
510*4882a593Smuzhiyun {
511*4882a593Smuzhiyun 	int i;
512*4882a593Smuzhiyun 
513*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(cs35l34_mclk_coeffs); i++) {
514*4882a593Smuzhiyun 		if (cs35l34_mclk_coeffs[i].mclk == mclk &&
515*4882a593Smuzhiyun 			cs35l34_mclk_coeffs[i].srate == srate)
516*4882a593Smuzhiyun 			return i;
517*4882a593Smuzhiyun 	}
518*4882a593Smuzhiyun 	return -EINVAL;
519*4882a593Smuzhiyun }
520*4882a593Smuzhiyun 
cs35l34_set_dai_fmt(struct snd_soc_dai * codec_dai,unsigned int fmt)521*4882a593Smuzhiyun static int cs35l34_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
522*4882a593Smuzhiyun {
523*4882a593Smuzhiyun 	struct snd_soc_component *component = codec_dai->component;
524*4882a593Smuzhiyun 	struct cs35l34_private *priv = snd_soc_component_get_drvdata(component);
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
527*4882a593Smuzhiyun 	case SND_SOC_DAIFMT_CBM_CFM:
528*4882a593Smuzhiyun 		regmap_update_bits(priv->regmap, CS35L34_ADSP_CLK_CTL,
529*4882a593Smuzhiyun 				    0x80, 0x80);
530*4882a593Smuzhiyun 		break;
531*4882a593Smuzhiyun 	case SND_SOC_DAIFMT_CBS_CFS:
532*4882a593Smuzhiyun 		regmap_update_bits(priv->regmap, CS35L34_ADSP_CLK_CTL,
533*4882a593Smuzhiyun 				    0x80, 0x00);
534*4882a593Smuzhiyun 		break;
535*4882a593Smuzhiyun 	default:
536*4882a593Smuzhiyun 		return -EINVAL;
537*4882a593Smuzhiyun 	}
538*4882a593Smuzhiyun 	return 0;
539*4882a593Smuzhiyun }
540*4882a593Smuzhiyun 
cs35l34_pcm_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)541*4882a593Smuzhiyun static int cs35l34_pcm_hw_params(struct snd_pcm_substream *substream,
542*4882a593Smuzhiyun 				 struct snd_pcm_hw_params *params,
543*4882a593Smuzhiyun 				 struct snd_soc_dai *dai)
544*4882a593Smuzhiyun {
545*4882a593Smuzhiyun 	struct snd_soc_component *component = dai->component;
546*4882a593Smuzhiyun 	struct cs35l34_private *priv = snd_soc_component_get_drvdata(component);
547*4882a593Smuzhiyun 	int srate = params_rate(params);
548*4882a593Smuzhiyun 	int ret;
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	int coeff = cs35l34_get_mclk_coeff(priv->mclk_int, srate);
551*4882a593Smuzhiyun 
552*4882a593Smuzhiyun 	if (coeff < 0) {
553*4882a593Smuzhiyun 		dev_err(component->dev, "ERROR: Invalid mclk %d and/or srate %d\n",
554*4882a593Smuzhiyun 			priv->mclk_int, srate);
555*4882a593Smuzhiyun 		return coeff;
556*4882a593Smuzhiyun 	}
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 	ret = regmap_update_bits(priv->regmap, CS35L34_ADSP_CLK_CTL,
559*4882a593Smuzhiyun 		CS35L34_ADSP_RATE, cs35l34_mclk_coeffs[coeff].adsp_rate);
560*4882a593Smuzhiyun 	if (ret != 0)
561*4882a593Smuzhiyun 		dev_err(component->dev, "Failed to set clock state %d\n", ret);
562*4882a593Smuzhiyun 
563*4882a593Smuzhiyun 	return ret;
564*4882a593Smuzhiyun }
565*4882a593Smuzhiyun 
566*4882a593Smuzhiyun static const unsigned int cs35l34_src_rates[] = {
567*4882a593Smuzhiyun 	8000, 11025, 12000, 16000, 22050, 24000, 32000, 44100, 48000
568*4882a593Smuzhiyun };
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 
571*4882a593Smuzhiyun static const struct snd_pcm_hw_constraint_list cs35l34_constraints = {
572*4882a593Smuzhiyun 	.count  = ARRAY_SIZE(cs35l34_src_rates),
573*4882a593Smuzhiyun 	.list   = cs35l34_src_rates,
574*4882a593Smuzhiyun };
575*4882a593Smuzhiyun 
cs35l34_pcm_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)576*4882a593Smuzhiyun static int cs35l34_pcm_startup(struct snd_pcm_substream *substream,
577*4882a593Smuzhiyun 			       struct snd_soc_dai *dai)
578*4882a593Smuzhiyun {
579*4882a593Smuzhiyun 
580*4882a593Smuzhiyun 	snd_pcm_hw_constraint_list(substream->runtime, 0,
581*4882a593Smuzhiyun 				SNDRV_PCM_HW_PARAM_RATE, &cs35l34_constraints);
582*4882a593Smuzhiyun 	return 0;
583*4882a593Smuzhiyun }
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 
cs35l34_set_tristate(struct snd_soc_dai * dai,int tristate)586*4882a593Smuzhiyun static int cs35l34_set_tristate(struct snd_soc_dai *dai, int tristate)
587*4882a593Smuzhiyun {
588*4882a593Smuzhiyun 
589*4882a593Smuzhiyun 	struct snd_soc_component *component = dai->component;
590*4882a593Smuzhiyun 
591*4882a593Smuzhiyun 	if (tristate)
592*4882a593Smuzhiyun 		snd_soc_component_update_bits(component, CS35L34_PWRCTL3,
593*4882a593Smuzhiyun 					CS35L34_PDN_SDOUT, CS35L34_PDN_SDOUT);
594*4882a593Smuzhiyun 	else
595*4882a593Smuzhiyun 		snd_soc_component_update_bits(component, CS35L34_PWRCTL3,
596*4882a593Smuzhiyun 					CS35L34_PDN_SDOUT, 0);
597*4882a593Smuzhiyun 	return 0;
598*4882a593Smuzhiyun }
599*4882a593Smuzhiyun 
cs35l34_dai_set_sysclk(struct snd_soc_dai * dai,int clk_id,unsigned int freq,int dir)600*4882a593Smuzhiyun static int cs35l34_dai_set_sysclk(struct snd_soc_dai *dai,
601*4882a593Smuzhiyun 				int clk_id, unsigned int freq, int dir)
602*4882a593Smuzhiyun {
603*4882a593Smuzhiyun 	struct snd_soc_component *component = dai->component;
604*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34 = snd_soc_component_get_drvdata(component);
605*4882a593Smuzhiyun 	unsigned int value;
606*4882a593Smuzhiyun 
607*4882a593Smuzhiyun 	switch (freq) {
608*4882a593Smuzhiyun 	case CS35L34_MCLK_5644:
609*4882a593Smuzhiyun 		value = CS35L34_MCLK_RATE_5P6448;
610*4882a593Smuzhiyun 		cs35l34->mclk_int = freq;
611*4882a593Smuzhiyun 	break;
612*4882a593Smuzhiyun 	case CS35L34_MCLK_6:
613*4882a593Smuzhiyun 		value = CS35L34_MCLK_RATE_6P0000;
614*4882a593Smuzhiyun 		cs35l34->mclk_int = freq;
615*4882a593Smuzhiyun 	break;
616*4882a593Smuzhiyun 	case CS35L34_MCLK_6144:
617*4882a593Smuzhiyun 		value = CS35L34_MCLK_RATE_6P1440;
618*4882a593Smuzhiyun 		cs35l34->mclk_int = freq;
619*4882a593Smuzhiyun 	break;
620*4882a593Smuzhiyun 	case CS35L34_MCLK_11289:
621*4882a593Smuzhiyun 		value = CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_5P6448;
622*4882a593Smuzhiyun 		cs35l34->mclk_int = freq / 2;
623*4882a593Smuzhiyun 	break;
624*4882a593Smuzhiyun 	case CS35L34_MCLK_12:
625*4882a593Smuzhiyun 		value = CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_6P0000;
626*4882a593Smuzhiyun 		cs35l34->mclk_int = freq / 2;
627*4882a593Smuzhiyun 	break;
628*4882a593Smuzhiyun 	case CS35L34_MCLK_12288:
629*4882a593Smuzhiyun 		value = CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_6P1440;
630*4882a593Smuzhiyun 		cs35l34->mclk_int = freq / 2;
631*4882a593Smuzhiyun 	break;
632*4882a593Smuzhiyun 	default:
633*4882a593Smuzhiyun 		dev_err(component->dev, "ERROR: Invalid Frequency %d\n", freq);
634*4882a593Smuzhiyun 		cs35l34->mclk_int = 0;
635*4882a593Smuzhiyun 		return -EINVAL;
636*4882a593Smuzhiyun 	}
637*4882a593Smuzhiyun 	regmap_update_bits(cs35l34->regmap, CS35L34_MCLK_CTL,
638*4882a593Smuzhiyun 			CS35L34_MCLK_DIV | CS35L34_MCLK_RATE_MASK, value);
639*4882a593Smuzhiyun 	return 0;
640*4882a593Smuzhiyun }
641*4882a593Smuzhiyun 
642*4882a593Smuzhiyun static const struct snd_soc_dai_ops cs35l34_ops = {
643*4882a593Smuzhiyun 	.startup = cs35l34_pcm_startup,
644*4882a593Smuzhiyun 	.set_tristate = cs35l34_set_tristate,
645*4882a593Smuzhiyun 	.set_fmt = cs35l34_set_dai_fmt,
646*4882a593Smuzhiyun 	.hw_params = cs35l34_pcm_hw_params,
647*4882a593Smuzhiyun 	.set_sysclk = cs35l34_dai_set_sysclk,
648*4882a593Smuzhiyun 	.set_tdm_slot = cs35l34_set_tdm_slot,
649*4882a593Smuzhiyun };
650*4882a593Smuzhiyun 
651*4882a593Smuzhiyun static struct snd_soc_dai_driver cs35l34_dai = {
652*4882a593Smuzhiyun 		.name = "cs35l34",
653*4882a593Smuzhiyun 		.id = 0,
654*4882a593Smuzhiyun 		.playback = {
655*4882a593Smuzhiyun 			.stream_name = "AMP Playback",
656*4882a593Smuzhiyun 			.channels_min = 1,
657*4882a593Smuzhiyun 			.channels_max = 8,
658*4882a593Smuzhiyun 			.rates = CS35L34_RATES,
659*4882a593Smuzhiyun 			.formats = CS35L34_FORMATS,
660*4882a593Smuzhiyun 		},
661*4882a593Smuzhiyun 		.capture = {
662*4882a593Smuzhiyun 			.stream_name = "AMP Capture",
663*4882a593Smuzhiyun 			.channels_min = 1,
664*4882a593Smuzhiyun 			.channels_max = 8,
665*4882a593Smuzhiyun 			.rates = CS35L34_RATES,
666*4882a593Smuzhiyun 			.formats = CS35L34_FORMATS,
667*4882a593Smuzhiyun 		},
668*4882a593Smuzhiyun 		.ops = &cs35l34_ops,
669*4882a593Smuzhiyun 		.symmetric_rates = 1,
670*4882a593Smuzhiyun };
671*4882a593Smuzhiyun 
cs35l34_boost_inductor(struct cs35l34_private * cs35l34,unsigned int inductor)672*4882a593Smuzhiyun static int cs35l34_boost_inductor(struct cs35l34_private *cs35l34,
673*4882a593Smuzhiyun 	unsigned int inductor)
674*4882a593Smuzhiyun {
675*4882a593Smuzhiyun 	struct snd_soc_component *component = cs35l34->component;
676*4882a593Smuzhiyun 
677*4882a593Smuzhiyun 	switch (inductor) {
678*4882a593Smuzhiyun 	case 1000: /* 1 uH */
679*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x24);
680*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x24);
681*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP,
682*4882a593Smuzhiyun 			0x4E);
683*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 0);
684*4882a593Smuzhiyun 		break;
685*4882a593Smuzhiyun 	case 1200: /* 1.2 uH */
686*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x20);
687*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x20);
688*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP,
689*4882a593Smuzhiyun 			0x47);
690*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 1);
691*4882a593Smuzhiyun 		break;
692*4882a593Smuzhiyun 	case 1500: /* 1.5uH */
693*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x20);
694*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x20);
695*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP,
696*4882a593Smuzhiyun 			0x3C);
697*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 2);
698*4882a593Smuzhiyun 		break;
699*4882a593Smuzhiyun 	case 2200: /* 2.2uH */
700*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_1, 0x19);
701*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_COEF_2, 0x25);
702*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SLOPE_COMP,
703*4882a593Smuzhiyun 			0x23);
704*4882a593Smuzhiyun 		regmap_write(cs35l34->regmap, CS35L34_BST_CONV_SW_FREQ, 3);
705*4882a593Smuzhiyun 		break;
706*4882a593Smuzhiyun 	default:
707*4882a593Smuzhiyun 		dev_err(component->dev, "%s Invalid Inductor Value %d uH\n",
708*4882a593Smuzhiyun 			__func__, inductor);
709*4882a593Smuzhiyun 		return -EINVAL;
710*4882a593Smuzhiyun 	}
711*4882a593Smuzhiyun 	return 0;
712*4882a593Smuzhiyun }
713*4882a593Smuzhiyun 
cs35l34_probe(struct snd_soc_component * component)714*4882a593Smuzhiyun static int cs35l34_probe(struct snd_soc_component *component)
715*4882a593Smuzhiyun {
716*4882a593Smuzhiyun 	int ret = 0;
717*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34 = snd_soc_component_get_drvdata(component);
718*4882a593Smuzhiyun 
719*4882a593Smuzhiyun 	pm_runtime_get_sync(component->dev);
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun 	/* Set over temperature warning attenuation to 6 dB */
722*4882a593Smuzhiyun 	regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL,
723*4882a593Smuzhiyun 		 CS35L34_OTW_ATTN_MASK, 0x8);
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	/* Set Power control registers 2 and 3 to have everything
726*4882a593Smuzhiyun 	 * powered down at initialization
727*4882a593Smuzhiyun 	 */
728*4882a593Smuzhiyun 	regmap_write(cs35l34->regmap, CS35L34_PWRCTL2, 0xFD);
729*4882a593Smuzhiyun 	regmap_write(cs35l34->regmap, CS35L34_PWRCTL3, 0x1F);
730*4882a593Smuzhiyun 
731*4882a593Smuzhiyun 	/* Set mute bit at startup */
732*4882a593Smuzhiyun 	regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL,
733*4882a593Smuzhiyun 				CS35L34_MUTE, CS35L34_MUTE);
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun 	/* Set Platform Data */
736*4882a593Smuzhiyun 	if (cs35l34->pdata.boost_peak)
737*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_BST_PEAK_I,
738*4882a593Smuzhiyun 				CS35L34_BST_PEAK_MASK,
739*4882a593Smuzhiyun 				cs35l34->pdata.boost_peak);
740*4882a593Smuzhiyun 
741*4882a593Smuzhiyun 	if (cs35l34->pdata.gain_zc_disable)
742*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL,
743*4882a593Smuzhiyun 			CS35L34_GAIN_ZC_MASK, 0);
744*4882a593Smuzhiyun 	else
745*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_PROTECT_CTL,
746*4882a593Smuzhiyun 			CS35L34_GAIN_ZC_MASK, CS35L34_GAIN_ZC_MASK);
747*4882a593Smuzhiyun 
748*4882a593Smuzhiyun 	if (cs35l34->pdata.aif_half_drv)
749*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_ADSP_CLK_CTL,
750*4882a593Smuzhiyun 			CS35L34_ADSP_DRIVE, 0);
751*4882a593Smuzhiyun 
752*4882a593Smuzhiyun 	if (cs35l34->pdata.digsft_disable)
753*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_AMP_DIG_VOL_CTL,
754*4882a593Smuzhiyun 			CS35L34_AMP_DIGSFT, 0);
755*4882a593Smuzhiyun 
756*4882a593Smuzhiyun 	if (cs35l34->pdata.amp_inv)
757*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_AMP_DIG_VOL_CTL,
758*4882a593Smuzhiyun 			CS35L34_INV, CS35L34_INV);
759*4882a593Smuzhiyun 
760*4882a593Smuzhiyun 	if (cs35l34->pdata.boost_ind)
761*4882a593Smuzhiyun 		ret = cs35l34_boost_inductor(cs35l34, cs35l34->pdata.boost_ind);
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	if (cs35l34->pdata.i2s_sdinloc)
764*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_ADSP_I2S_CTL,
765*4882a593Smuzhiyun 			CS35L34_I2S_LOC_MASK,
766*4882a593Smuzhiyun 			cs35l34->pdata.i2s_sdinloc << CS35L34_I2S_LOC_SHIFT);
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun 	if (cs35l34->pdata.tdm_rising_edge)
769*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_ADSP_TDM_CTL,
770*4882a593Smuzhiyun 			1, 1);
771*4882a593Smuzhiyun 
772*4882a593Smuzhiyun 	pm_runtime_put_sync(component->dev);
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 	return ret;
775*4882a593Smuzhiyun }
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 
778*4882a593Smuzhiyun static const struct snd_soc_component_driver soc_component_dev_cs35l34 = {
779*4882a593Smuzhiyun 	.probe			= cs35l34_probe,
780*4882a593Smuzhiyun 	.dapm_widgets		= cs35l34_dapm_widgets,
781*4882a593Smuzhiyun 	.num_dapm_widgets	= ARRAY_SIZE(cs35l34_dapm_widgets),
782*4882a593Smuzhiyun 	.dapm_routes		= cs35l34_audio_map,
783*4882a593Smuzhiyun 	.num_dapm_routes	= ARRAY_SIZE(cs35l34_audio_map),
784*4882a593Smuzhiyun 	.controls		= cs35l34_snd_controls,
785*4882a593Smuzhiyun 	.num_controls		= ARRAY_SIZE(cs35l34_snd_controls),
786*4882a593Smuzhiyun 	.idle_bias_on		= 1,
787*4882a593Smuzhiyun 	.use_pmdown_time	= 1,
788*4882a593Smuzhiyun 	.endianness		= 1,
789*4882a593Smuzhiyun 	.non_legacy_dai_naming	= 1,
790*4882a593Smuzhiyun };
791*4882a593Smuzhiyun 
792*4882a593Smuzhiyun static struct regmap_config cs35l34_regmap = {
793*4882a593Smuzhiyun 	.reg_bits = 8,
794*4882a593Smuzhiyun 	.val_bits = 8,
795*4882a593Smuzhiyun 
796*4882a593Smuzhiyun 	.max_register = CS35L34_MAX_REGISTER,
797*4882a593Smuzhiyun 	.reg_defaults = cs35l34_reg,
798*4882a593Smuzhiyun 	.num_reg_defaults = ARRAY_SIZE(cs35l34_reg),
799*4882a593Smuzhiyun 	.volatile_reg = cs35l34_volatile_register,
800*4882a593Smuzhiyun 	.readable_reg = cs35l34_readable_register,
801*4882a593Smuzhiyun 	.precious_reg = cs35l34_precious_register,
802*4882a593Smuzhiyun 	.cache_type = REGCACHE_RBTREE,
803*4882a593Smuzhiyun };
804*4882a593Smuzhiyun 
cs35l34_handle_of_data(struct i2c_client * i2c_client,struct cs35l34_platform_data * pdata)805*4882a593Smuzhiyun static int cs35l34_handle_of_data(struct i2c_client *i2c_client,
806*4882a593Smuzhiyun 				struct cs35l34_platform_data *pdata)
807*4882a593Smuzhiyun {
808*4882a593Smuzhiyun 	struct device_node *np = i2c_client->dev.of_node;
809*4882a593Smuzhiyun 	unsigned int val;
810*4882a593Smuzhiyun 
811*4882a593Smuzhiyun 	if (of_property_read_u32(np, "cirrus,boost-vtge-millivolt",
812*4882a593Smuzhiyun 		&val) >= 0) {
813*4882a593Smuzhiyun 		/* Boost Voltage has a maximum of 8V */
814*4882a593Smuzhiyun 		if (val > 8000 || (val < 3300 && val > 0)) {
815*4882a593Smuzhiyun 			dev_err(&i2c_client->dev,
816*4882a593Smuzhiyun 				"Invalid Boost Voltage %d mV\n", val);
817*4882a593Smuzhiyun 			return -EINVAL;
818*4882a593Smuzhiyun 		}
819*4882a593Smuzhiyun 		if (val == 0)
820*4882a593Smuzhiyun 			pdata->boost_vtge = 0; /* Use VP */
821*4882a593Smuzhiyun 		else
822*4882a593Smuzhiyun 			pdata->boost_vtge = ((val - 3300)/100) + 1;
823*4882a593Smuzhiyun 	} else {
824*4882a593Smuzhiyun 		dev_warn(&i2c_client->dev,
825*4882a593Smuzhiyun 			"Boost Voltage not specified. Using VP\n");
826*4882a593Smuzhiyun 	}
827*4882a593Smuzhiyun 
828*4882a593Smuzhiyun 	if (of_property_read_u32(np, "cirrus,boost-ind-nanohenry", &val) >= 0) {
829*4882a593Smuzhiyun 		pdata->boost_ind = val;
830*4882a593Smuzhiyun 	} else {
831*4882a593Smuzhiyun 		dev_err(&i2c_client->dev, "Inductor not specified.\n");
832*4882a593Smuzhiyun 		return -EINVAL;
833*4882a593Smuzhiyun 	}
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	if (of_property_read_u32(np, "cirrus,boost-peak-milliamp", &val) >= 0) {
836*4882a593Smuzhiyun 		if (val > 3840 || val < 1200) {
837*4882a593Smuzhiyun 			dev_err(&i2c_client->dev,
838*4882a593Smuzhiyun 				"Invalid Boost Peak Current %d mA\n", val);
839*4882a593Smuzhiyun 			return -EINVAL;
840*4882a593Smuzhiyun 		}
841*4882a593Smuzhiyun 		pdata->boost_peak = ((val - 1200)/80) + 1;
842*4882a593Smuzhiyun 	}
843*4882a593Smuzhiyun 
844*4882a593Smuzhiyun 	pdata->aif_half_drv = of_property_read_bool(np,
845*4882a593Smuzhiyun 		"cirrus,aif-half-drv");
846*4882a593Smuzhiyun 	pdata->digsft_disable = of_property_read_bool(np,
847*4882a593Smuzhiyun 		"cirrus,digsft-disable");
848*4882a593Smuzhiyun 
849*4882a593Smuzhiyun 	pdata->gain_zc_disable = of_property_read_bool(np,
850*4882a593Smuzhiyun 		"cirrus,gain-zc-disable");
851*4882a593Smuzhiyun 	pdata->amp_inv = of_property_read_bool(np, "cirrus,amp-inv");
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	if (of_property_read_u32(np, "cirrus,i2s-sdinloc", &val) >= 0)
854*4882a593Smuzhiyun 		pdata->i2s_sdinloc = val;
855*4882a593Smuzhiyun 	if (of_property_read_u32(np, "cirrus,tdm-rising-edge", &val) >= 0)
856*4882a593Smuzhiyun 		pdata->tdm_rising_edge = val;
857*4882a593Smuzhiyun 
858*4882a593Smuzhiyun 	return 0;
859*4882a593Smuzhiyun }
860*4882a593Smuzhiyun 
cs35l34_irq_thread(int irq,void * data)861*4882a593Smuzhiyun static irqreturn_t cs35l34_irq_thread(int irq, void *data)
862*4882a593Smuzhiyun {
863*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34 = data;
864*4882a593Smuzhiyun 	struct snd_soc_component *component = cs35l34->component;
865*4882a593Smuzhiyun 	unsigned int sticky1, sticky2, sticky3, sticky4;
866*4882a593Smuzhiyun 	unsigned int mask1, mask2, mask3, mask4, current1;
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 
869*4882a593Smuzhiyun 	/* ack the irq by reading all status registers */
870*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_4, &sticky4);
871*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_3, &sticky3);
872*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_2, &sticky2);
873*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_1, &sticky1);
874*4882a593Smuzhiyun 
875*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_MASK_4, &mask4);
876*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_MASK_3, &mask3);
877*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_MASK_2, &mask2);
878*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_MASK_1, &mask1);
879*4882a593Smuzhiyun 
880*4882a593Smuzhiyun 	if (!(sticky1 & ~mask1) && !(sticky2 & ~mask2) && !(sticky3 & ~mask3)
881*4882a593Smuzhiyun 		&& !(sticky4 & ~mask4))
882*4882a593Smuzhiyun 		return IRQ_NONE;
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun 	regmap_read(cs35l34->regmap, CS35L34_INT_STATUS_1, &current1);
885*4882a593Smuzhiyun 
886*4882a593Smuzhiyun 	if (sticky1 & CS35L34_CAL_ERR) {
887*4882a593Smuzhiyun 		dev_err(component->dev, "Cal error\n");
888*4882a593Smuzhiyun 
889*4882a593Smuzhiyun 		/* error is no longer asserted; safe to reset */
890*4882a593Smuzhiyun 		if (!(current1 & CS35L34_CAL_ERR)) {
891*4882a593Smuzhiyun 			dev_dbg(component->dev, "Cal error release\n");
892*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
893*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
894*4882a593Smuzhiyun 					CS35L34_CAL_ERR_RLS, 0);
895*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
896*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
897*4882a593Smuzhiyun 					CS35L34_CAL_ERR_RLS,
898*4882a593Smuzhiyun 					CS35L34_CAL_ERR_RLS);
899*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
900*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
901*4882a593Smuzhiyun 					CS35L34_CAL_ERR_RLS, 0);
902*4882a593Smuzhiyun 			/* note: amp will re-calibrate on next resume */
903*4882a593Smuzhiyun 		}
904*4882a593Smuzhiyun 	}
905*4882a593Smuzhiyun 
906*4882a593Smuzhiyun 	if (sticky1 & CS35L34_ALIVE_ERR)
907*4882a593Smuzhiyun 		dev_err(component->dev, "Alive error\n");
908*4882a593Smuzhiyun 
909*4882a593Smuzhiyun 	if (sticky1 & CS35L34_AMP_SHORT) {
910*4882a593Smuzhiyun 		dev_crit(component->dev, "Amp short error\n");
911*4882a593Smuzhiyun 
912*4882a593Smuzhiyun 		/* error is no longer asserted; safe to reset */
913*4882a593Smuzhiyun 		if (!(current1 & CS35L34_AMP_SHORT)) {
914*4882a593Smuzhiyun 			dev_dbg(component->dev,
915*4882a593Smuzhiyun 				"Amp short error release\n");
916*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
917*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
918*4882a593Smuzhiyun 					CS35L34_SHORT_RLS, 0);
919*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
920*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
921*4882a593Smuzhiyun 					CS35L34_SHORT_RLS,
922*4882a593Smuzhiyun 					CS35L34_SHORT_RLS);
923*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
924*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
925*4882a593Smuzhiyun 					CS35L34_SHORT_RLS, 0);
926*4882a593Smuzhiyun 		}
927*4882a593Smuzhiyun 	}
928*4882a593Smuzhiyun 
929*4882a593Smuzhiyun 	if (sticky1 & CS35L34_OTW) {
930*4882a593Smuzhiyun 		dev_crit(component->dev, "Over temperature warning\n");
931*4882a593Smuzhiyun 
932*4882a593Smuzhiyun 		/* error is no longer asserted; safe to reset */
933*4882a593Smuzhiyun 		if (!(current1 & CS35L34_OTW)) {
934*4882a593Smuzhiyun 			dev_dbg(component->dev,
935*4882a593Smuzhiyun 				"Over temperature warning release\n");
936*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
937*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
938*4882a593Smuzhiyun 					CS35L34_OTW_RLS, 0);
939*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
940*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
941*4882a593Smuzhiyun 					CS35L34_OTW_RLS,
942*4882a593Smuzhiyun 					CS35L34_OTW_RLS);
943*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
944*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
945*4882a593Smuzhiyun 					CS35L34_OTW_RLS, 0);
946*4882a593Smuzhiyun 		}
947*4882a593Smuzhiyun 	}
948*4882a593Smuzhiyun 
949*4882a593Smuzhiyun 	if (sticky1 & CS35L34_OTE) {
950*4882a593Smuzhiyun 		dev_crit(component->dev, "Over temperature error\n");
951*4882a593Smuzhiyun 
952*4882a593Smuzhiyun 		/* error is no longer asserted; safe to reset */
953*4882a593Smuzhiyun 		if (!(current1 & CS35L34_OTE)) {
954*4882a593Smuzhiyun 			dev_dbg(component->dev,
955*4882a593Smuzhiyun 				"Over temperature error release\n");
956*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
957*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
958*4882a593Smuzhiyun 					CS35L34_OTE_RLS, 0);
959*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
960*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
961*4882a593Smuzhiyun 					CS35L34_OTE_RLS,
962*4882a593Smuzhiyun 					CS35L34_OTE_RLS);
963*4882a593Smuzhiyun 			regmap_update_bits(cs35l34->regmap,
964*4882a593Smuzhiyun 					CS35L34_PROT_RELEASE_CTL,
965*4882a593Smuzhiyun 					CS35L34_OTE_RLS, 0);
966*4882a593Smuzhiyun 		}
967*4882a593Smuzhiyun 	}
968*4882a593Smuzhiyun 
969*4882a593Smuzhiyun 	if (sticky3 & CS35L34_BST_HIGH) {
970*4882a593Smuzhiyun 		dev_crit(component->dev, "VBST too high error; powering off!\n");
971*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL2,
972*4882a593Smuzhiyun 				CS35L34_PDN_AMP, CS35L34_PDN_AMP);
973*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL1,
974*4882a593Smuzhiyun 				CS35L34_PDN_ALL, CS35L34_PDN_ALL);
975*4882a593Smuzhiyun 	}
976*4882a593Smuzhiyun 
977*4882a593Smuzhiyun 	if (sticky3 & CS35L34_LBST_SHORT) {
978*4882a593Smuzhiyun 		dev_crit(component->dev, "LBST short error; powering off!\n");
979*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL2,
980*4882a593Smuzhiyun 				CS35L34_PDN_AMP, CS35L34_PDN_AMP);
981*4882a593Smuzhiyun 		regmap_update_bits(cs35l34->regmap, CS35L34_PWRCTL1,
982*4882a593Smuzhiyun 				CS35L34_PDN_ALL, CS35L34_PDN_ALL);
983*4882a593Smuzhiyun 	}
984*4882a593Smuzhiyun 
985*4882a593Smuzhiyun 	return IRQ_HANDLED;
986*4882a593Smuzhiyun }
987*4882a593Smuzhiyun 
988*4882a593Smuzhiyun static const char * const cs35l34_core_supplies[] = {
989*4882a593Smuzhiyun 	"VA",
990*4882a593Smuzhiyun 	"VP",
991*4882a593Smuzhiyun };
992*4882a593Smuzhiyun 
cs35l34_i2c_probe(struct i2c_client * i2c_client,const struct i2c_device_id * id)993*4882a593Smuzhiyun static int cs35l34_i2c_probe(struct i2c_client *i2c_client,
994*4882a593Smuzhiyun 			      const struct i2c_device_id *id)
995*4882a593Smuzhiyun {
996*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34;
997*4882a593Smuzhiyun 	struct cs35l34_platform_data *pdata =
998*4882a593Smuzhiyun 		dev_get_platdata(&i2c_client->dev);
999*4882a593Smuzhiyun 	int i;
1000*4882a593Smuzhiyun 	int ret;
1001*4882a593Smuzhiyun 	unsigned int devid = 0;
1002*4882a593Smuzhiyun 	unsigned int reg;
1003*4882a593Smuzhiyun 
1004*4882a593Smuzhiyun 	cs35l34 = devm_kzalloc(&i2c_client->dev, sizeof(*cs35l34), GFP_KERNEL);
1005*4882a593Smuzhiyun 	if (!cs35l34)
1006*4882a593Smuzhiyun 		return -ENOMEM;
1007*4882a593Smuzhiyun 
1008*4882a593Smuzhiyun 	i2c_set_clientdata(i2c_client, cs35l34);
1009*4882a593Smuzhiyun 	cs35l34->regmap = devm_regmap_init_i2c(i2c_client, &cs35l34_regmap);
1010*4882a593Smuzhiyun 	if (IS_ERR(cs35l34->regmap)) {
1011*4882a593Smuzhiyun 		ret = PTR_ERR(cs35l34->regmap);
1012*4882a593Smuzhiyun 		dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret);
1013*4882a593Smuzhiyun 		return ret;
1014*4882a593Smuzhiyun 	}
1015*4882a593Smuzhiyun 
1016*4882a593Smuzhiyun 	cs35l34->num_core_supplies = ARRAY_SIZE(cs35l34_core_supplies);
1017*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(cs35l34_core_supplies); i++)
1018*4882a593Smuzhiyun 		cs35l34->core_supplies[i].supply = cs35l34_core_supplies[i];
1019*4882a593Smuzhiyun 
1020*4882a593Smuzhiyun 	ret = devm_regulator_bulk_get(&i2c_client->dev,
1021*4882a593Smuzhiyun 		cs35l34->num_core_supplies,
1022*4882a593Smuzhiyun 		cs35l34->core_supplies);
1023*4882a593Smuzhiyun 	if (ret != 0) {
1024*4882a593Smuzhiyun 		dev_err(&i2c_client->dev,
1025*4882a593Smuzhiyun 			"Failed to request core supplies %d\n", ret);
1026*4882a593Smuzhiyun 		return ret;
1027*4882a593Smuzhiyun 	}
1028*4882a593Smuzhiyun 
1029*4882a593Smuzhiyun 	ret = regulator_bulk_enable(cs35l34->num_core_supplies,
1030*4882a593Smuzhiyun 					cs35l34->core_supplies);
1031*4882a593Smuzhiyun 	if (ret != 0) {
1032*4882a593Smuzhiyun 		dev_err(&i2c_client->dev,
1033*4882a593Smuzhiyun 			"Failed to enable core supplies: %d\n", ret);
1034*4882a593Smuzhiyun 		return ret;
1035*4882a593Smuzhiyun 	}
1036*4882a593Smuzhiyun 
1037*4882a593Smuzhiyun 	if (pdata) {
1038*4882a593Smuzhiyun 		cs35l34->pdata = *pdata;
1039*4882a593Smuzhiyun 	} else {
1040*4882a593Smuzhiyun 		pdata = devm_kzalloc(&i2c_client->dev, sizeof(*pdata),
1041*4882a593Smuzhiyun 				     GFP_KERNEL);
1042*4882a593Smuzhiyun 		if (!pdata)
1043*4882a593Smuzhiyun 			return -ENOMEM;
1044*4882a593Smuzhiyun 
1045*4882a593Smuzhiyun 		if (i2c_client->dev.of_node) {
1046*4882a593Smuzhiyun 			ret = cs35l34_handle_of_data(i2c_client, pdata);
1047*4882a593Smuzhiyun 			if (ret != 0)
1048*4882a593Smuzhiyun 				return ret;
1049*4882a593Smuzhiyun 
1050*4882a593Smuzhiyun 		}
1051*4882a593Smuzhiyun 		cs35l34->pdata = *pdata;
1052*4882a593Smuzhiyun 	}
1053*4882a593Smuzhiyun 
1054*4882a593Smuzhiyun 	ret = devm_request_threaded_irq(&i2c_client->dev, i2c_client->irq, NULL,
1055*4882a593Smuzhiyun 			cs35l34_irq_thread, IRQF_ONESHOT | IRQF_TRIGGER_LOW,
1056*4882a593Smuzhiyun 			"cs35l34", cs35l34);
1057*4882a593Smuzhiyun 	if (ret != 0)
1058*4882a593Smuzhiyun 		dev_err(&i2c_client->dev, "Failed to request IRQ: %d\n", ret);
1059*4882a593Smuzhiyun 
1060*4882a593Smuzhiyun 	cs35l34->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev,
1061*4882a593Smuzhiyun 				"reset-gpios", GPIOD_OUT_LOW);
1062*4882a593Smuzhiyun 	if (IS_ERR(cs35l34->reset_gpio))
1063*4882a593Smuzhiyun 		return PTR_ERR(cs35l34->reset_gpio);
1064*4882a593Smuzhiyun 
1065*4882a593Smuzhiyun 	gpiod_set_value_cansleep(cs35l34->reset_gpio, 1);
1066*4882a593Smuzhiyun 
1067*4882a593Smuzhiyun 	msleep(CS35L34_START_DELAY);
1068*4882a593Smuzhiyun 
1069*4882a593Smuzhiyun 	ret = regmap_read(cs35l34->regmap, CS35L34_DEVID_AB, &reg);
1070*4882a593Smuzhiyun 
1071*4882a593Smuzhiyun 	devid = (reg & 0xFF) << 12;
1072*4882a593Smuzhiyun 	ret = regmap_read(cs35l34->regmap, CS35L34_DEVID_CD, &reg);
1073*4882a593Smuzhiyun 	devid |= (reg & 0xFF) << 4;
1074*4882a593Smuzhiyun 	ret = regmap_read(cs35l34->regmap, CS35L34_DEVID_E, &reg);
1075*4882a593Smuzhiyun 	devid |= (reg & 0xF0) >> 4;
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 	if (devid != CS35L34_CHIP_ID) {
1078*4882a593Smuzhiyun 		dev_err(&i2c_client->dev,
1079*4882a593Smuzhiyun 			"CS35l34 Device ID (%X). Expected ID %X\n",
1080*4882a593Smuzhiyun 			devid, CS35L34_CHIP_ID);
1081*4882a593Smuzhiyun 		ret = -ENODEV;
1082*4882a593Smuzhiyun 		goto err_regulator;
1083*4882a593Smuzhiyun 	}
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	ret = regmap_read(cs35l34->regmap, CS35L34_REV_ID, &reg);
1086*4882a593Smuzhiyun 	if (ret < 0) {
1087*4882a593Smuzhiyun 		dev_err(&i2c_client->dev, "Get Revision ID failed\n");
1088*4882a593Smuzhiyun 		goto err_regulator;
1089*4882a593Smuzhiyun 	}
1090*4882a593Smuzhiyun 
1091*4882a593Smuzhiyun 	dev_info(&i2c_client->dev,
1092*4882a593Smuzhiyun 		 "Cirrus Logic CS35l34 (%x), Revision: %02X\n", devid,
1093*4882a593Smuzhiyun 		reg & 0xFF);
1094*4882a593Smuzhiyun 
1095*4882a593Smuzhiyun 	/* Unmask critical interrupts */
1096*4882a593Smuzhiyun 	regmap_update_bits(cs35l34->regmap, CS35L34_INT_MASK_1,
1097*4882a593Smuzhiyun 				CS35L34_M_CAL_ERR | CS35L34_M_ALIVE_ERR |
1098*4882a593Smuzhiyun 				CS35L34_M_AMP_SHORT | CS35L34_M_OTW |
1099*4882a593Smuzhiyun 				CS35L34_M_OTE, 0);
1100*4882a593Smuzhiyun 	regmap_update_bits(cs35l34->regmap, CS35L34_INT_MASK_3,
1101*4882a593Smuzhiyun 				CS35L34_M_BST_HIGH | CS35L34_M_LBST_SHORT, 0);
1102*4882a593Smuzhiyun 
1103*4882a593Smuzhiyun 	pm_runtime_set_autosuspend_delay(&i2c_client->dev, 100);
1104*4882a593Smuzhiyun 	pm_runtime_use_autosuspend(&i2c_client->dev);
1105*4882a593Smuzhiyun 	pm_runtime_set_active(&i2c_client->dev);
1106*4882a593Smuzhiyun 	pm_runtime_enable(&i2c_client->dev);
1107*4882a593Smuzhiyun 
1108*4882a593Smuzhiyun 	ret = devm_snd_soc_register_component(&i2c_client->dev,
1109*4882a593Smuzhiyun 			&soc_component_dev_cs35l34, &cs35l34_dai, 1);
1110*4882a593Smuzhiyun 	if (ret < 0) {
1111*4882a593Smuzhiyun 		dev_err(&i2c_client->dev,
1112*4882a593Smuzhiyun 			"%s: Register component failed\n", __func__);
1113*4882a593Smuzhiyun 		goto err_regulator;
1114*4882a593Smuzhiyun 	}
1115*4882a593Smuzhiyun 
1116*4882a593Smuzhiyun 	return 0;
1117*4882a593Smuzhiyun 
1118*4882a593Smuzhiyun err_regulator:
1119*4882a593Smuzhiyun 	regulator_bulk_disable(cs35l34->num_core_supplies,
1120*4882a593Smuzhiyun 		cs35l34->core_supplies);
1121*4882a593Smuzhiyun 
1122*4882a593Smuzhiyun 	return ret;
1123*4882a593Smuzhiyun }
1124*4882a593Smuzhiyun 
cs35l34_i2c_remove(struct i2c_client * client)1125*4882a593Smuzhiyun static int cs35l34_i2c_remove(struct i2c_client *client)
1126*4882a593Smuzhiyun {
1127*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34 = i2c_get_clientdata(client);
1128*4882a593Smuzhiyun 
1129*4882a593Smuzhiyun 	gpiod_set_value_cansleep(cs35l34->reset_gpio, 0);
1130*4882a593Smuzhiyun 
1131*4882a593Smuzhiyun 	pm_runtime_disable(&client->dev);
1132*4882a593Smuzhiyun 	regulator_bulk_disable(cs35l34->num_core_supplies,
1133*4882a593Smuzhiyun 		cs35l34->core_supplies);
1134*4882a593Smuzhiyun 
1135*4882a593Smuzhiyun 	return 0;
1136*4882a593Smuzhiyun }
1137*4882a593Smuzhiyun 
cs35l34_runtime_resume(struct device * dev)1138*4882a593Smuzhiyun static int __maybe_unused cs35l34_runtime_resume(struct device *dev)
1139*4882a593Smuzhiyun {
1140*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34 = dev_get_drvdata(dev);
1141*4882a593Smuzhiyun 	int ret;
1142*4882a593Smuzhiyun 
1143*4882a593Smuzhiyun 	ret = regulator_bulk_enable(cs35l34->num_core_supplies,
1144*4882a593Smuzhiyun 		cs35l34->core_supplies);
1145*4882a593Smuzhiyun 
1146*4882a593Smuzhiyun 	if (ret != 0) {
1147*4882a593Smuzhiyun 		dev_err(dev, "Failed to enable core supplies: %d\n",
1148*4882a593Smuzhiyun 			ret);
1149*4882a593Smuzhiyun 		return ret;
1150*4882a593Smuzhiyun 	}
1151*4882a593Smuzhiyun 
1152*4882a593Smuzhiyun 	regcache_cache_only(cs35l34->regmap, false);
1153*4882a593Smuzhiyun 
1154*4882a593Smuzhiyun 	gpiod_set_value_cansleep(cs35l34->reset_gpio, 1);
1155*4882a593Smuzhiyun 	msleep(CS35L34_START_DELAY);
1156*4882a593Smuzhiyun 
1157*4882a593Smuzhiyun 	ret = regcache_sync(cs35l34->regmap);
1158*4882a593Smuzhiyun 	if (ret != 0) {
1159*4882a593Smuzhiyun 		dev_err(dev, "Failed to restore register cache\n");
1160*4882a593Smuzhiyun 		goto err;
1161*4882a593Smuzhiyun 	}
1162*4882a593Smuzhiyun 	return 0;
1163*4882a593Smuzhiyun err:
1164*4882a593Smuzhiyun 	regcache_cache_only(cs35l34->regmap, true);
1165*4882a593Smuzhiyun 	regulator_bulk_disable(cs35l34->num_core_supplies,
1166*4882a593Smuzhiyun 		cs35l34->core_supplies);
1167*4882a593Smuzhiyun 
1168*4882a593Smuzhiyun 	return ret;
1169*4882a593Smuzhiyun }
1170*4882a593Smuzhiyun 
cs35l34_runtime_suspend(struct device * dev)1171*4882a593Smuzhiyun static int __maybe_unused cs35l34_runtime_suspend(struct device *dev)
1172*4882a593Smuzhiyun {
1173*4882a593Smuzhiyun 	struct cs35l34_private *cs35l34 = dev_get_drvdata(dev);
1174*4882a593Smuzhiyun 
1175*4882a593Smuzhiyun 	regcache_cache_only(cs35l34->regmap, true);
1176*4882a593Smuzhiyun 	regcache_mark_dirty(cs35l34->regmap);
1177*4882a593Smuzhiyun 
1178*4882a593Smuzhiyun 	gpiod_set_value_cansleep(cs35l34->reset_gpio, 0);
1179*4882a593Smuzhiyun 
1180*4882a593Smuzhiyun 	regulator_bulk_disable(cs35l34->num_core_supplies,
1181*4882a593Smuzhiyun 			cs35l34->core_supplies);
1182*4882a593Smuzhiyun 
1183*4882a593Smuzhiyun 	return 0;
1184*4882a593Smuzhiyun }
1185*4882a593Smuzhiyun 
1186*4882a593Smuzhiyun static const struct dev_pm_ops cs35l34_pm_ops = {
1187*4882a593Smuzhiyun 	SET_RUNTIME_PM_OPS(cs35l34_runtime_suspend,
1188*4882a593Smuzhiyun 			   cs35l34_runtime_resume,
1189*4882a593Smuzhiyun 			   NULL)
1190*4882a593Smuzhiyun };
1191*4882a593Smuzhiyun 
1192*4882a593Smuzhiyun static const struct of_device_id cs35l34_of_match[] = {
1193*4882a593Smuzhiyun 	{.compatible = "cirrus,cs35l34"},
1194*4882a593Smuzhiyun 	{},
1195*4882a593Smuzhiyun };
1196*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, cs35l34_of_match);
1197*4882a593Smuzhiyun 
1198*4882a593Smuzhiyun static const struct i2c_device_id cs35l34_id[] = {
1199*4882a593Smuzhiyun 	{"cs35l34", 0},
1200*4882a593Smuzhiyun 	{}
1201*4882a593Smuzhiyun };
1202*4882a593Smuzhiyun MODULE_DEVICE_TABLE(i2c, cs35l34_id);
1203*4882a593Smuzhiyun 
1204*4882a593Smuzhiyun static struct i2c_driver cs35l34_i2c_driver = {
1205*4882a593Smuzhiyun 	.driver = {
1206*4882a593Smuzhiyun 		.name = "cs35l34",
1207*4882a593Smuzhiyun 		.pm = &cs35l34_pm_ops,
1208*4882a593Smuzhiyun 		.of_match_table = cs35l34_of_match,
1209*4882a593Smuzhiyun 
1210*4882a593Smuzhiyun 		},
1211*4882a593Smuzhiyun 	.id_table = cs35l34_id,
1212*4882a593Smuzhiyun 	.probe = cs35l34_i2c_probe,
1213*4882a593Smuzhiyun 	.remove = cs35l34_i2c_remove,
1214*4882a593Smuzhiyun 
1215*4882a593Smuzhiyun };
1216*4882a593Smuzhiyun 
cs35l34_modinit(void)1217*4882a593Smuzhiyun static int __init cs35l34_modinit(void)
1218*4882a593Smuzhiyun {
1219*4882a593Smuzhiyun 	int ret;
1220*4882a593Smuzhiyun 
1221*4882a593Smuzhiyun 	ret = i2c_add_driver(&cs35l34_i2c_driver);
1222*4882a593Smuzhiyun 	if (ret != 0) {
1223*4882a593Smuzhiyun 		pr_err("Failed to register CS35l34 I2C driver: %d\n", ret);
1224*4882a593Smuzhiyun 		return ret;
1225*4882a593Smuzhiyun 	}
1226*4882a593Smuzhiyun 	return 0;
1227*4882a593Smuzhiyun }
1228*4882a593Smuzhiyun module_init(cs35l34_modinit);
1229*4882a593Smuzhiyun 
cs35l34_exit(void)1230*4882a593Smuzhiyun static void __exit cs35l34_exit(void)
1231*4882a593Smuzhiyun {
1232*4882a593Smuzhiyun 	i2c_del_driver(&cs35l34_i2c_driver);
1233*4882a593Smuzhiyun }
1234*4882a593Smuzhiyun module_exit(cs35l34_exit);
1235*4882a593Smuzhiyun 
1236*4882a593Smuzhiyun MODULE_DESCRIPTION("ASoC CS35l34 driver");
1237*4882a593Smuzhiyun MODULE_AUTHOR("Paul Handrigan, Cirrus Logic Inc, <Paul.Handrigan@cirrus.com>");
1238*4882a593Smuzhiyun MODULE_LICENSE("GPL");
1239