1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * cs35l35.c -- CS35L35 ALSA SoC audio driver
4 *
5 * Copyright 2017 Cirrus Logic, Inc.
6 *
7 * Author: Brian Austin <brian.austin@cirrus.com>
8 */
9
10 #include <linux/module.h>
11 #include <linux/moduleparam.h>
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/delay.h>
15 #include <linux/i2c.h>
16 #include <linux/slab.h>
17 #include <linux/platform_device.h>
18 #include <linux/regulator/consumer.h>
19 #include <linux/gpio/consumer.h>
20 #include <linux/of.h>
21 #include <linux/regmap.h>
22 #include <sound/core.h>
23 #include <sound/pcm.h>
24 #include <sound/pcm_params.h>
25 #include <sound/soc.h>
26 #include <sound/soc-dapm.h>
27 #include <sound/initval.h>
28 #include <sound/tlv.h>
29 #include <sound/cs35l35.h>
30 #include <linux/completion.h>
31
32 #include "cs35l35.h"
33 #include "cirrus_legacy.h"
34
35 /*
36 * Some fields take zero as a valid value so use a high bit flag that won't
37 * get written to the device to mark those.
38 */
39 #define CS35L35_VALID_PDATA 0x80000000
40
41 static const struct reg_default cs35l35_reg[] = {
42 {CS35L35_PWRCTL1, 0x01},
43 {CS35L35_PWRCTL2, 0x11},
44 {CS35L35_PWRCTL3, 0x00},
45 {CS35L35_CLK_CTL1, 0x04},
46 {CS35L35_CLK_CTL2, 0x12},
47 {CS35L35_CLK_CTL3, 0xCF},
48 {CS35L35_SP_FMT_CTL1, 0x20},
49 {CS35L35_SP_FMT_CTL2, 0x00},
50 {CS35L35_SP_FMT_CTL3, 0x02},
51 {CS35L35_MAG_COMP_CTL, 0x00},
52 {CS35L35_AMP_INP_DRV_CTL, 0x01},
53 {CS35L35_AMP_DIG_VOL_CTL, 0x12},
54 {CS35L35_AMP_DIG_VOL, 0x00},
55 {CS35L35_ADV_DIG_VOL, 0x00},
56 {CS35L35_PROTECT_CTL, 0x06},
57 {CS35L35_AMP_GAIN_AUD_CTL, 0x13},
58 {CS35L35_AMP_GAIN_PDM_CTL, 0x00},
59 {CS35L35_AMP_GAIN_ADV_CTL, 0x00},
60 {CS35L35_GPI_CTL, 0x00},
61 {CS35L35_BST_CVTR_V_CTL, 0x00},
62 {CS35L35_BST_PEAK_I, 0x07},
63 {CS35L35_BST_RAMP_CTL, 0x85},
64 {CS35L35_BST_CONV_COEF_1, 0x24},
65 {CS35L35_BST_CONV_COEF_2, 0x24},
66 {CS35L35_BST_CONV_SLOPE_COMP, 0x4E},
67 {CS35L35_BST_CONV_SW_FREQ, 0x04},
68 {CS35L35_CLASS_H_CTL, 0x0B},
69 {CS35L35_CLASS_H_HEADRM_CTL, 0x0B},
70 {CS35L35_CLASS_H_RELEASE_RATE, 0x08},
71 {CS35L35_CLASS_H_FET_DRIVE_CTL, 0x41},
72 {CS35L35_CLASS_H_VP_CTL, 0xC5},
73 {CS35L35_VPBR_CTL, 0x0A},
74 {CS35L35_VPBR_VOL_CTL, 0x90},
75 {CS35L35_VPBR_TIMING_CTL, 0x6A},
76 {CS35L35_VPBR_MODE_VOL_CTL, 0x00},
77 {CS35L35_SPKR_MON_CTL, 0xC0},
78 {CS35L35_IMON_SCALE_CTL, 0x30},
79 {CS35L35_AUDIN_RXLOC_CTL, 0x00},
80 {CS35L35_ADVIN_RXLOC_CTL, 0x80},
81 {CS35L35_VMON_TXLOC_CTL, 0x00},
82 {CS35L35_IMON_TXLOC_CTL, 0x80},
83 {CS35L35_VPMON_TXLOC_CTL, 0x04},
84 {CS35L35_VBSTMON_TXLOC_CTL, 0x84},
85 {CS35L35_VPBR_STATUS_TXLOC_CTL, 0x04},
86 {CS35L35_ZERO_FILL_LOC_CTL, 0x00},
87 {CS35L35_AUDIN_DEPTH_CTL, 0x0F},
88 {CS35L35_SPKMON_DEPTH_CTL, 0x0F},
89 {CS35L35_SUPMON_DEPTH_CTL, 0x0F},
90 {CS35L35_ZEROFILL_DEPTH_CTL, 0x00},
91 {CS35L35_MULT_DEV_SYNCH1, 0x02},
92 {CS35L35_MULT_DEV_SYNCH2, 0x80},
93 {CS35L35_PROT_RELEASE_CTL, 0x00},
94 {CS35L35_DIAG_MODE_REG_LOCK, 0x00},
95 {CS35L35_DIAG_MODE_CTL_1, 0x40},
96 {CS35L35_DIAG_MODE_CTL_2, 0x00},
97 {CS35L35_INT_MASK_1, 0xFF},
98 {CS35L35_INT_MASK_2, 0xFF},
99 {CS35L35_INT_MASK_3, 0xFF},
100 {CS35L35_INT_MASK_4, 0xFF},
101
102 };
103
cs35l35_volatile_register(struct device * dev,unsigned int reg)104 static bool cs35l35_volatile_register(struct device *dev, unsigned int reg)
105 {
106 switch (reg) {
107 case CS35L35_INT_STATUS_1:
108 case CS35L35_INT_STATUS_2:
109 case CS35L35_INT_STATUS_3:
110 case CS35L35_INT_STATUS_4:
111 case CS35L35_PLL_STATUS:
112 case CS35L35_OTP_TRIM_STATUS:
113 return true;
114 default:
115 return false;
116 }
117 }
118
cs35l35_readable_register(struct device * dev,unsigned int reg)119 static bool cs35l35_readable_register(struct device *dev, unsigned int reg)
120 {
121 switch (reg) {
122 case CS35L35_DEVID_AB ... CS35L35_PWRCTL3:
123 case CS35L35_CLK_CTL1 ... CS35L35_SP_FMT_CTL3:
124 case CS35L35_MAG_COMP_CTL ... CS35L35_AMP_GAIN_AUD_CTL:
125 case CS35L35_AMP_GAIN_PDM_CTL ... CS35L35_BST_PEAK_I:
126 case CS35L35_BST_RAMP_CTL ... CS35L35_BST_CONV_SW_FREQ:
127 case CS35L35_CLASS_H_CTL ... CS35L35_CLASS_H_VP_CTL:
128 case CS35L35_CLASS_H_STATUS:
129 case CS35L35_VPBR_CTL ... CS35L35_VPBR_MODE_VOL_CTL:
130 case CS35L35_VPBR_ATTEN_STATUS:
131 case CS35L35_SPKR_MON_CTL:
132 case CS35L35_IMON_SCALE_CTL ... CS35L35_ZEROFILL_DEPTH_CTL:
133 case CS35L35_MULT_DEV_SYNCH1 ... CS35L35_PROT_RELEASE_CTL:
134 case CS35L35_DIAG_MODE_REG_LOCK ... CS35L35_DIAG_MODE_CTL_2:
135 case CS35L35_INT_MASK_1 ... CS35L35_PLL_STATUS:
136 case CS35L35_OTP_TRIM_STATUS:
137 return true;
138 default:
139 return false;
140 }
141 }
142
cs35l35_precious_register(struct device * dev,unsigned int reg)143 static bool cs35l35_precious_register(struct device *dev, unsigned int reg)
144 {
145 switch (reg) {
146 case CS35L35_INT_STATUS_1:
147 case CS35L35_INT_STATUS_2:
148 case CS35L35_INT_STATUS_3:
149 case CS35L35_INT_STATUS_4:
150 case CS35L35_PLL_STATUS:
151 case CS35L35_OTP_TRIM_STATUS:
152 return true;
153 default:
154 return false;
155 }
156 }
157
cs35l35_reset(struct cs35l35_private * cs35l35)158 static void cs35l35_reset(struct cs35l35_private *cs35l35)
159 {
160 gpiod_set_value_cansleep(cs35l35->reset_gpio, 0);
161 usleep_range(2000, 2100);
162 gpiod_set_value_cansleep(cs35l35->reset_gpio, 1);
163 usleep_range(1000, 1100);
164 }
165
cs35l35_wait_for_pdn(struct cs35l35_private * cs35l35)166 static int cs35l35_wait_for_pdn(struct cs35l35_private *cs35l35)
167 {
168 int ret;
169
170 if (cs35l35->pdata.ext_bst) {
171 usleep_range(5000, 5500);
172 return 0;
173 }
174
175 reinit_completion(&cs35l35->pdn_done);
176
177 ret = wait_for_completion_timeout(&cs35l35->pdn_done,
178 msecs_to_jiffies(100));
179 if (ret == 0) {
180 dev_err(cs35l35->dev, "PDN_DONE did not complete\n");
181 return -ETIMEDOUT;
182 }
183
184 return 0;
185 }
186
cs35l35_sdin_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)187 static int cs35l35_sdin_event(struct snd_soc_dapm_widget *w,
188 struct snd_kcontrol *kcontrol, int event)
189 {
190 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
191 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
192 int ret = 0;
193
194 switch (event) {
195 case SND_SOC_DAPM_PRE_PMU:
196 regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL1,
197 CS35L35_MCLK_DIS_MASK,
198 0 << CS35L35_MCLK_DIS_SHIFT);
199 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL1,
200 CS35L35_DISCHG_FILT_MASK,
201 0 << CS35L35_DISCHG_FILT_SHIFT);
202 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL1,
203 CS35L35_PDN_ALL_MASK, 0);
204 break;
205 case SND_SOC_DAPM_POST_PMD:
206 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL1,
207 CS35L35_DISCHG_FILT_MASK,
208 1 << CS35L35_DISCHG_FILT_SHIFT);
209 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL1,
210 CS35L35_PDN_ALL_MASK, 1);
211
212 /* Already muted, so disable volume ramp for faster shutdown */
213 regmap_update_bits(cs35l35->regmap, CS35L35_AMP_DIG_VOL_CTL,
214 CS35L35_AMP_DIGSFT_MASK, 0);
215
216 ret = cs35l35_wait_for_pdn(cs35l35);
217
218 regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL1,
219 CS35L35_MCLK_DIS_MASK,
220 1 << CS35L35_MCLK_DIS_SHIFT);
221
222 regmap_update_bits(cs35l35->regmap, CS35L35_AMP_DIG_VOL_CTL,
223 CS35L35_AMP_DIGSFT_MASK,
224 1 << CS35L35_AMP_DIGSFT_SHIFT);
225 break;
226 default:
227 dev_err(component->dev, "Invalid event = 0x%x\n", event);
228 ret = -EINVAL;
229 }
230 return ret;
231 }
232
cs35l35_main_amp_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)233 static int cs35l35_main_amp_event(struct snd_soc_dapm_widget *w,
234 struct snd_kcontrol *kcontrol, int event)
235 {
236 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
237 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
238 unsigned int reg[4];
239 int i;
240
241 switch (event) {
242 case SND_SOC_DAPM_PRE_PMU:
243 if (cs35l35->pdata.bst_pdn_fet_on)
244 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
245 CS35L35_PDN_BST_MASK,
246 0 << CS35L35_PDN_BST_FETON_SHIFT);
247 else
248 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
249 CS35L35_PDN_BST_MASK,
250 0 << CS35L35_PDN_BST_FETOFF_SHIFT);
251 break;
252 case SND_SOC_DAPM_POST_PMU:
253 usleep_range(5000, 5100);
254 /* If in PDM mode we must use VP for Voltage control */
255 if (cs35l35->pdm_mode)
256 regmap_update_bits(cs35l35->regmap,
257 CS35L35_BST_CVTR_V_CTL,
258 CS35L35_BST_CTL_MASK,
259 0 << CS35L35_BST_CTL_SHIFT);
260
261 regmap_update_bits(cs35l35->regmap, CS35L35_PROTECT_CTL,
262 CS35L35_AMP_MUTE_MASK, 0);
263
264 for (i = 0; i < 2; i++)
265 regmap_bulk_read(cs35l35->regmap, CS35L35_INT_STATUS_1,
266 ®, ARRAY_SIZE(reg));
267
268 break;
269 case SND_SOC_DAPM_PRE_PMD:
270 regmap_update_bits(cs35l35->regmap, CS35L35_PROTECT_CTL,
271 CS35L35_AMP_MUTE_MASK,
272 1 << CS35L35_AMP_MUTE_SHIFT);
273 if (cs35l35->pdata.bst_pdn_fet_on)
274 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
275 CS35L35_PDN_BST_MASK,
276 1 << CS35L35_PDN_BST_FETON_SHIFT);
277 else
278 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
279 CS35L35_PDN_BST_MASK,
280 1 << CS35L35_PDN_BST_FETOFF_SHIFT);
281 break;
282 case SND_SOC_DAPM_POST_PMD:
283 usleep_range(5000, 5100);
284 /*
285 * If PDM mode we should switch back to pdata value
286 * for Voltage control when we go down
287 */
288 if (cs35l35->pdm_mode)
289 regmap_update_bits(cs35l35->regmap,
290 CS35L35_BST_CVTR_V_CTL,
291 CS35L35_BST_CTL_MASK,
292 cs35l35->pdata.bst_vctl
293 << CS35L35_BST_CTL_SHIFT);
294
295 break;
296 default:
297 dev_err(component->dev, "Invalid event = 0x%x\n", event);
298 }
299 return 0;
300 }
301
302 static DECLARE_TLV_DB_SCALE(amp_gain_tlv, 0, 1, 1);
303 static DECLARE_TLV_DB_SCALE(dig_vol_tlv, -10200, 50, 0);
304
305 static const struct snd_kcontrol_new cs35l35_aud_controls[] = {
306 SOC_SINGLE_SX_TLV("Digital Audio Volume", CS35L35_AMP_DIG_VOL,
307 0, 0x34, 0xE4, dig_vol_tlv),
308 SOC_SINGLE_TLV("Analog Audio Volume", CS35L35_AMP_GAIN_AUD_CTL, 0, 19, 0,
309 amp_gain_tlv),
310 SOC_SINGLE_TLV("PDM Volume", CS35L35_AMP_GAIN_PDM_CTL, 0, 19, 0,
311 amp_gain_tlv),
312 };
313
314 static const struct snd_kcontrol_new cs35l35_adv_controls[] = {
315 SOC_SINGLE_SX_TLV("Digital Advisory Volume", CS35L35_ADV_DIG_VOL,
316 0, 0x34, 0xE4, dig_vol_tlv),
317 SOC_SINGLE_TLV("Analog Advisory Volume", CS35L35_AMP_GAIN_ADV_CTL, 0, 19, 0,
318 amp_gain_tlv),
319 };
320
321 static const struct snd_soc_dapm_widget cs35l35_dapm_widgets[] = {
322 SND_SOC_DAPM_AIF_IN_E("SDIN", NULL, 0, CS35L35_PWRCTL3, 1, 1,
323 cs35l35_sdin_event, SND_SOC_DAPM_PRE_PMU |
324 SND_SOC_DAPM_POST_PMD),
325 SND_SOC_DAPM_AIF_OUT("SDOUT", NULL, 0, CS35L35_PWRCTL3, 2, 1),
326
327 SND_SOC_DAPM_OUTPUT("SPK"),
328
329 SND_SOC_DAPM_INPUT("VP"),
330 SND_SOC_DAPM_INPUT("VBST"),
331 SND_SOC_DAPM_INPUT("ISENSE"),
332 SND_SOC_DAPM_INPUT("VSENSE"),
333
334 SND_SOC_DAPM_ADC("VMON ADC", NULL, CS35L35_PWRCTL2, 7, 1),
335 SND_SOC_DAPM_ADC("IMON ADC", NULL, CS35L35_PWRCTL2, 6, 1),
336 SND_SOC_DAPM_ADC("VPMON ADC", NULL, CS35L35_PWRCTL3, 3, 1),
337 SND_SOC_DAPM_ADC("VBSTMON ADC", NULL, CS35L35_PWRCTL3, 4, 1),
338 SND_SOC_DAPM_ADC("CLASS H", NULL, CS35L35_PWRCTL2, 5, 1),
339
340 SND_SOC_DAPM_OUT_DRV_E("Main AMP", CS35L35_PWRCTL2, 0, 1, NULL, 0,
341 cs35l35_main_amp_event, SND_SOC_DAPM_PRE_PMU |
342 SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU |
343 SND_SOC_DAPM_PRE_PMD),
344 };
345
346 static const struct snd_soc_dapm_route cs35l35_audio_map[] = {
347 {"VPMON ADC", NULL, "VP"},
348 {"VBSTMON ADC", NULL, "VBST"},
349 {"IMON ADC", NULL, "ISENSE"},
350 {"VMON ADC", NULL, "VSENSE"},
351 {"SDOUT", NULL, "IMON ADC"},
352 {"SDOUT", NULL, "VMON ADC"},
353 {"SDOUT", NULL, "VBSTMON ADC"},
354 {"SDOUT", NULL, "VPMON ADC"},
355 {"AMP Capture", NULL, "SDOUT"},
356
357 {"SDIN", NULL, "AMP Playback"},
358 {"CLASS H", NULL, "SDIN"},
359 {"Main AMP", NULL, "CLASS H"},
360 {"SPK", NULL, "Main AMP"},
361 };
362
cs35l35_set_dai_fmt(struct snd_soc_dai * codec_dai,unsigned int fmt)363 static int cs35l35_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
364 {
365 struct snd_soc_component *component = codec_dai->component;
366 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
367
368 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
369 case SND_SOC_DAIFMT_CBP_CFP:
370 regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL1,
371 CS35L35_MS_MASK, 1 << CS35L35_MS_SHIFT);
372 cs35l35->clock_consumer = false;
373 break;
374 case SND_SOC_DAIFMT_CBC_CFC:
375 regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL1,
376 CS35L35_MS_MASK, 0 << CS35L35_MS_SHIFT);
377 cs35l35->clock_consumer = true;
378 break;
379 default:
380 return -EINVAL;
381 }
382
383 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
384 case SND_SOC_DAIFMT_I2S:
385 cs35l35->i2s_mode = true;
386 cs35l35->pdm_mode = false;
387 break;
388 case SND_SOC_DAIFMT_PDM:
389 cs35l35->pdm_mode = true;
390 cs35l35->i2s_mode = false;
391 break;
392 default:
393 return -EINVAL;
394 }
395
396 return 0;
397 }
398
399 struct cs35l35_sysclk_config {
400 int sysclk;
401 int srate;
402 u8 clk_cfg;
403 };
404
405 static struct cs35l35_sysclk_config cs35l35_clk_ctl[] = {
406
407 /* SYSCLK, Sample Rate, Serial Port Cfg */
408 {5644800, 44100, 0x00},
409 {5644800, 88200, 0x40},
410 {6144000, 48000, 0x10},
411 {6144000, 96000, 0x50},
412 {11289600, 44100, 0x01},
413 {11289600, 88200, 0x41},
414 {11289600, 176400, 0x81},
415 {12000000, 44100, 0x03},
416 {12000000, 48000, 0x13},
417 {12000000, 88200, 0x43},
418 {12000000, 96000, 0x53},
419 {12000000, 176400, 0x83},
420 {12000000, 192000, 0x93},
421 {12288000, 48000, 0x11},
422 {12288000, 96000, 0x51},
423 {12288000, 192000, 0x91},
424 {13000000, 44100, 0x07},
425 {13000000, 48000, 0x17},
426 {13000000, 88200, 0x47},
427 {13000000, 96000, 0x57},
428 {13000000, 176400, 0x87},
429 {13000000, 192000, 0x97},
430 {22579200, 44100, 0x02},
431 {22579200, 88200, 0x42},
432 {22579200, 176400, 0x82},
433 {24000000, 44100, 0x0B},
434 {24000000, 48000, 0x1B},
435 {24000000, 88200, 0x4B},
436 {24000000, 96000, 0x5B},
437 {24000000, 176400, 0x8B},
438 {24000000, 192000, 0x9B},
439 {24576000, 48000, 0x12},
440 {24576000, 96000, 0x52},
441 {24576000, 192000, 0x92},
442 {26000000, 44100, 0x0F},
443 {26000000, 48000, 0x1F},
444 {26000000, 88200, 0x4F},
445 {26000000, 96000, 0x5F},
446 {26000000, 176400, 0x8F},
447 {26000000, 192000, 0x9F},
448 };
449
cs35l35_get_clk_config(int sysclk,int srate)450 static int cs35l35_get_clk_config(int sysclk, int srate)
451 {
452 int i;
453
454 for (i = 0; i < ARRAY_SIZE(cs35l35_clk_ctl); i++) {
455 if (cs35l35_clk_ctl[i].sysclk == sysclk &&
456 cs35l35_clk_ctl[i].srate == srate)
457 return cs35l35_clk_ctl[i].clk_cfg;
458 }
459 return -EINVAL;
460 }
461
cs35l35_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)462 static int cs35l35_hw_params(struct snd_pcm_substream *substream,
463 struct snd_pcm_hw_params *params,
464 struct snd_soc_dai *dai)
465 {
466 struct snd_soc_component *component = dai->component;
467 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
468 struct classh_cfg *classh = &cs35l35->pdata.classh_algo;
469 int srate = params_rate(params);
470 int ret = 0;
471 u8 sp_sclks;
472 int audin_format;
473 int errata_chk;
474
475 int clk_ctl = cs35l35_get_clk_config(cs35l35->sysclk, srate);
476
477 if (clk_ctl < 0) {
478 dev_err(component->dev, "Invalid CLK:Rate %d:%d\n",
479 cs35l35->sysclk, srate);
480 return -EINVAL;
481 }
482
483 ret = regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL2,
484 CS35L35_CLK_CTL2_MASK, clk_ctl);
485 if (ret != 0) {
486 dev_err(component->dev, "Failed to set port config %d\n", ret);
487 return ret;
488 }
489
490 /*
491 * Rev A0 Errata
492 * When configured for the weak-drive detection path (CH_WKFET_DIS = 0)
493 * the Class H algorithm does not enable weak-drive operation for
494 * nonzero values of CH_WKFET_DELAY if SP_RATE = 01 or 10
495 */
496 errata_chk = (clk_ctl & CS35L35_SP_RATE_MASK) >> CS35L35_SP_RATE_SHIFT;
497
498 if (classh->classh_wk_fet_disable == 0x00 &&
499 (errata_chk == 0x01 || errata_chk == 0x02)) {
500 ret = regmap_update_bits(cs35l35->regmap,
501 CS35L35_CLASS_H_FET_DRIVE_CTL,
502 CS35L35_CH_WKFET_DEL_MASK,
503 0 << CS35L35_CH_WKFET_DEL_SHIFT);
504 if (ret != 0) {
505 dev_err(component->dev, "Failed to set fet config %d\n",
506 ret);
507 return ret;
508 }
509 }
510
511 /*
512 * You can pull more Monitor data from the SDOUT pin than going to SDIN
513 * Just make sure your SCLK is fast enough to fill the frame
514 */
515 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
516 switch (params_width(params)) {
517 case 8:
518 audin_format = CS35L35_SDIN_DEPTH_8;
519 break;
520 case 16:
521 audin_format = CS35L35_SDIN_DEPTH_16;
522 break;
523 case 24:
524 audin_format = CS35L35_SDIN_DEPTH_24;
525 break;
526 default:
527 dev_err(component->dev, "Unsupported Width %d\n",
528 params_width(params));
529 return -EINVAL;
530 }
531 regmap_update_bits(cs35l35->regmap,
532 CS35L35_AUDIN_DEPTH_CTL,
533 CS35L35_AUDIN_DEPTH_MASK,
534 audin_format <<
535 CS35L35_AUDIN_DEPTH_SHIFT);
536 if (cs35l35->pdata.stereo) {
537 regmap_update_bits(cs35l35->regmap,
538 CS35L35_AUDIN_DEPTH_CTL,
539 CS35L35_ADVIN_DEPTH_MASK,
540 audin_format <<
541 CS35L35_ADVIN_DEPTH_SHIFT);
542 }
543 }
544
545 if (cs35l35->i2s_mode) {
546 /* We have to take the SCLK to derive num sclks
547 * to configure the CLOCK_CTL3 register correctly
548 */
549 if ((cs35l35->sclk / srate) % 4) {
550 dev_err(component->dev, "Unsupported sclk/fs ratio %d:%d\n",
551 cs35l35->sclk, srate);
552 return -EINVAL;
553 }
554 sp_sclks = ((cs35l35->sclk / srate) / 4) - 1;
555
556 /* Only certain ratios supported when device is a clock consumer */
557 if (cs35l35->clock_consumer) {
558 switch (sp_sclks) {
559 case CS35L35_SP_SCLKS_32FS:
560 case CS35L35_SP_SCLKS_48FS:
561 case CS35L35_SP_SCLKS_64FS:
562 break;
563 default:
564 dev_err(component->dev, "ratio not supported\n");
565 return -EINVAL;
566 }
567 } else {
568 /* Only certain ratios supported when device is a clock provider */
569 switch (sp_sclks) {
570 case CS35L35_SP_SCLKS_32FS:
571 case CS35L35_SP_SCLKS_64FS:
572 break;
573 default:
574 dev_err(component->dev, "ratio not supported\n");
575 return -EINVAL;
576 }
577 }
578 ret = regmap_update_bits(cs35l35->regmap,
579 CS35L35_CLK_CTL3,
580 CS35L35_SP_SCLKS_MASK, sp_sclks <<
581 CS35L35_SP_SCLKS_SHIFT);
582 if (ret != 0) {
583 dev_err(component->dev, "Failed to set fsclk %d\n", ret);
584 return ret;
585 }
586 }
587
588 return ret;
589 }
590
591 static const unsigned int cs35l35_src_rates[] = {
592 44100, 48000, 88200, 96000, 176400, 192000
593 };
594
595 static const struct snd_pcm_hw_constraint_list cs35l35_constraints = {
596 .count = ARRAY_SIZE(cs35l35_src_rates),
597 .list = cs35l35_src_rates,
598 };
599
cs35l35_pcm_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)600 static int cs35l35_pcm_startup(struct snd_pcm_substream *substream,
601 struct snd_soc_dai *dai)
602 {
603 struct snd_soc_component *component = dai->component;
604 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
605
606 if (!substream->runtime)
607 return 0;
608
609 snd_pcm_hw_constraint_list(substream->runtime, 0,
610 SNDRV_PCM_HW_PARAM_RATE, &cs35l35_constraints);
611
612 regmap_update_bits(cs35l35->regmap, CS35L35_AMP_INP_DRV_CTL,
613 CS35L35_PDM_MODE_MASK,
614 0 << CS35L35_PDM_MODE_SHIFT);
615
616 return 0;
617 }
618
619 static const unsigned int cs35l35_pdm_rates[] = {
620 44100, 48000, 88200, 96000
621 };
622
623 static const struct snd_pcm_hw_constraint_list cs35l35_pdm_constraints = {
624 .count = ARRAY_SIZE(cs35l35_pdm_rates),
625 .list = cs35l35_pdm_rates,
626 };
627
cs35l35_pdm_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)628 static int cs35l35_pdm_startup(struct snd_pcm_substream *substream,
629 struct snd_soc_dai *dai)
630 {
631 struct snd_soc_component *component = dai->component;
632 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
633
634 if (!substream->runtime)
635 return 0;
636
637 snd_pcm_hw_constraint_list(substream->runtime, 0,
638 SNDRV_PCM_HW_PARAM_RATE,
639 &cs35l35_pdm_constraints);
640
641 regmap_update_bits(cs35l35->regmap, CS35L35_AMP_INP_DRV_CTL,
642 CS35L35_PDM_MODE_MASK,
643 1 << CS35L35_PDM_MODE_SHIFT);
644
645 return 0;
646 }
647
cs35l35_dai_set_sysclk(struct snd_soc_dai * dai,int clk_id,unsigned int freq,int dir)648 static int cs35l35_dai_set_sysclk(struct snd_soc_dai *dai,
649 int clk_id, unsigned int freq, int dir)
650 {
651 struct snd_soc_component *component = dai->component;
652 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
653
654 /* Need the SCLK Frequency regardless of sysclk source for I2S */
655 cs35l35->sclk = freq;
656
657 return 0;
658 }
659
660 static const struct snd_soc_dai_ops cs35l35_ops = {
661 .startup = cs35l35_pcm_startup,
662 .set_fmt = cs35l35_set_dai_fmt,
663 .hw_params = cs35l35_hw_params,
664 .set_sysclk = cs35l35_dai_set_sysclk,
665 };
666
667 static const struct snd_soc_dai_ops cs35l35_pdm_ops = {
668 .startup = cs35l35_pdm_startup,
669 .set_fmt = cs35l35_set_dai_fmt,
670 .hw_params = cs35l35_hw_params,
671 };
672
673 static struct snd_soc_dai_driver cs35l35_dai[] = {
674 {
675 .name = "cs35l35-pcm",
676 .id = 0,
677 .playback = {
678 .stream_name = "AMP Playback",
679 .channels_min = 1,
680 .channels_max = 8,
681 .rates = SNDRV_PCM_RATE_KNOT,
682 .formats = CS35L35_FORMATS,
683 },
684 .capture = {
685 .stream_name = "AMP Capture",
686 .channels_min = 1,
687 .channels_max = 8,
688 .rates = SNDRV_PCM_RATE_KNOT,
689 .formats = CS35L35_FORMATS,
690 },
691 .ops = &cs35l35_ops,
692 .symmetric_rate = 1,
693 },
694 {
695 .name = "cs35l35-pdm",
696 .id = 1,
697 .playback = {
698 .stream_name = "PDM Playback",
699 .channels_min = 1,
700 .channels_max = 2,
701 .rates = SNDRV_PCM_RATE_KNOT,
702 .formats = CS35L35_FORMATS,
703 },
704 .ops = &cs35l35_pdm_ops,
705 },
706 };
707
cs35l35_component_set_sysclk(struct snd_soc_component * component,int clk_id,int source,unsigned int freq,int dir)708 static int cs35l35_component_set_sysclk(struct snd_soc_component *component,
709 int clk_id, int source, unsigned int freq,
710 int dir)
711 {
712 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
713 int clksrc;
714 int ret = 0;
715
716 switch (clk_id) {
717 case 0:
718 clksrc = CS35L35_CLK_SOURCE_MCLK;
719 break;
720 case 1:
721 clksrc = CS35L35_CLK_SOURCE_SCLK;
722 break;
723 case 2:
724 clksrc = CS35L35_CLK_SOURCE_PDM;
725 break;
726 default:
727 dev_err(component->dev, "Invalid CLK Source\n");
728 return -EINVAL;
729 }
730
731 switch (freq) {
732 case 5644800:
733 case 6144000:
734 case 11289600:
735 case 12000000:
736 case 12288000:
737 case 13000000:
738 case 22579200:
739 case 24000000:
740 case 24576000:
741 case 26000000:
742 cs35l35->sysclk = freq;
743 break;
744 default:
745 dev_err(component->dev, "Invalid CLK Frequency Input : %d\n", freq);
746 return -EINVAL;
747 }
748
749 ret = regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL1,
750 CS35L35_CLK_SOURCE_MASK,
751 clksrc << CS35L35_CLK_SOURCE_SHIFT);
752 if (ret != 0) {
753 dev_err(component->dev, "Failed to set sysclk %d\n", ret);
754 return ret;
755 }
756
757 return ret;
758 }
759
cs35l35_boost_inductor(struct cs35l35_private * cs35l35,int inductor)760 static int cs35l35_boost_inductor(struct cs35l35_private *cs35l35,
761 int inductor)
762 {
763 struct regmap *regmap = cs35l35->regmap;
764 unsigned int bst_ipk = 0;
765
766 /*
767 * Digital Boost Converter Configuration for feedback,
768 * ramping, switching frequency, and estimation block seeding.
769 */
770
771 regmap_update_bits(regmap, CS35L35_BST_CONV_SW_FREQ,
772 CS35L35_BST_CONV_SWFREQ_MASK, 0x00);
773
774 regmap_read(regmap, CS35L35_BST_PEAK_I, &bst_ipk);
775 bst_ipk &= CS35L35_BST_IPK_MASK;
776
777 switch (inductor) {
778 case 1000: /* 1 uH */
779 regmap_write(regmap, CS35L35_BST_CONV_COEF_1, 0x24);
780 regmap_write(regmap, CS35L35_BST_CONV_COEF_2, 0x24);
781 regmap_update_bits(regmap, CS35L35_BST_CONV_SW_FREQ,
782 CS35L35_BST_CONV_LBST_MASK, 0x00);
783
784 if (bst_ipk < 0x04)
785 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x1B);
786 else
787 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x4E);
788 break;
789 case 1200: /* 1.2 uH */
790 regmap_write(regmap, CS35L35_BST_CONV_COEF_1, 0x20);
791 regmap_write(regmap, CS35L35_BST_CONV_COEF_2, 0x20);
792 regmap_update_bits(regmap, CS35L35_BST_CONV_SW_FREQ,
793 CS35L35_BST_CONV_LBST_MASK, 0x01);
794
795 if (bst_ipk < 0x04)
796 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x1B);
797 else
798 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x47);
799 break;
800 case 1500: /* 1.5uH */
801 regmap_write(regmap, CS35L35_BST_CONV_COEF_1, 0x20);
802 regmap_write(regmap, CS35L35_BST_CONV_COEF_2, 0x20);
803 regmap_update_bits(regmap, CS35L35_BST_CONV_SW_FREQ,
804 CS35L35_BST_CONV_LBST_MASK, 0x02);
805
806 if (bst_ipk < 0x04)
807 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x1B);
808 else
809 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x3C);
810 break;
811 case 2200: /* 2.2uH */
812 regmap_write(regmap, CS35L35_BST_CONV_COEF_1, 0x19);
813 regmap_write(regmap, CS35L35_BST_CONV_COEF_2, 0x25);
814 regmap_update_bits(regmap, CS35L35_BST_CONV_SW_FREQ,
815 CS35L35_BST_CONV_LBST_MASK, 0x03);
816
817 if (bst_ipk < 0x04)
818 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x1B);
819 else
820 regmap_write(regmap, CS35L35_BST_CONV_SLOPE_COMP, 0x23);
821 break;
822 default:
823 dev_err(cs35l35->dev, "Invalid Inductor Value %d uH\n",
824 inductor);
825 return -EINVAL;
826 }
827 return 0;
828 }
829
cs35l35_component_probe(struct snd_soc_component * component)830 static int cs35l35_component_probe(struct snd_soc_component *component)
831 {
832 struct cs35l35_private *cs35l35 = snd_soc_component_get_drvdata(component);
833 struct classh_cfg *classh = &cs35l35->pdata.classh_algo;
834 struct monitor_cfg *monitor_config = &cs35l35->pdata.mon_cfg;
835 int ret;
836
837 /* Set Platform Data */
838 if (cs35l35->pdata.bst_vctl)
839 regmap_update_bits(cs35l35->regmap, CS35L35_BST_CVTR_V_CTL,
840 CS35L35_BST_CTL_MASK,
841 cs35l35->pdata.bst_vctl);
842
843 if (cs35l35->pdata.bst_ipk)
844 regmap_update_bits(cs35l35->regmap, CS35L35_BST_PEAK_I,
845 CS35L35_BST_IPK_MASK,
846 cs35l35->pdata.bst_ipk <<
847 CS35L35_BST_IPK_SHIFT);
848
849 ret = cs35l35_boost_inductor(cs35l35, cs35l35->pdata.boost_ind);
850 if (ret)
851 return ret;
852
853 if (cs35l35->pdata.gain_zc)
854 regmap_update_bits(cs35l35->regmap, CS35L35_PROTECT_CTL,
855 CS35L35_AMP_GAIN_ZC_MASK,
856 cs35l35->pdata.gain_zc <<
857 CS35L35_AMP_GAIN_ZC_SHIFT);
858
859 if (cs35l35->pdata.aud_channel)
860 regmap_update_bits(cs35l35->regmap,
861 CS35L35_AUDIN_RXLOC_CTL,
862 CS35L35_AUD_IN_LR_MASK,
863 cs35l35->pdata.aud_channel <<
864 CS35L35_AUD_IN_LR_SHIFT);
865
866 if (cs35l35->pdata.stereo) {
867 regmap_update_bits(cs35l35->regmap,
868 CS35L35_ADVIN_RXLOC_CTL,
869 CS35L35_ADV_IN_LR_MASK,
870 cs35l35->pdata.adv_channel <<
871 CS35L35_ADV_IN_LR_SHIFT);
872 if (cs35l35->pdata.shared_bst)
873 regmap_update_bits(cs35l35->regmap, CS35L35_CLASS_H_CTL,
874 CS35L35_CH_STEREO_MASK,
875 1 << CS35L35_CH_STEREO_SHIFT);
876 ret = snd_soc_add_component_controls(component, cs35l35_adv_controls,
877 ARRAY_SIZE(cs35l35_adv_controls));
878 if (ret)
879 return ret;
880 }
881
882 if (cs35l35->pdata.sp_drv_str)
883 regmap_update_bits(cs35l35->regmap, CS35L35_CLK_CTL1,
884 CS35L35_SP_DRV_MASK,
885 cs35l35->pdata.sp_drv_str <<
886 CS35L35_SP_DRV_SHIFT);
887 if (cs35l35->pdata.sp_drv_unused)
888 regmap_update_bits(cs35l35->regmap, CS35L35_SP_FMT_CTL3,
889 CS35L35_SP_I2S_DRV_MASK,
890 cs35l35->pdata.sp_drv_unused <<
891 CS35L35_SP_I2S_DRV_SHIFT);
892
893 if (classh->classh_algo_enable) {
894 if (classh->classh_bst_override)
895 regmap_update_bits(cs35l35->regmap,
896 CS35L35_CLASS_H_CTL,
897 CS35L35_CH_BST_OVR_MASK,
898 classh->classh_bst_override <<
899 CS35L35_CH_BST_OVR_SHIFT);
900 if (classh->classh_bst_max_limit)
901 regmap_update_bits(cs35l35->regmap,
902 CS35L35_CLASS_H_CTL,
903 CS35L35_CH_BST_LIM_MASK,
904 classh->classh_bst_max_limit <<
905 CS35L35_CH_BST_LIM_SHIFT);
906 if (classh->classh_mem_depth)
907 regmap_update_bits(cs35l35->regmap,
908 CS35L35_CLASS_H_CTL,
909 CS35L35_CH_MEM_DEPTH_MASK,
910 classh->classh_mem_depth <<
911 CS35L35_CH_MEM_DEPTH_SHIFT);
912 if (classh->classh_headroom)
913 regmap_update_bits(cs35l35->regmap,
914 CS35L35_CLASS_H_HEADRM_CTL,
915 CS35L35_CH_HDRM_CTL_MASK,
916 classh->classh_headroom <<
917 CS35L35_CH_HDRM_CTL_SHIFT);
918 if (classh->classh_release_rate)
919 regmap_update_bits(cs35l35->regmap,
920 CS35L35_CLASS_H_RELEASE_RATE,
921 CS35L35_CH_REL_RATE_MASK,
922 classh->classh_release_rate <<
923 CS35L35_CH_REL_RATE_SHIFT);
924 if (classh->classh_wk_fet_disable)
925 regmap_update_bits(cs35l35->regmap,
926 CS35L35_CLASS_H_FET_DRIVE_CTL,
927 CS35L35_CH_WKFET_DIS_MASK,
928 classh->classh_wk_fet_disable <<
929 CS35L35_CH_WKFET_DIS_SHIFT);
930 if (classh->classh_wk_fet_delay)
931 regmap_update_bits(cs35l35->regmap,
932 CS35L35_CLASS_H_FET_DRIVE_CTL,
933 CS35L35_CH_WKFET_DEL_MASK,
934 classh->classh_wk_fet_delay <<
935 CS35L35_CH_WKFET_DEL_SHIFT);
936 if (classh->classh_wk_fet_thld)
937 regmap_update_bits(cs35l35->regmap,
938 CS35L35_CLASS_H_FET_DRIVE_CTL,
939 CS35L35_CH_WKFET_THLD_MASK,
940 classh->classh_wk_fet_thld <<
941 CS35L35_CH_WKFET_THLD_SHIFT);
942 if (classh->classh_vpch_auto)
943 regmap_update_bits(cs35l35->regmap,
944 CS35L35_CLASS_H_VP_CTL,
945 CS35L35_CH_VP_AUTO_MASK,
946 classh->classh_vpch_auto <<
947 CS35L35_CH_VP_AUTO_SHIFT);
948 if (classh->classh_vpch_rate)
949 regmap_update_bits(cs35l35->regmap,
950 CS35L35_CLASS_H_VP_CTL,
951 CS35L35_CH_VP_RATE_MASK,
952 classh->classh_vpch_rate <<
953 CS35L35_CH_VP_RATE_SHIFT);
954 if (classh->classh_vpch_man)
955 regmap_update_bits(cs35l35->regmap,
956 CS35L35_CLASS_H_VP_CTL,
957 CS35L35_CH_VP_MAN_MASK,
958 classh->classh_vpch_man <<
959 CS35L35_CH_VP_MAN_SHIFT);
960 }
961
962 if (monitor_config->is_present) {
963 if (monitor_config->vmon_specs) {
964 regmap_update_bits(cs35l35->regmap,
965 CS35L35_SPKMON_DEPTH_CTL,
966 CS35L35_VMON_DEPTH_MASK,
967 monitor_config->vmon_dpth <<
968 CS35L35_VMON_DEPTH_SHIFT);
969 regmap_update_bits(cs35l35->regmap,
970 CS35L35_VMON_TXLOC_CTL,
971 CS35L35_MON_TXLOC_MASK,
972 monitor_config->vmon_loc <<
973 CS35L35_MON_TXLOC_SHIFT);
974 regmap_update_bits(cs35l35->regmap,
975 CS35L35_VMON_TXLOC_CTL,
976 CS35L35_MON_FRM_MASK,
977 monitor_config->vmon_frm <<
978 CS35L35_MON_FRM_SHIFT);
979 }
980 if (monitor_config->imon_specs) {
981 regmap_update_bits(cs35l35->regmap,
982 CS35L35_SPKMON_DEPTH_CTL,
983 CS35L35_IMON_DEPTH_MASK,
984 monitor_config->imon_dpth <<
985 CS35L35_IMON_DEPTH_SHIFT);
986 regmap_update_bits(cs35l35->regmap,
987 CS35L35_IMON_TXLOC_CTL,
988 CS35L35_MON_TXLOC_MASK,
989 monitor_config->imon_loc <<
990 CS35L35_MON_TXLOC_SHIFT);
991 regmap_update_bits(cs35l35->regmap,
992 CS35L35_IMON_TXLOC_CTL,
993 CS35L35_MON_FRM_MASK,
994 monitor_config->imon_frm <<
995 CS35L35_MON_FRM_SHIFT);
996 regmap_update_bits(cs35l35->regmap,
997 CS35L35_IMON_SCALE_CTL,
998 CS35L35_IMON_SCALE_MASK,
999 monitor_config->imon_scale <<
1000 CS35L35_IMON_SCALE_SHIFT);
1001 }
1002 if (monitor_config->vpmon_specs) {
1003 regmap_update_bits(cs35l35->regmap,
1004 CS35L35_SUPMON_DEPTH_CTL,
1005 CS35L35_VPMON_DEPTH_MASK,
1006 monitor_config->vpmon_dpth <<
1007 CS35L35_VPMON_DEPTH_SHIFT);
1008 regmap_update_bits(cs35l35->regmap,
1009 CS35L35_VPMON_TXLOC_CTL,
1010 CS35L35_MON_TXLOC_MASK,
1011 monitor_config->vpmon_loc <<
1012 CS35L35_MON_TXLOC_SHIFT);
1013 regmap_update_bits(cs35l35->regmap,
1014 CS35L35_VPMON_TXLOC_CTL,
1015 CS35L35_MON_FRM_MASK,
1016 monitor_config->vpmon_frm <<
1017 CS35L35_MON_FRM_SHIFT);
1018 }
1019 if (monitor_config->vbstmon_specs) {
1020 regmap_update_bits(cs35l35->regmap,
1021 CS35L35_SUPMON_DEPTH_CTL,
1022 CS35L35_VBSTMON_DEPTH_MASK,
1023 monitor_config->vpmon_dpth <<
1024 CS35L35_VBSTMON_DEPTH_SHIFT);
1025 regmap_update_bits(cs35l35->regmap,
1026 CS35L35_VBSTMON_TXLOC_CTL,
1027 CS35L35_MON_TXLOC_MASK,
1028 monitor_config->vbstmon_loc <<
1029 CS35L35_MON_TXLOC_SHIFT);
1030 regmap_update_bits(cs35l35->regmap,
1031 CS35L35_VBSTMON_TXLOC_CTL,
1032 CS35L35_MON_FRM_MASK,
1033 monitor_config->vbstmon_frm <<
1034 CS35L35_MON_FRM_SHIFT);
1035 }
1036 if (monitor_config->vpbrstat_specs) {
1037 regmap_update_bits(cs35l35->regmap,
1038 CS35L35_SUPMON_DEPTH_CTL,
1039 CS35L35_VPBRSTAT_DEPTH_MASK,
1040 monitor_config->vpbrstat_dpth <<
1041 CS35L35_VPBRSTAT_DEPTH_SHIFT);
1042 regmap_update_bits(cs35l35->regmap,
1043 CS35L35_VPBR_STATUS_TXLOC_CTL,
1044 CS35L35_MON_TXLOC_MASK,
1045 monitor_config->vpbrstat_loc <<
1046 CS35L35_MON_TXLOC_SHIFT);
1047 regmap_update_bits(cs35l35->regmap,
1048 CS35L35_VPBR_STATUS_TXLOC_CTL,
1049 CS35L35_MON_FRM_MASK,
1050 monitor_config->vpbrstat_frm <<
1051 CS35L35_MON_FRM_SHIFT);
1052 }
1053 if (monitor_config->zerofill_specs) {
1054 regmap_update_bits(cs35l35->regmap,
1055 CS35L35_SUPMON_DEPTH_CTL,
1056 CS35L35_ZEROFILL_DEPTH_MASK,
1057 monitor_config->zerofill_dpth <<
1058 CS35L35_ZEROFILL_DEPTH_SHIFT);
1059 regmap_update_bits(cs35l35->regmap,
1060 CS35L35_ZERO_FILL_LOC_CTL,
1061 CS35L35_MON_TXLOC_MASK,
1062 monitor_config->zerofill_loc <<
1063 CS35L35_MON_TXLOC_SHIFT);
1064 regmap_update_bits(cs35l35->regmap,
1065 CS35L35_ZERO_FILL_LOC_CTL,
1066 CS35L35_MON_FRM_MASK,
1067 monitor_config->zerofill_frm <<
1068 CS35L35_MON_FRM_SHIFT);
1069 }
1070 }
1071
1072 return 0;
1073 }
1074
1075 static const struct snd_soc_component_driver soc_component_dev_cs35l35 = {
1076 .probe = cs35l35_component_probe,
1077 .set_sysclk = cs35l35_component_set_sysclk,
1078 .dapm_widgets = cs35l35_dapm_widgets,
1079 .num_dapm_widgets = ARRAY_SIZE(cs35l35_dapm_widgets),
1080 .dapm_routes = cs35l35_audio_map,
1081 .num_dapm_routes = ARRAY_SIZE(cs35l35_audio_map),
1082 .controls = cs35l35_aud_controls,
1083 .num_controls = ARRAY_SIZE(cs35l35_aud_controls),
1084 .idle_bias_on = 1,
1085 .use_pmdown_time = 1,
1086 .endianness = 1,
1087 };
1088
1089 static const struct regmap_config cs35l35_regmap = {
1090 .reg_bits = 8,
1091 .val_bits = 8,
1092
1093 .max_register = CS35L35_MAX_REGISTER,
1094 .reg_defaults = cs35l35_reg,
1095 .num_reg_defaults = ARRAY_SIZE(cs35l35_reg),
1096 .volatile_reg = cs35l35_volatile_register,
1097 .readable_reg = cs35l35_readable_register,
1098 .precious_reg = cs35l35_precious_register,
1099 .cache_type = REGCACHE_MAPLE,
1100 .use_single_read = true,
1101 .use_single_write = true,
1102 };
1103
cs35l35_irq(int irq,void * data)1104 static irqreturn_t cs35l35_irq(int irq, void *data)
1105 {
1106 struct cs35l35_private *cs35l35 = data;
1107 unsigned int sticky1, sticky2, sticky3, sticky4;
1108 unsigned int mask1, mask2, mask3, mask4, current1;
1109
1110 /* ack the irq by reading all status registers */
1111 regmap_read(cs35l35->regmap, CS35L35_INT_STATUS_4, &sticky4);
1112 regmap_read(cs35l35->regmap, CS35L35_INT_STATUS_3, &sticky3);
1113 regmap_read(cs35l35->regmap, CS35L35_INT_STATUS_2, &sticky2);
1114 regmap_read(cs35l35->regmap, CS35L35_INT_STATUS_1, &sticky1);
1115
1116 regmap_read(cs35l35->regmap, CS35L35_INT_MASK_4, &mask4);
1117 regmap_read(cs35l35->regmap, CS35L35_INT_MASK_3, &mask3);
1118 regmap_read(cs35l35->regmap, CS35L35_INT_MASK_2, &mask2);
1119 regmap_read(cs35l35->regmap, CS35L35_INT_MASK_1, &mask1);
1120
1121 /* Check to see if unmasked bits are active */
1122 if (!(sticky1 & ~mask1) && !(sticky2 & ~mask2) && !(sticky3 & ~mask3)
1123 && !(sticky4 & ~mask4))
1124 return IRQ_NONE;
1125
1126 if (sticky2 & CS35L35_PDN_DONE)
1127 complete(&cs35l35->pdn_done);
1128
1129 /* read the current values */
1130 regmap_read(cs35l35->regmap, CS35L35_INT_STATUS_1, ¤t1);
1131
1132 /* handle the interrupts */
1133 if (sticky1 & CS35L35_CAL_ERR) {
1134 dev_crit(cs35l35->dev, "Calibration Error\n");
1135
1136 /* error is no longer asserted; safe to reset */
1137 if (!(current1 & CS35L35_CAL_ERR)) {
1138 pr_debug("%s : Cal error release\n", __func__);
1139 regmap_update_bits(cs35l35->regmap,
1140 CS35L35_PROT_RELEASE_CTL,
1141 CS35L35_CAL_ERR_RLS, 0);
1142 regmap_update_bits(cs35l35->regmap,
1143 CS35L35_PROT_RELEASE_CTL,
1144 CS35L35_CAL_ERR_RLS,
1145 CS35L35_CAL_ERR_RLS);
1146 regmap_update_bits(cs35l35->regmap,
1147 CS35L35_PROT_RELEASE_CTL,
1148 CS35L35_CAL_ERR_RLS, 0);
1149 }
1150 }
1151
1152 if (sticky1 & CS35L35_AMP_SHORT) {
1153 dev_crit(cs35l35->dev, "AMP Short Error\n");
1154 /* error is no longer asserted; safe to reset */
1155 if (!(current1 & CS35L35_AMP_SHORT)) {
1156 dev_dbg(cs35l35->dev, "Amp short error release\n");
1157 regmap_update_bits(cs35l35->regmap,
1158 CS35L35_PROT_RELEASE_CTL,
1159 CS35L35_SHORT_RLS, 0);
1160 regmap_update_bits(cs35l35->regmap,
1161 CS35L35_PROT_RELEASE_CTL,
1162 CS35L35_SHORT_RLS,
1163 CS35L35_SHORT_RLS);
1164 regmap_update_bits(cs35l35->regmap,
1165 CS35L35_PROT_RELEASE_CTL,
1166 CS35L35_SHORT_RLS, 0);
1167 }
1168 }
1169
1170 if (sticky1 & CS35L35_OTW) {
1171 dev_warn(cs35l35->dev, "Over temperature warning\n");
1172
1173 /* error is no longer asserted; safe to reset */
1174 if (!(current1 & CS35L35_OTW)) {
1175 dev_dbg(cs35l35->dev, "Over temperature warn release\n");
1176 regmap_update_bits(cs35l35->regmap,
1177 CS35L35_PROT_RELEASE_CTL,
1178 CS35L35_OTW_RLS, 0);
1179 regmap_update_bits(cs35l35->regmap,
1180 CS35L35_PROT_RELEASE_CTL,
1181 CS35L35_OTW_RLS,
1182 CS35L35_OTW_RLS);
1183 regmap_update_bits(cs35l35->regmap,
1184 CS35L35_PROT_RELEASE_CTL,
1185 CS35L35_OTW_RLS, 0);
1186 }
1187 }
1188
1189 if (sticky1 & CS35L35_OTE) {
1190 dev_crit(cs35l35->dev, "Over temperature error\n");
1191 /* error is no longer asserted; safe to reset */
1192 if (!(current1 & CS35L35_OTE)) {
1193 dev_dbg(cs35l35->dev, "Over temperature error release\n");
1194 regmap_update_bits(cs35l35->regmap,
1195 CS35L35_PROT_RELEASE_CTL,
1196 CS35L35_OTE_RLS, 0);
1197 regmap_update_bits(cs35l35->regmap,
1198 CS35L35_PROT_RELEASE_CTL,
1199 CS35L35_OTE_RLS,
1200 CS35L35_OTE_RLS);
1201 regmap_update_bits(cs35l35->regmap,
1202 CS35L35_PROT_RELEASE_CTL,
1203 CS35L35_OTE_RLS, 0);
1204 }
1205 }
1206
1207 if (sticky3 & CS35L35_BST_HIGH) {
1208 dev_crit(cs35l35->dev, "VBST error: powering off!\n");
1209 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
1210 CS35L35_PDN_AMP, CS35L35_PDN_AMP);
1211 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL1,
1212 CS35L35_PDN_ALL, CS35L35_PDN_ALL);
1213 }
1214
1215 if (sticky3 & CS35L35_LBST_SHORT) {
1216 dev_crit(cs35l35->dev, "LBST error: powering off!\n");
1217 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
1218 CS35L35_PDN_AMP, CS35L35_PDN_AMP);
1219 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL1,
1220 CS35L35_PDN_ALL, CS35L35_PDN_ALL);
1221 }
1222
1223 if (sticky2 & CS35L35_VPBR_ERR)
1224 dev_dbg(cs35l35->dev, "Error: Reactive Brownout\n");
1225
1226 if (sticky4 & CS35L35_VMON_OVFL)
1227 dev_dbg(cs35l35->dev, "Error: VMON overflow\n");
1228
1229 if (sticky4 & CS35L35_IMON_OVFL)
1230 dev_dbg(cs35l35->dev, "Error: IMON overflow\n");
1231
1232 return IRQ_HANDLED;
1233 }
1234
1235
cs35l35_handle_of_data(struct i2c_client * i2c_client,struct cs35l35_platform_data * pdata)1236 static int cs35l35_handle_of_data(struct i2c_client *i2c_client,
1237 struct cs35l35_platform_data *pdata)
1238 {
1239 struct device_node *np = i2c_client->dev.of_node;
1240 struct device_node *classh, *signal_format;
1241 struct classh_cfg *classh_config = &pdata->classh_algo;
1242 struct monitor_cfg *monitor_config = &pdata->mon_cfg;
1243 unsigned int val32 = 0;
1244 u8 monitor_array[4];
1245 const int imon_array_size = ARRAY_SIZE(monitor_array);
1246 const int mon_array_size = imon_array_size - 1;
1247 int ret = 0;
1248
1249 if (!np)
1250 return 0;
1251
1252 pdata->bst_pdn_fet_on = of_property_read_bool(np,
1253 "cirrus,boost-pdn-fet-on");
1254
1255 ret = of_property_read_u32(np, "cirrus,boost-ctl-millivolt", &val32);
1256 if (ret >= 0) {
1257 if (val32 < 2600 || val32 > 9000) {
1258 dev_err(&i2c_client->dev,
1259 "Invalid Boost Voltage %d mV\n", val32);
1260 return -EINVAL;
1261 }
1262 pdata->bst_vctl = ((val32 - 2600) / 100) + 1;
1263 }
1264
1265 ret = of_property_read_u32(np, "cirrus,boost-peak-milliamp", &val32);
1266 if (ret >= 0) {
1267 if (val32 < 1680 || val32 > 4480) {
1268 dev_err(&i2c_client->dev,
1269 "Invalid Boost Peak Current %u mA\n", val32);
1270 return -EINVAL;
1271 }
1272
1273 pdata->bst_ipk = ((val32 - 1680) / 110) | CS35L35_VALID_PDATA;
1274 }
1275
1276 ret = of_property_read_u32(np, "cirrus,boost-ind-nanohenry", &val32);
1277 if (ret >= 0) {
1278 pdata->boost_ind = val32;
1279 } else {
1280 dev_err(&i2c_client->dev, "Inductor not specified.\n");
1281 return -EINVAL;
1282 }
1283
1284 if (of_property_read_u32(np, "cirrus,sp-drv-strength", &val32) >= 0)
1285 pdata->sp_drv_str = val32;
1286 if (of_property_read_u32(np, "cirrus,sp-drv-unused", &val32) >= 0)
1287 pdata->sp_drv_unused = val32 | CS35L35_VALID_PDATA;
1288
1289 pdata->stereo = of_property_read_bool(np, "cirrus,stereo-config");
1290
1291 if (pdata->stereo) {
1292 ret = of_property_read_u32(np, "cirrus,audio-channel", &val32);
1293 if (ret >= 0)
1294 pdata->aud_channel = val32;
1295
1296 ret = of_property_read_u32(np, "cirrus,advisory-channel",
1297 &val32);
1298 if (ret >= 0)
1299 pdata->adv_channel = val32;
1300
1301 pdata->shared_bst = of_property_read_bool(np,
1302 "cirrus,shared-boost");
1303 }
1304
1305 pdata->ext_bst = of_property_read_bool(np, "cirrus,external-boost");
1306
1307 pdata->gain_zc = of_property_read_bool(np, "cirrus,amp-gain-zc");
1308
1309 classh = of_get_child_by_name(np, "cirrus,classh-internal-algo");
1310 classh_config->classh_algo_enable = (classh != NULL);
1311
1312 if (classh_config->classh_algo_enable) {
1313 classh_config->classh_bst_override =
1314 of_property_read_bool(np, "cirrus,classh-bst-overide");
1315
1316 ret = of_property_read_u32(classh,
1317 "cirrus,classh-bst-max-limit",
1318 &val32);
1319 if (ret >= 0) {
1320 val32 |= CS35L35_VALID_PDATA;
1321 classh_config->classh_bst_max_limit = val32;
1322 }
1323
1324 ret = of_property_read_u32(classh,
1325 "cirrus,classh-bst-max-limit",
1326 &val32);
1327 if (ret >= 0) {
1328 val32 |= CS35L35_VALID_PDATA;
1329 classh_config->classh_bst_max_limit = val32;
1330 }
1331
1332 ret = of_property_read_u32(classh, "cirrus,classh-mem-depth",
1333 &val32);
1334 if (ret >= 0) {
1335 val32 |= CS35L35_VALID_PDATA;
1336 classh_config->classh_mem_depth = val32;
1337 }
1338
1339 ret = of_property_read_u32(classh, "cirrus,classh-release-rate",
1340 &val32);
1341 if (ret >= 0)
1342 classh_config->classh_release_rate = val32;
1343
1344 ret = of_property_read_u32(classh, "cirrus,classh-headroom",
1345 &val32);
1346 if (ret >= 0) {
1347 val32 |= CS35L35_VALID_PDATA;
1348 classh_config->classh_headroom = val32;
1349 }
1350
1351 ret = of_property_read_u32(classh,
1352 "cirrus,classh-wk-fet-disable",
1353 &val32);
1354 if (ret >= 0)
1355 classh_config->classh_wk_fet_disable = val32;
1356
1357 ret = of_property_read_u32(classh, "cirrus,classh-wk-fet-delay",
1358 &val32);
1359 if (ret >= 0) {
1360 val32 |= CS35L35_VALID_PDATA;
1361 classh_config->classh_wk_fet_delay = val32;
1362 }
1363
1364 ret = of_property_read_u32(classh, "cirrus,classh-wk-fet-thld",
1365 &val32);
1366 if (ret >= 0)
1367 classh_config->classh_wk_fet_thld = val32;
1368
1369 ret = of_property_read_u32(classh, "cirrus,classh-vpch-auto",
1370 &val32);
1371 if (ret >= 0) {
1372 val32 |= CS35L35_VALID_PDATA;
1373 classh_config->classh_vpch_auto = val32;
1374 }
1375
1376 ret = of_property_read_u32(classh, "cirrus,classh-vpch-rate",
1377 &val32);
1378 if (ret >= 0) {
1379 val32 |= CS35L35_VALID_PDATA;
1380 classh_config->classh_vpch_rate = val32;
1381 }
1382
1383 ret = of_property_read_u32(classh, "cirrus,classh-vpch-man",
1384 &val32);
1385 if (ret >= 0)
1386 classh_config->classh_vpch_man = val32;
1387 }
1388 of_node_put(classh);
1389
1390 /* frame depth location */
1391 signal_format = of_get_child_by_name(np, "cirrus,monitor-signal-format");
1392 monitor_config->is_present = signal_format ? true : false;
1393 if (monitor_config->is_present) {
1394 ret = of_property_read_u8_array(signal_format, "cirrus,imon",
1395 monitor_array, imon_array_size);
1396 if (!ret) {
1397 monitor_config->imon_specs = true;
1398 monitor_config->imon_dpth = monitor_array[0];
1399 monitor_config->imon_loc = monitor_array[1];
1400 monitor_config->imon_frm = monitor_array[2];
1401 monitor_config->imon_scale = monitor_array[3];
1402 }
1403 ret = of_property_read_u8_array(signal_format, "cirrus,vmon",
1404 monitor_array, mon_array_size);
1405 if (!ret) {
1406 monitor_config->vmon_specs = true;
1407 monitor_config->vmon_dpth = monitor_array[0];
1408 monitor_config->vmon_loc = monitor_array[1];
1409 monitor_config->vmon_frm = monitor_array[2];
1410 }
1411 ret = of_property_read_u8_array(signal_format, "cirrus,vpmon",
1412 monitor_array, mon_array_size);
1413 if (!ret) {
1414 monitor_config->vpmon_specs = true;
1415 monitor_config->vpmon_dpth = monitor_array[0];
1416 monitor_config->vpmon_loc = monitor_array[1];
1417 monitor_config->vpmon_frm = monitor_array[2];
1418 }
1419 ret = of_property_read_u8_array(signal_format, "cirrus,vbstmon",
1420 monitor_array, mon_array_size);
1421 if (!ret) {
1422 monitor_config->vbstmon_specs = true;
1423 monitor_config->vbstmon_dpth = monitor_array[0];
1424 monitor_config->vbstmon_loc = monitor_array[1];
1425 monitor_config->vbstmon_frm = monitor_array[2];
1426 }
1427 ret = of_property_read_u8_array(signal_format, "cirrus,vpbrstat",
1428 monitor_array, mon_array_size);
1429 if (!ret) {
1430 monitor_config->vpbrstat_specs = true;
1431 monitor_config->vpbrstat_dpth = monitor_array[0];
1432 monitor_config->vpbrstat_loc = monitor_array[1];
1433 monitor_config->vpbrstat_frm = monitor_array[2];
1434 }
1435 ret = of_property_read_u8_array(signal_format, "cirrus,zerofill",
1436 monitor_array, mon_array_size);
1437 if (!ret) {
1438 monitor_config->zerofill_specs = true;
1439 monitor_config->zerofill_dpth = monitor_array[0];
1440 monitor_config->zerofill_loc = monitor_array[1];
1441 monitor_config->zerofill_frm = monitor_array[2];
1442 }
1443 }
1444 of_node_put(signal_format);
1445
1446 return 0;
1447 }
1448
1449 /* Errata Rev A0 */
1450 static const struct reg_sequence cs35l35_errata_patch[] = {
1451
1452 { 0x7F, 0x99 },
1453 { 0x00, 0x99 },
1454 { 0x52, 0x22 },
1455 { 0x04, 0x14 },
1456 { 0x6D, 0x44 },
1457 { 0x24, 0x10 },
1458 { 0x58, 0xC4 },
1459 { 0x00, 0x98 },
1460 { 0x18, 0x08 },
1461 { 0x00, 0x00 },
1462 { 0x7F, 0x00 },
1463 };
1464
cs35l35_i2c_probe(struct i2c_client * i2c_client)1465 static int cs35l35_i2c_probe(struct i2c_client *i2c_client)
1466 {
1467 struct cs35l35_private *cs35l35;
1468 struct device *dev = &i2c_client->dev;
1469 struct cs35l35_platform_data *pdata = dev_get_platdata(dev);
1470 int i, devid;
1471 int ret;
1472 unsigned int reg;
1473
1474 cs35l35 = devm_kzalloc(dev, sizeof(struct cs35l35_private), GFP_KERNEL);
1475 if (!cs35l35)
1476 return -ENOMEM;
1477
1478 cs35l35->dev = dev;
1479
1480 i2c_set_clientdata(i2c_client, cs35l35);
1481 cs35l35->regmap = devm_regmap_init_i2c(i2c_client, &cs35l35_regmap);
1482 if (IS_ERR(cs35l35->regmap)) {
1483 ret = PTR_ERR(cs35l35->regmap);
1484 dev_err(dev, "regmap_init() failed: %d\n", ret);
1485 return ret;
1486 }
1487
1488 for (i = 0; i < ARRAY_SIZE(cs35l35_supplies); i++)
1489 cs35l35->supplies[i].supply = cs35l35_supplies[i];
1490
1491 cs35l35->num_supplies = ARRAY_SIZE(cs35l35_supplies);
1492
1493 ret = devm_regulator_bulk_get(dev, cs35l35->num_supplies,
1494 cs35l35->supplies);
1495 if (ret != 0) {
1496 dev_err(dev, "Failed to request core supplies: %d\n", ret);
1497 return ret;
1498 }
1499
1500 if (pdata) {
1501 cs35l35->pdata = *pdata;
1502 } else {
1503 pdata = devm_kzalloc(dev, sizeof(struct cs35l35_platform_data),
1504 GFP_KERNEL);
1505 if (!pdata)
1506 return -ENOMEM;
1507 if (i2c_client->dev.of_node) {
1508 ret = cs35l35_handle_of_data(i2c_client, pdata);
1509 if (ret != 0)
1510 return ret;
1511
1512 }
1513 cs35l35->pdata = *pdata;
1514 }
1515
1516 ret = regulator_bulk_enable(cs35l35->num_supplies,
1517 cs35l35->supplies);
1518 if (ret != 0) {
1519 dev_err(dev, "Failed to enable core supplies: %d\n", ret);
1520 return ret;
1521 }
1522
1523 /* returning NULL can be valid if in stereo mode */
1524 cs35l35->reset_gpio = devm_gpiod_get_optional(dev, "reset",
1525 GPIOD_OUT_LOW);
1526 if (IS_ERR(cs35l35->reset_gpio)) {
1527 ret = PTR_ERR(cs35l35->reset_gpio);
1528 cs35l35->reset_gpio = NULL;
1529 if (ret == -EBUSY) {
1530 dev_info(dev,
1531 "Reset line busy, assuming shared reset\n");
1532 } else {
1533 dev_err(dev, "Failed to get reset GPIO: %d\n", ret);
1534 goto err;
1535 }
1536 }
1537
1538 cs35l35_reset(cs35l35);
1539
1540 init_completion(&cs35l35->pdn_done);
1541
1542 ret = devm_request_threaded_irq(dev, i2c_client->irq, NULL, cs35l35_irq,
1543 IRQF_ONESHOT | IRQF_TRIGGER_LOW |
1544 IRQF_SHARED, "cs35l35", cs35l35);
1545 if (ret != 0) {
1546 dev_err(dev, "Failed to request IRQ: %d\n", ret);
1547 goto err;
1548 }
1549 /* initialize codec */
1550 devid = cirrus_read_device_id(cs35l35->regmap, CS35L35_DEVID_AB);
1551 if (devid < 0) {
1552 ret = devid;
1553 dev_err(dev, "Failed to read device ID: %d\n", ret);
1554 goto err;
1555 }
1556
1557 if (devid != CS35L35_CHIP_ID) {
1558 dev_err(dev, "CS35L35 Device ID (%X). Expected ID %X\n",
1559 devid, CS35L35_CHIP_ID);
1560 ret = -ENODEV;
1561 goto err;
1562 }
1563
1564 ret = regmap_read(cs35l35->regmap, CS35L35_REV_ID, ®);
1565 if (ret < 0) {
1566 dev_err(dev, "Get Revision ID failed: %d\n", ret);
1567 goto err;
1568 }
1569
1570 ret = regmap_register_patch(cs35l35->regmap, cs35l35_errata_patch,
1571 ARRAY_SIZE(cs35l35_errata_patch));
1572 if (ret < 0) {
1573 dev_err(dev, "Failed to apply errata patch: %d\n", ret);
1574 goto err;
1575 }
1576
1577 dev_info(dev, "Cirrus Logic CS35L35 (%x), Revision: %02X\n",
1578 devid, reg & 0xFF);
1579
1580 /* Set the INT Masks for critical errors */
1581 regmap_write(cs35l35->regmap, CS35L35_INT_MASK_1,
1582 CS35L35_INT1_CRIT_MASK);
1583 regmap_write(cs35l35->regmap, CS35L35_INT_MASK_2,
1584 CS35L35_INT2_CRIT_MASK);
1585 regmap_write(cs35l35->regmap, CS35L35_INT_MASK_3,
1586 CS35L35_INT3_CRIT_MASK);
1587 regmap_write(cs35l35->regmap, CS35L35_INT_MASK_4,
1588 CS35L35_INT4_CRIT_MASK);
1589
1590 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
1591 CS35L35_PWR2_PDN_MASK,
1592 CS35L35_PWR2_PDN_MASK);
1593
1594 if (cs35l35->pdata.bst_pdn_fet_on)
1595 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
1596 CS35L35_PDN_BST_MASK,
1597 1 << CS35L35_PDN_BST_FETON_SHIFT);
1598 else
1599 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL2,
1600 CS35L35_PDN_BST_MASK,
1601 1 << CS35L35_PDN_BST_FETOFF_SHIFT);
1602
1603 regmap_update_bits(cs35l35->regmap, CS35L35_PWRCTL3,
1604 CS35L35_PWR3_PDN_MASK,
1605 CS35L35_PWR3_PDN_MASK);
1606
1607 regmap_update_bits(cs35l35->regmap, CS35L35_PROTECT_CTL,
1608 CS35L35_AMP_MUTE_MASK, 1 << CS35L35_AMP_MUTE_SHIFT);
1609
1610 ret = devm_snd_soc_register_component(dev, &soc_component_dev_cs35l35,
1611 cs35l35_dai, ARRAY_SIZE(cs35l35_dai));
1612 if (ret < 0) {
1613 dev_err(dev, "Failed to register component: %d\n", ret);
1614 goto err;
1615 }
1616
1617 return 0;
1618
1619 err:
1620 regulator_bulk_disable(cs35l35->num_supplies,
1621 cs35l35->supplies);
1622 gpiod_set_value_cansleep(cs35l35->reset_gpio, 0);
1623
1624 return ret;
1625 }
1626
cs35l35_i2c_remove(struct i2c_client * i2c_client)1627 static void cs35l35_i2c_remove(struct i2c_client *i2c_client)
1628 {
1629 struct cs35l35_private *cs35l35 = i2c_get_clientdata(i2c_client);
1630
1631 regulator_bulk_disable(cs35l35->num_supplies, cs35l35->supplies);
1632 gpiod_set_value_cansleep(cs35l35->reset_gpio, 0);
1633 }
1634
1635 static const struct of_device_id cs35l35_of_match[] = {
1636 {.compatible = "cirrus,cs35l35"},
1637 {},
1638 };
1639 MODULE_DEVICE_TABLE(of, cs35l35_of_match);
1640
1641 static const struct i2c_device_id cs35l35_id[] = {
1642 {"cs35l35"},
1643 {}
1644 };
1645
1646 MODULE_DEVICE_TABLE(i2c, cs35l35_id);
1647
1648 static struct i2c_driver cs35l35_i2c_driver = {
1649 .driver = {
1650 .name = "cs35l35",
1651 .of_match_table = cs35l35_of_match,
1652 },
1653 .id_table = cs35l35_id,
1654 .probe = cs35l35_i2c_probe,
1655 .remove = cs35l35_i2c_remove,
1656 };
1657
1658 module_i2c_driver(cs35l35_i2c_driver);
1659
1660 MODULE_DESCRIPTION("ASoC CS35L35 driver");
1661 MODULE_AUTHOR("Brian Austin, Cirrus Logic Inc, <brian.austin@cirrus.com>");
1662 MODULE_LICENSE("GPL");
1663