projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
vfio/pci: Fix typos in comments
[deliverable/linux.git] / sound / soc / codecs / cs35l33.c
1 /*
2 * cs35l33.c -- CS35L33 ALSA SoC audio driver
3 *
4 * Copyright 2016 Cirrus Logic, Inc.
5 *
6 * Author: Paul Handrigan <paul.handrigan@cirrus.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 *
12 */
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/kernel.h>
16 #include <linux/init.h>
17 #include <linux/delay.h>
18 #include <linux/i2c.h>
19 #include <linux/slab.h>
20 #include <linux/workqueue.h>
21 #include <linux/platform_device.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 <linux/gpio.h>
30 #include <linux/gpio/consumer.h>
31 #include <sound/cs35l33.h>
32 #include <linux/pm_runtime.h>
33 #include <linux/regulator/consumer.h>
34 #include <linux/regulator/machine.h>
35 #include <linux/of_gpio.h>
36 #include <linux/of.h>
37 #include <linux/of_device.h>
38 #include <linux/of_irq.h>
39
40 #include "cs35l33.h"
41
42 #define CS35L33_BOOT_DELAY 50
43
44 struct cs35l33_private {
45 struct snd_soc_codec *codec;
46 struct cs35l33_pdata pdata;
47 struct regmap *regmap;
48 struct gpio_desc *reset_gpio;
49 bool amp_cal;
50 int mclk_int;
51 struct regulator_bulk_data core_supplies[2];
52 int num_core_supplies;
53 bool is_tdm_mode;
54 bool enable_soft_ramp;
55 };
56
57 static const struct reg_default cs35l33_reg[] = {
58 {CS35L33_PWRCTL1, 0x85},
59 {CS35L33_PWRCTL2, 0xFE},
60 {CS35L33_CLK_CTL, 0x0C},
61 {CS35L33_BST_PEAK_CTL, 0x90},
62 {CS35L33_PROTECT_CTL, 0x55},
63 {CS35L33_BST_CTL1, 0x00},
64 {CS35L33_BST_CTL2, 0x01},
65 {CS35L33_ADSP_CTL, 0x00},
66 {CS35L33_ADC_CTL, 0xC8},
67 {CS35L33_DAC_CTL, 0x14},
68 {CS35L33_DIG_VOL_CTL, 0x00},
69 {CS35L33_CLASSD_CTL, 0x04},
70 {CS35L33_AMP_CTL, 0x90},
71 {CS35L33_INT_MASK_1, 0xFF},
72 {CS35L33_INT_MASK_2, 0xFF},
73 {CS35L33_DIAG_LOCK, 0x00},
74 {CS35L33_DIAG_CTRL_1, 0x40},
75 {CS35L33_DIAG_CTRL_2, 0x00},
76 {CS35L33_HG_MEMLDO_CTL, 0x62},
77 {CS35L33_HG_REL_RATE, 0x03},
78 {CS35L33_LDO_DEL, 0x12},
79 {CS35L33_HG_HEAD, 0x0A},
80 {CS35L33_HG_EN, 0x05},
81 {CS35L33_TX_VMON, 0x00},
82 {CS35L33_TX_IMON, 0x03},
83 {CS35L33_TX_VPMON, 0x02},
84 {CS35L33_TX_VBSTMON, 0x05},
85 {CS35L33_TX_FLAG, 0x06},
86 {CS35L33_TX_EN1, 0x00},
87 {CS35L33_TX_EN2, 0x00},
88 {CS35L33_TX_EN3, 0x00},
89 {CS35L33_TX_EN4, 0x00},
90 {CS35L33_RX_AUD, 0x40},
91 {CS35L33_RX_SPLY, 0x03},
92 {CS35L33_RX_ALIVE, 0x04},
93 {CS35L33_BST_CTL4, 0x63},
94 };
95
96 static const struct reg_sequence cs35l33_patch[] = {
97 { 0x00, 0x99, 0 },
98 { 0x59, 0x02, 0 },
99 { 0x52, 0x30, 0 },
100 { 0x39, 0x45, 0 },
101 { 0x57, 0x30, 0 },
102 { 0x2C, 0x68, 0 },
103 { 0x00, 0x00, 0 },
104 };
105
106 static bool cs35l33_volatile_register(struct device *dev, unsigned int reg)
107 {
108 switch (reg) {
109 case CS35L33_DEVID_AB:
110 case CS35L33_DEVID_CD:
111 case CS35L33_DEVID_E:
112 case CS35L33_REV_ID:
113 case CS35L33_INT_STATUS_1:
114 case CS35L33_INT_STATUS_2:
115 case CS35L33_HG_STATUS:
116 return true;
117 default:
118 return false;
119 }
120 }
121
122 static bool cs35l33_writeable_register(struct device *dev, unsigned int reg)
123 {
124 switch (reg) {
125 /* these are read only registers */
126 case CS35L33_DEVID_AB:
127 case CS35L33_DEVID_CD:
128 case CS35L33_DEVID_E:
129 case CS35L33_REV_ID:
130 case CS35L33_INT_STATUS_1:
131 case CS35L33_INT_STATUS_2:
132 case CS35L33_HG_STATUS:
133 return false;
134 default:
135 return true;
136 }
137 }
138
139 static bool cs35l33_readable_register(struct device *dev, unsigned int reg)
140 {
141 switch (reg) {
142 case CS35L33_DEVID_AB:
143 case CS35L33_DEVID_CD:
144 case CS35L33_DEVID_E:
145 case CS35L33_REV_ID:
146 case CS35L33_PWRCTL1:
147 case CS35L33_PWRCTL2:
148 case CS35L33_CLK_CTL:
149 case CS35L33_BST_PEAK_CTL:
150 case CS35L33_PROTECT_CTL:
151 case CS35L33_BST_CTL1:
152 case CS35L33_BST_CTL2:
153 case CS35L33_ADSP_CTL:
154 case CS35L33_ADC_CTL:
155 case CS35L33_DAC_CTL:
156 case CS35L33_DIG_VOL_CTL:
157 case CS35L33_CLASSD_CTL:
158 case CS35L33_AMP_CTL:
159 case CS35L33_INT_MASK_1:
160 case CS35L33_INT_MASK_2:
161 case CS35L33_INT_STATUS_1:
162 case CS35L33_INT_STATUS_2:
163 case CS35L33_DIAG_LOCK:
164 case CS35L33_DIAG_CTRL_1:
165 case CS35L33_DIAG_CTRL_2:
166 case CS35L33_HG_MEMLDO_CTL:
167 case CS35L33_HG_REL_RATE:
168 case CS35L33_LDO_DEL:
169 case CS35L33_HG_HEAD:
170 case CS35L33_HG_EN:
171 case CS35L33_TX_VMON:
172 case CS35L33_TX_IMON:
173 case CS35L33_TX_VPMON:
174 case CS35L33_TX_VBSTMON:
175 case CS35L33_TX_FLAG:
176 case CS35L33_TX_EN1:
177 case CS35L33_TX_EN2:
178 case CS35L33_TX_EN3:
179 case CS35L33_TX_EN4:
180 case CS35L33_RX_AUD:
181 case CS35L33_RX_SPLY:
182 case CS35L33_RX_ALIVE:
183 case CS35L33_BST_CTL4:
184 return true;
185 default:
186 return false;
187 }
188 }
189
190 static DECLARE_TLV_DB_SCALE(classd_ctl_tlv, 900, 100, 0);
191 static DECLARE_TLV_DB_SCALE(dac_tlv, -10200, 50, 0);
192
193 static const struct snd_kcontrol_new cs35l33_snd_controls[] = {
194
195 SOC_SINGLE_TLV("SPK Amp Volume", CS35L33_AMP_CTL,
196 4, 0x09, 0, classd_ctl_tlv),
197 SOC_SINGLE_SX_TLV("DAC Volume", CS35L33_DIG_VOL_CTL,
198 0, 0x34, 0xE4, dac_tlv),
199 };
200
201 static int cs35l33_spkrdrv_event(struct snd_soc_dapm_widget *w,
202 struct snd_kcontrol *kcontrol, int event)
203 {
204 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
205 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
206
207 switch (event) {
208 case SND_SOC_DAPM_POST_PMU:
209 if (!priv->amp_cal) {
210 usleep_range(8000, 9000);
211 priv->amp_cal = true;
212 regmap_update_bits(priv->regmap, CS35L33_CLASSD_CTL,
213 CS35L33_AMP_CAL, 0);
214 dev_dbg(codec->dev, "Amp calibration done\n");
215 }
216 dev_dbg(codec->dev, "Amp turned on\n");
217 break;
218 case SND_SOC_DAPM_POST_PMD:
219 dev_dbg(codec->dev, "Amp turned off\n");
220 break;
221 default:
222 dev_err(codec->dev, "Invalid event = 0x%x\n", event);
223 break;
224 }
225
226 return 0;
227 }
228
229 static int cs35l33_sdin_event(struct snd_soc_dapm_widget *w,
230 struct snd_kcontrol *kcontrol, int event)
231 {
232 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
233 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
234 unsigned int val;
235
236 switch (event) {
237 case SND_SOC_DAPM_PRE_PMU:
238 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
239 CS35L33_PDN_BST, 0);
240 val = priv->is_tdm_mode ? 0 : CS35L33_PDN_TDM;
241 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
242 CS35L33_PDN_TDM, val);
243 dev_dbg(codec->dev, "BST turned on\n");
244 break;
245 case SND_SOC_DAPM_POST_PMU:
246 dev_dbg(codec->dev, "SDIN turned on\n");
247 if (!priv->amp_cal) {
248 regmap_update_bits(priv->regmap, CS35L33_CLASSD_CTL,
249 CS35L33_AMP_CAL, CS35L33_AMP_CAL);
250 dev_dbg(codec->dev, "Amp calibration started\n");
251 usleep_range(10000, 11000);
252 }
253 break;
254 case SND_SOC_DAPM_POST_PMD:
255 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
256 CS35L33_PDN_TDM, CS35L33_PDN_TDM);
257 usleep_range(4000, 4100);
258 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
259 CS35L33_PDN_BST, CS35L33_PDN_BST);
260 dev_dbg(codec->dev, "BST and SDIN turned off\n");
261 break;
262 default:
263 dev_err(codec->dev, "Invalid event = 0x%x\n", event);
264
265 }
266
267 return 0;
268 }
269
270 static int cs35l33_sdout_event(struct snd_soc_dapm_widget *w,
271 struct snd_kcontrol *kcontrol, int event)
272 {
273 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
274 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
275 unsigned int mask = CS35L33_SDOUT_3ST_I2S | CS35L33_PDN_TDM;
276 unsigned int mask2 = CS35L33_SDOUT_3ST_TDM;
277 unsigned int val, val2;
278
279 switch (event) {
280 case SND_SOC_DAPM_PRE_PMU:
281 if (priv->is_tdm_mode) {
282 /* set sdout_3st_i2s and reset pdn_tdm */
283 val = CS35L33_SDOUT_3ST_I2S;
284 /* reset sdout_3st_tdm */
285 val2 = 0;
286 } else {
287 /* reset sdout_3st_i2s and set pdn_tdm */
288 val = CS35L33_PDN_TDM;
289 /* set sdout_3st_tdm */
290 val2 = CS35L33_SDOUT_3ST_TDM;
291 }
292 dev_dbg(codec->dev, "SDOUT turned on\n");
293 break;
294 case SND_SOC_DAPM_PRE_PMD:
295 val = CS35L33_SDOUT_3ST_I2S | CS35L33_PDN_TDM;
296 val2 = CS35L33_SDOUT_3ST_TDM;
297 dev_dbg(codec->dev, "SDOUT turned off\n");
298 break;
299 default:
300 dev_err(codec->dev, "Invalid event = 0x%x\n", event);
301 return 0;
302 }
303
304 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
305 mask, val);
306 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
307 mask2, val2);
308
309 return 0;
310 }
311
312 static const struct snd_soc_dapm_widget cs35l33_dapm_widgets[] = {
313
314 SND_SOC_DAPM_OUTPUT("SPK"),
315 SND_SOC_DAPM_OUT_DRV_E("SPKDRV", CS35L33_PWRCTL1, 7, 1, NULL, 0,
316 cs35l33_spkrdrv_event,
317 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
318 SND_SOC_DAPM_AIF_IN_E("SDIN", NULL, 0, CS35L33_PWRCTL2,
319 2, 1, cs35l33_sdin_event, SND_SOC_DAPM_PRE_PMU |
320 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
321
322 SND_SOC_DAPM_INPUT("MON"),
323
324 SND_SOC_DAPM_ADC("VMON", NULL,
325 CS35L33_PWRCTL2, CS35L33_PDN_VMON_SHIFT, 1),
326 SND_SOC_DAPM_ADC("IMON", NULL,
327 CS35L33_PWRCTL2, CS35L33_PDN_IMON_SHIFT, 1),
328 SND_SOC_DAPM_ADC("VPMON", NULL,
329 CS35L33_PWRCTL2, CS35L33_PDN_VPMON_SHIFT, 1),
330 SND_SOC_DAPM_ADC("VBSTMON", NULL,
331 CS35L33_PWRCTL2, CS35L33_PDN_VBSTMON_SHIFT, 1),
332
333 SND_SOC_DAPM_AIF_OUT_E("SDOUT", NULL, 0, SND_SOC_NOPM, 0, 0,
334 cs35l33_sdout_event, SND_SOC_DAPM_PRE_PMU |
335 SND_SOC_DAPM_PRE_PMD),
336 };
337
338 static const struct snd_soc_dapm_route cs35l33_audio_map[] = {
339 {"SDIN", NULL, "CS35L33 Playback"},
340 {"SPKDRV", NULL, "SDIN"},
341 {"SPK", NULL, "SPKDRV"},
342
343 {"VMON", NULL, "MON"},
344 {"IMON", NULL, "MON"},
345
346 {"SDOUT", NULL, "VMON"},
347 {"SDOUT", NULL, "IMON"},
348 {"CS35L33 Capture", NULL, "SDOUT"},
349 };
350
351 static const struct snd_soc_dapm_route cs35l33_vphg_auto_route[] = {
352 {"SPKDRV", NULL, "VPMON"},
353 {"VPMON", NULL, "CS35L33 Playback"},
354 };
355
356 static const struct snd_soc_dapm_route cs35l33_vp_vbst_mon_route[] = {
357 {"SDOUT", NULL, "VPMON"},
358 {"VPMON", NULL, "MON"},
359 {"SDOUT", NULL, "VBSTMON"},
360 {"VBSTMON", NULL, "MON"},
361 };
362
363 static int cs35l33_set_bias_level(struct snd_soc_codec *codec,
364 enum snd_soc_bias_level level)
365 {
366 unsigned int val;
367 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
368
369 switch (level) {
370 case SND_SOC_BIAS_ON:
371 break;
372 case SND_SOC_BIAS_PREPARE:
373 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
374 CS35L33_PDN_ALL, 0);
375 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
376 CS35L33_MCLKDIS, 0);
377 break;
378 case SND_SOC_BIAS_STANDBY:
379 regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
380 CS35L33_PDN_ALL, CS35L33_PDN_ALL);
381 regmap_read(priv->regmap, CS35L33_INT_STATUS_2, &val);
382 usleep_range(1000, 1100);
383 if (val & CS35L33_PDN_DONE)
384 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
385 CS35L33_MCLKDIS, CS35L33_MCLKDIS);
386 break;
387 case SND_SOC_BIAS_OFF:
388 break;
389 default:
390 return -EINVAL;
391 }
392
393 return 0;
394 }
395
396 struct cs35l33_mclk_div {
397 int mclk;
398 int srate;
399 u8 adsp_rate;
400 u8 int_fs_ratio;
401 };
402
403 static const struct cs35l33_mclk_div cs35l33_mclk_coeffs[] = {
404 /* MCLK, Sample Rate, adsp_rate, int_fs_ratio */
405 {5644800, 11025, 0x4, CS35L33_INT_FS_RATE},
406 {5644800, 22050, 0x8, CS35L33_INT_FS_RATE},
407 {5644800, 44100, 0xC, CS35L33_INT_FS_RATE},
408
409 {6000000, 8000, 0x1, 0},
410 {6000000, 11025, 0x2, 0},
411 {6000000, 11029, 0x3, 0},
412 {6000000, 12000, 0x4, 0},
413 {6000000, 16000, 0x5, 0},
414 {6000000, 22050, 0x6, 0},
415 {6000000, 22059, 0x7, 0},
416 {6000000, 24000, 0x8, 0},
417 {6000000, 32000, 0x9, 0},
418 {6000000, 44100, 0xA, 0},
419 {6000000, 44118, 0xB, 0},
420 {6000000, 48000, 0xC, 0},
421
422 {6144000, 8000, 0x1, CS35L33_INT_FS_RATE},
423 {6144000, 12000, 0x4, CS35L33_INT_FS_RATE},
424 {6144000, 16000, 0x5, CS35L33_INT_FS_RATE},
425 {6144000, 24000, 0x8, CS35L33_INT_FS_RATE},
426 {6144000, 32000, 0x9, CS35L33_INT_FS_RATE},
427 {6144000, 48000, 0xC, CS35L33_INT_FS_RATE},
428 };
429
430 static int cs35l33_get_mclk_coeff(int mclk, int srate)
431 {
432 int i;
433
434 for (i = 0; i < ARRAY_SIZE(cs35l33_mclk_coeffs); i++) {
435 if (cs35l33_mclk_coeffs[i].mclk == mclk &&
436 cs35l33_mclk_coeffs[i].srate == srate)
437 return i;
438 }
439 return -EINVAL;
440 }
441
442 static int cs35l33_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
443 {
444 struct snd_soc_codec *codec = codec_dai->codec;
445 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
446
447 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
448 case SND_SOC_DAIFMT_CBM_CFM:
449 regmap_update_bits(priv->regmap, CS35L33_ADSP_CTL,
450 CS35L33_MS_MASK, CS35L33_MS_MASK);
451 dev_dbg(codec->dev, "Audio port in master mode\n");
452 break;
453 case SND_SOC_DAIFMT_CBS_CFS:
454 regmap_update_bits(priv->regmap, CS35L33_ADSP_CTL,
455 CS35L33_MS_MASK, 0);
456 dev_dbg(codec->dev, "Audio port in slave mode\n");
457 break;
458 default:
459 return -EINVAL;
460 }
461
462 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
463 case SND_SOC_DAIFMT_DSP_A:
464 /*
465 * tdm mode in cs35l33 resembles dsp-a mode very
466 * closely, it is dsp-a with fsync shifted left by half bclk
467 */
468 priv->is_tdm_mode = true;
469 dev_dbg(codec->dev, "Audio port in TDM mode\n");
470 break;
471 case SND_SOC_DAIFMT_I2S:
472 priv->is_tdm_mode = false;
473 dev_dbg(codec->dev, "Audio port in I2S mode\n");
474 break;
475 default:
476 return -EINVAL;
477 }
478
479 return 0;
480 }
481
482 static int cs35l33_pcm_hw_params(struct snd_pcm_substream *substream,
483 struct snd_pcm_hw_params *params,
484 struct snd_soc_dai *dai)
485 {
486 struct snd_soc_codec *codec = dai->codec;
487 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
488 int sample_size = params_width(params);
489 int coeff = cs35l33_get_mclk_coeff(priv->mclk_int, params_rate(params));
490
491 if (coeff < 0)
492 return coeff;
493
494 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
495 CS35L33_ADSP_FS | CS35L33_INT_FS_RATE,
496 cs35l33_mclk_coeffs[coeff].int_fs_ratio
497 | cs35l33_mclk_coeffs[coeff].adsp_rate);
498
499 if (priv->is_tdm_mode) {
500 sample_size = (sample_size / 8) - 1;
501 if (sample_size > 2)
502 sample_size = 2;
503 regmap_update_bits(priv->regmap, CS35L33_RX_AUD,
504 CS35L33_AUDIN_RX_DEPTH,
505 sample_size << CS35L33_AUDIN_RX_DEPTH_SHIFT);
506 }
507
508 dev_dbg(codec->dev, "sample rate=%d, bits per sample=%d\n",
509 params_rate(params), params_width(params));
510
511 return 0;
512 }
513
514 static const unsigned int cs35l33_src_rates[] = {
515 8000, 11025, 11029, 12000, 16000, 22050,
516 22059, 24000, 32000, 44100, 44118, 48000
517 };
518
519 static const struct snd_pcm_hw_constraint_list cs35l33_constraints = {
520 .count = ARRAY_SIZE(cs35l33_src_rates),
521 .list = cs35l33_src_rates,
522 };
523
524 static int cs35l33_pcm_startup(struct snd_pcm_substream *substream,
525 struct snd_soc_dai *dai)
526 {
527 snd_pcm_hw_constraint_list(substream->runtime, 0,
528 SNDRV_PCM_HW_PARAM_RATE,
529 &cs35l33_constraints);
530 return 0;
531 }
532
533 static int cs35l33_set_tristate(struct snd_soc_dai *dai, int tristate)
534 {
535 struct snd_soc_codec *codec = dai->codec;
536 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
537
538 if (tristate) {
539 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
540 CS35L33_SDOUT_3ST_I2S, CS35L33_SDOUT_3ST_I2S);
541 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
542 CS35L33_SDOUT_3ST_TDM, CS35L33_SDOUT_3ST_TDM);
543 } else {
544 regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
545 CS35L33_SDOUT_3ST_I2S, 0);
546 regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
547 CS35L33_SDOUT_3ST_TDM, 0);
548 }
549
550 return 0;
551 }
552
553 static int cs35l33_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
554 unsigned int rx_mask, int slots, int slot_width)
555 {
556 struct snd_soc_codec *codec = dai->codec;
557 struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
558 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
559 unsigned int reg, bit_pos, i;
560 int slot, slot_num;
561
562 if (slot_width != 8)
563 return -EINVAL;
564
565 /* scan rx_mask for aud slot */
566 slot = ffs(rx_mask) - 1;
567 if (slot >= 0) {
568 regmap_update_bits(priv->regmap, CS35L33_RX_AUD,
569 CS35L33_X_LOC, slot);
570 dev_dbg(codec->dev, "Audio starts from slots %d", slot);
571 }
572
573 /*
574 * scan tx_mask: vmon(2 slots); imon (2 slots);
575 * vpmon (1 slot) vbstmon (1 slot)
576 */
577 slot = ffs(tx_mask) - 1;
578 slot_num = 0;
579
580 for (i = 0; i < 2 ; i++) {
581 /* disable vpmon/vbstmon: enable later if set in tx_mask */
582 regmap_update_bits(priv->regmap, CS35L33_TX_VPMON + i,
583 CS35L33_X_STATE | CS35L33_X_LOC, CS35L33_X_STATE
584 | CS35L33_X_LOC);
585 }
586
587 /* disconnect {vp,vbst}_mon routes: eanble later if set in tx_mask*/
588 snd_soc_dapm_del_routes(dapm, cs35l33_vp_vbst_mon_route,
589 ARRAY_SIZE(cs35l33_vp_vbst_mon_route));
590
591 while (slot >= 0) {
592 /* configure VMON_TX_LOC */
593 if (slot_num == 0) {
594 regmap_update_bits(priv->regmap, CS35L33_TX_VMON,
595 CS35L33_X_STATE | CS35L33_X_LOC, slot);
596 dev_dbg(codec->dev, "VMON enabled in slots %d-%d",
597 slot, slot + 1);
598 }
599
600 /* configure IMON_TX_LOC */
601 if (slot_num == 3) {
602 regmap_update_bits(priv->regmap, CS35L33_TX_IMON,
603 CS35L33_X_STATE | CS35L33_X_LOC, slot);
604 dev_dbg(codec->dev, "IMON enabled in slots %d-%d",
605 slot, slot + 1);
606 }
607
608 /* configure VPMON_TX_LOC */
609 if (slot_num == 4) {
610 regmap_update_bits(priv->regmap, CS35L33_TX_VPMON,
611 CS35L33_X_STATE | CS35L33_X_LOC, slot);
612 snd_soc_dapm_add_routes(dapm,
613 &cs35l33_vp_vbst_mon_route[0], 2);
614 dev_dbg(codec->dev, "VPMON enabled in slots %d", slot);
615 }
616
617 /* configure VBSTMON_TX_LOC */
618 if (slot_num == 5) {
619 regmap_update_bits(priv->regmap, CS35L33_TX_VBSTMON,
620 CS35L33_X_STATE | CS35L33_X_LOC, slot);
621 snd_soc_dapm_add_routes(dapm,
622 &cs35l33_vp_vbst_mon_route[2], 2);
623 dev_dbg(codec->dev,
624 "VBSTMON enabled in slots %d", slot);
625 }
626
627 /* Enable the relevant tx slot */
628 reg = CS35L33_TX_EN4 - (slot/8);
629 bit_pos = slot - ((slot / 8) * (8));
630 regmap_update_bits(priv->regmap, reg,
631 1 << bit_pos, 1 << bit_pos);
632
633 tx_mask &= ~(1 << slot);
634 slot = ffs(tx_mask) - 1;
635 slot_num++;
636 }
637
638 return 0;
639 }
640
641 static int cs35l33_codec_set_sysclk(struct snd_soc_codec *codec,
642 int clk_id, int source, unsigned int freq, int dir)
643 {
644 struct cs35l33_private *cs35l33 = snd_soc_codec_get_drvdata(codec);
645
646 switch (freq) {
647 case CS35L33_MCLK_5644:
648 case CS35L33_MCLK_6:
649 case CS35L33_MCLK_6144:
650 regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL,
651 CS35L33_MCLKDIV2, 0);
652 cs35l33->mclk_int = freq;
653 break;
654 case CS35L33_MCLK_11289:
655 case CS35L33_MCLK_12:
656 case CS35L33_MCLK_12288:
657 regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL,
658 CS35L33_MCLKDIV2, CS35L33_MCLKDIV2);
659 cs35l33->mclk_int = freq/2;
660 break;
661 default:
662 cs35l33->mclk_int = 0;
663 return -EINVAL;
664 }
665
666 dev_dbg(codec->dev, "external mclk freq=%d, internal mclk freq=%d\n",
667 freq, cs35l33->mclk_int);
668
669 return 0;
670 }
671
672 static const struct snd_soc_dai_ops cs35l33_ops = {
673 .startup = cs35l33_pcm_startup,
674 .set_tristate = cs35l33_set_tristate,
675 .set_fmt = cs35l33_set_dai_fmt,
676 .hw_params = cs35l33_pcm_hw_params,
677 .set_tdm_slot = cs35l33_set_tdm_slot,
678 };
679
680 static struct snd_soc_dai_driver cs35l33_dai = {
681 .name = "cs35l33-dai",
682 .id = 0,
683 .playback = {
684 .stream_name = "CS35L33 Playback",
685 .channels_min = 1,
686 .channels_max = 1,
687 .rates = CS35L33_RATES,
688 .formats = CS35L33_FORMATS,
689 },
690 .capture = {
691 .stream_name = "CS35L33 Capture",
692 .channels_min = 2,
693 .channels_max = 2,
694 .rates = CS35L33_RATES,
695 .formats = CS35L33_FORMATS,
696 },
697 .ops = &cs35l33_ops,
698 .symmetric_rates = 1,
699 };
700
701 static int cs35l33_set_hg_data(struct snd_soc_codec *codec,
702 struct cs35l33_pdata *pdata)
703 {
704 struct cs35l33_hg *hg_config = &pdata->hg_config;
705 struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
706 struct cs35l33_private *priv = snd_soc_codec_get_drvdata(codec);
707
708 if (hg_config->enable_hg_algo) {
709 regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL,
710 CS35L33_MEM_DEPTH_MASK,
711 hg_config->mem_depth << CS35L33_MEM_DEPTH_SHIFT);
712 regmap_write(priv->regmap, CS35L33_HG_REL_RATE,
713 hg_config->release_rate);
714 regmap_update_bits(priv->regmap, CS35L33_HG_HEAD,
715 CS35L33_HD_RM_MASK,
716 hg_config->hd_rm << CS35L33_HD_RM_SHIFT);
717 regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL,
718 CS35L33_LDO_THLD_MASK,
719 hg_config->ldo_thld << CS35L33_LDO_THLD_SHIFT);
720 regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL,
721 CS35L33_LDO_DISABLE_MASK,
722 hg_config->ldo_path_disable <<
723 CS35L33_LDO_DISABLE_SHIFT);
724 regmap_update_bits(priv->regmap, CS35L33_LDO_DEL,
725 CS35L33_LDO_ENTRY_DELAY_MASK,
726 hg_config->ldo_entry_delay <<
727 CS35L33_LDO_ENTRY_DELAY_SHIFT);
728 if (hg_config->vp_hg_auto) {
729 regmap_update_bits(priv->regmap, CS35L33_HG_EN,
730 CS35L33_VP_HG_AUTO_MASK,
731 CS35L33_VP_HG_AUTO_MASK);
732 snd_soc_dapm_add_routes(dapm, cs35l33_vphg_auto_route,
733 ARRAY_SIZE(cs35l33_vphg_auto_route));
734 }
735 regmap_update_bits(priv->regmap, CS35L33_HG_EN,
736 CS35L33_VP_HG_MASK,
737 hg_config->vp_hg << CS35L33_VP_HG_SHIFT);
738 regmap_update_bits(priv->regmap, CS35L33_LDO_DEL,
739 CS35L33_VP_HG_RATE_MASK,
740 hg_config->vp_hg_rate << CS35L33_VP_HG_RATE_SHIFT);
741 regmap_update_bits(priv->regmap, CS35L33_LDO_DEL,
742 CS35L33_VP_HG_VA_MASK,
743 hg_config->vp_hg_va << CS35L33_VP_HG_VA_SHIFT);
744 regmap_update_bits(priv->regmap, CS35L33_HG_EN,
745 CS35L33_CLASS_HG_EN_MASK, CS35L33_CLASS_HG_EN_MASK);
746 }
747 return 0;
748 }
749
750 static int cs35l33_set_bst_ipk(struct snd_soc_codec *codec, unsigned int bst)
751 {
752 struct cs35l33_private *cs35l33 = snd_soc_codec_get_drvdata(codec);
753 int ret = 0, steps = 0;
754
755 /* Boost current in uA */
756 if (bst > 3600000 || bst < 1850000) {
757 dev_err(codec->dev, "Invalid boost current %d\n", bst);
758 ret = -EINVAL;
759 goto err;
760 }
761
762 if (bst % 15625) {
763 dev_err(codec->dev, "Current not a multiple of 15625uA (%d)\n",
764 bst);
765 ret = -EINVAL;
766 goto err;
767 }
768
769 while (bst > 1850000) {
770 bst -= 15625;
771 steps++;
772 }
773
774 regmap_write(cs35l33->regmap, CS35L33_BST_PEAK_CTL,
775 steps+0x70);
776
777 err:
778 return ret;
779 }
780
781 static int cs35l33_probe(struct snd_soc_codec *codec)
782 {
783 struct cs35l33_private *cs35l33 = snd_soc_codec_get_drvdata(codec);
784
785 cs35l33->codec = codec;
786 pm_runtime_get_sync(codec->dev);
787
788 regmap_update_bits(cs35l33->regmap, CS35L33_PROTECT_CTL,
789 CS35L33_ALIVE_WD_DIS, 0x8);
790 regmap_update_bits(cs35l33->regmap, CS35L33_BST_CTL2,
791 CS35L33_ALIVE_WD_DIS2,
792 CS35L33_ALIVE_WD_DIS2);
793
794 /* Set Platform Data */
795 regmap_update_bits(cs35l33->regmap, CS35L33_BST_CTL1,
796 CS35L33_BST_CTL_MASK, cs35l33->pdata.boost_ctl);
797 regmap_update_bits(cs35l33->regmap, CS35L33_CLASSD_CTL,
798 CS35L33_AMP_DRV_SEL_MASK,
799 cs35l33->pdata.amp_drv_sel << CS35L33_AMP_DRV_SEL_SHIFT);
800
801 if (cs35l33->pdata.boost_ipk)
802 cs35l33_set_bst_ipk(codec, cs35l33->pdata.boost_ipk);
803
804 if (cs35l33->enable_soft_ramp) {
805 snd_soc_update_bits(codec, CS35L33_DAC_CTL,
806 CS35L33_DIGSFT, CS35L33_DIGSFT);
807 snd_soc_update_bits(codec, CS35L33_DAC_CTL,
808 CS35L33_DSR_RATE, cs35l33->pdata.ramp_rate);
809 } else {
810 snd_soc_update_bits(codec, CS35L33_DAC_CTL,
811 CS35L33_DIGSFT, 0);
812 }
813
814 /* update IMON scaling rate if different from default of 0x8 */
815 if (cs35l33->pdata.imon_adc_scale != 0x8)
816 snd_soc_update_bits(codec, CS35L33_ADC_CTL,
817 CS35L33_IMON_SCALE, cs35l33->pdata.imon_adc_scale);
818
819 cs35l33_set_hg_data(codec, &(cs35l33->pdata));
820
821 /*
822 * unmask important interrupts that causes the chip to enter
823 * speaker safe mode and hence deserves user attention
824 */
825 regmap_update_bits(cs35l33->regmap, CS35L33_INT_MASK_1,
826 CS35L33_M_OTE | CS35L33_M_OTW | CS35L33_M_AMP_SHORT |
827 CS35L33_M_CAL_ERR, 0);
828
829 pm_runtime_put_sync(codec->dev);
830
831 return 0;
832 }
833
834 static struct snd_soc_codec_driver soc_codec_dev_cs35l33 = {
835 .probe = cs35l33_probe,
836
837 .set_bias_level = cs35l33_set_bias_level,
838 .set_sysclk = cs35l33_codec_set_sysclk,
839
840 .dapm_widgets = cs35l33_dapm_widgets,
841 .num_dapm_widgets = ARRAY_SIZE(cs35l33_dapm_widgets),
842 .dapm_routes = cs35l33_audio_map,
843 .num_dapm_routes = ARRAY_SIZE(cs35l33_audio_map),
844 .controls = cs35l33_snd_controls,
845 .num_controls = ARRAY_SIZE(cs35l33_snd_controls),
846
847 .idle_bias_off = true,
848 };
849
850 static const struct regmap_config cs35l33_regmap = {
851 .reg_bits = 8,
852 .val_bits = 8,
853
854 .max_register = CS35L33_MAX_REGISTER,
855 .reg_defaults = cs35l33_reg,
856 .num_reg_defaults = ARRAY_SIZE(cs35l33_reg),
857 .volatile_reg = cs35l33_volatile_register,
858 .readable_reg = cs35l33_readable_register,
859 .writeable_reg = cs35l33_writeable_register,
860 .cache_type = REGCACHE_RBTREE,
861 .use_single_rw = true,
862 };
863
864 static int __maybe_unused cs35l33_runtime_resume(struct device *dev)
865 {
866 struct cs35l33_private *cs35l33 = dev_get_drvdata(dev);
867 int ret;
868
869 dev_dbg(dev, "%s\n", __func__);
870
871 if (cs35l33->reset_gpio)
872 gpiod_set_value_cansleep(cs35l33->reset_gpio, 0);
873
874 ret = regulator_bulk_enable(cs35l33->num_core_supplies,
875 cs35l33->core_supplies);
876 if (ret != 0) {
877 dev_err(dev, "Failed to enable core supplies: %d\n", ret);
878 return ret;
879 }
880
881 regcache_cache_only(cs35l33->regmap, false);
882
883 if (cs35l33->reset_gpio)
884 gpiod_set_value_cansleep(cs35l33->reset_gpio, 1);
885
886 msleep(CS35L33_BOOT_DELAY);
887
888 ret = regcache_sync(cs35l33->regmap);
889 if (ret != 0) {
890 dev_err(dev, "Failed to restore register cache\n");
891 goto err;
892 }
893
894 return 0;
895
896 err:
897 regcache_cache_only(cs35l33->regmap, true);
898 regulator_bulk_disable(cs35l33->num_core_supplies,
899 cs35l33->core_supplies);
900
901 return ret;
902 }
903
904 static int __maybe_unused cs35l33_runtime_suspend(struct device *dev)
905 {
906 struct cs35l33_private *cs35l33 = dev_get_drvdata(dev);
907
908 dev_dbg(dev, "%s\n", __func__);
909
910 /* redo the calibration in next power up */
911 cs35l33->amp_cal = false;
912
913 regcache_cache_only(cs35l33->regmap, true);
914 regcache_mark_dirty(cs35l33->regmap);
915 regulator_bulk_disable(cs35l33->num_core_supplies,
916 cs35l33->core_supplies);
917
918 return 0;
919 }
920
921 static const struct dev_pm_ops cs35l33_pm_ops = {
922 SET_RUNTIME_PM_OPS(cs35l33_runtime_suspend,
923 cs35l33_runtime_resume,
924 NULL)
925 };
926
927 static int cs35l33_get_hg_data(const struct device_node *np,
928 struct cs35l33_pdata *pdata)
929 {
930 struct device_node *hg;
931 struct cs35l33_hg *hg_config = &pdata->hg_config;
932 u32 val32;
933
934 hg = of_get_child_by_name(np, "cirrus,hg-algo");
935 hg_config->enable_hg_algo = hg ? true : false;
936
937 if (hg_config->enable_hg_algo) {
938 if (of_property_read_u32(hg, "cirrus,mem-depth", &val32) >= 0)
939 hg_config->mem_depth = val32;
940 if (of_property_read_u32(hg, "cirrus,release-rate",
941 &val32) >= 0)
942 hg_config->release_rate = val32;
943 if (of_property_read_u32(hg, "cirrus,ldo-thld", &val32) >= 0)
944 hg_config->ldo_thld = val32;
945 if (of_property_read_u32(hg, "cirrus,ldo-path-disable",
946 &val32) >= 0)
947 hg_config->ldo_path_disable = val32;
948 if (of_property_read_u32(hg, "cirrus,ldo-entry-delay",
949 &val32) >= 0)
950 hg_config->ldo_entry_delay = val32;
951
952 hg_config->vp_hg_auto = of_property_read_bool(hg,
953 "cirrus,vp-hg-auto");
954
955 if (of_property_read_u32(hg, "cirrus,vp-hg", &val32) >= 0)
956 hg_config->vp_hg = val32;
957 if (of_property_read_u32(hg, "cirrus,vp-hg-rate", &val32) >= 0)
958 hg_config->vp_hg_rate = val32;
959 if (of_property_read_u32(hg, "cirrus,vp-hg-va", &val32) >= 0)
960 hg_config->vp_hg_va = val32;
961 }
962
963 of_node_put(hg);
964
965 return 0;
966 }
967
968 static irqreturn_t cs35l33_irq_thread(int irq, void *data)
969 {
970 struct cs35l33_private *cs35l33 = data;
971 struct snd_soc_codec *codec = cs35l33->codec;
972 unsigned int sticky_val1, sticky_val2, current_val, mask1, mask2;
973
974 regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_2,
975 &sticky_val2);
976 regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_1,
977 &sticky_val1);
978 regmap_read(cs35l33->regmap, CS35L33_INT_MASK_2, &mask2);
979 regmap_read(cs35l33->regmap, CS35L33_INT_MASK_1, &mask1);
980
981 /* Check to see if the unmasked bits are active,
982 * if not then exit.
983 */
984 if (!(sticky_val1 & ~mask1) && !(sticky_val2 & ~mask2))
985 return IRQ_NONE;
986
987 regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_1,
988 &current_val);
989
990 /* handle the interrupts */
991
992 if (sticky_val1 & CS35L33_AMP_SHORT) {
993 dev_crit(codec->dev, "Amp short error\n");
994 if (!(current_val & CS35L33_AMP_SHORT)) {
995 dev_dbg(codec->dev,
996 "Amp short error release\n");
997 regmap_update_bits(cs35l33->regmap,
998 CS35L33_AMP_CTL,
999 CS35L33_AMP_SHORT_RLS, 0);
1000 regmap_update_bits(cs35l33->regmap,
1001 CS35L33_AMP_CTL,
1002 CS35L33_AMP_SHORT_RLS,
1003 CS35L33_AMP_SHORT_RLS);
1004 regmap_update_bits(cs35l33->regmap,
1005 CS35L33_AMP_CTL, CS35L33_AMP_SHORT_RLS,
1006 0);
1007 }
1008 }
1009
1010 if (sticky_val1 & CS35L33_CAL_ERR) {
1011 dev_err(codec->dev, "Cal error\n");
1012
1013 /* redo the calibration in next power up */
1014 cs35l33->amp_cal = false;
1015
1016 if (!(current_val & CS35L33_CAL_ERR)) {
1017 dev_dbg(codec->dev, "Cal error release\n");
1018 regmap_update_bits(cs35l33->regmap,
1019 CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS,
1020 0);
1021 regmap_update_bits(cs35l33->regmap,
1022 CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS,
1023 CS35L33_CAL_ERR_RLS);
1024 regmap_update_bits(cs35l33->regmap,
1025 CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS,
1026 0);
1027 }
1028 }
1029
1030 if (sticky_val1 & CS35L33_OTE) {
1031 dev_crit(codec->dev, "Over temperature error\n");
1032 if (!(current_val & CS35L33_OTE)) {
1033 dev_dbg(codec->dev,
1034 "Over temperature error release\n");
1035 regmap_update_bits(cs35l33->regmap,
1036 CS35L33_AMP_CTL, CS35L33_OTE_RLS, 0);
1037 regmap_update_bits(cs35l33->regmap,
1038 CS35L33_AMP_CTL, CS35L33_OTE_RLS,
1039 CS35L33_OTE_RLS);
1040 regmap_update_bits(cs35l33->regmap,
1041 CS35L33_AMP_CTL, CS35L33_OTE_RLS, 0);
1042 }
1043 }
1044
1045 if (sticky_val1 & CS35L33_OTW) {
1046 dev_err(codec->dev, "Over temperature warning\n");
1047 if (!(current_val & CS35L33_OTW)) {
1048 dev_dbg(codec->dev,
1049 "Over temperature warning release\n");
1050 regmap_update_bits(cs35l33->regmap,
1051 CS35L33_AMP_CTL, CS35L33_OTW_RLS, 0);
1052 regmap_update_bits(cs35l33->regmap,
1053 CS35L33_AMP_CTL, CS35L33_OTW_RLS,
1054 CS35L33_OTW_RLS);
1055 regmap_update_bits(cs35l33->regmap,
1056 CS35L33_AMP_CTL, CS35L33_OTW_RLS, 0);
1057 }
1058 }
1059 if (CS35L33_ALIVE_ERR & sticky_val1)
1060 dev_err(codec->dev, "ERROR: ADSPCLK Interrupt\n");
1061
1062 if (CS35L33_MCLK_ERR & sticky_val1)
1063 dev_err(codec->dev, "ERROR: MCLK Interrupt\n");
1064
1065 if (CS35L33_VMON_OVFL & sticky_val2)
1066 dev_err(codec->dev,
1067 "ERROR: VMON Overflow Interrupt\n");
1068
1069 if (CS35L33_IMON_OVFL & sticky_val2)
1070 dev_err(codec->dev,
1071 "ERROR: IMON Overflow Interrupt\n");
1072
1073 if (CS35L33_VPMON_OVFL & sticky_val2)
1074 dev_err(codec->dev,
1075 "ERROR: VPMON Overflow Interrupt\n");
1076
1077 return IRQ_HANDLED;
1078 }
1079
1080 static const char * const cs35l33_core_supplies[] = {
1081 "VA",
1082 "VP",
1083 };
1084
1085 static int cs35l33_of_get_pdata(struct device *dev,
1086 struct cs35l33_private *cs35l33)
1087 {
1088 struct device_node *np = dev->of_node;
1089 struct cs35l33_pdata *pdata = &cs35l33->pdata;
1090 u32 val32;
1091
1092 if (!np)
1093 return 0;
1094
1095 if (of_property_read_u32(np, "cirrus,boost-ctl", &val32) >= 0) {
1096 pdata->boost_ctl = val32;
1097 pdata->amp_drv_sel = 1;
1098 }
1099
1100 if (of_property_read_u32(np, "cirrus,ramp-rate", &val32) >= 0) {
1101 pdata->ramp_rate = val32;
1102 cs35l33->enable_soft_ramp = true;
1103 }
1104
1105 if (of_property_read_u32(np, "cirrus,boost-ipk", &val32) >= 0)
1106 pdata->boost_ipk = val32;
1107
1108 if (of_property_read_u32(np, "cirrus,imon-adc-scale", &val32) >= 0) {
1109 if ((val32 == 0x0) || (val32 == 0x7) || (val32 == 0x6))
1110 pdata->imon_adc_scale = val32;
1111 else
1112 /* use default value */
1113 pdata->imon_adc_scale = 0x8;
1114 } else {
1115 /* use default value */
1116 pdata->imon_adc_scale = 0x8;
1117 }
1118
1119 cs35l33_get_hg_data(np, pdata);
1120
1121 return 0;
1122 }
1123
1124 static int cs35l33_i2c_probe(struct i2c_client *i2c_client,
1125 const struct i2c_device_id *id)
1126 {
1127 struct cs35l33_private *cs35l33;
1128 struct cs35l33_pdata *pdata = dev_get_platdata(&i2c_client->dev);
1129 int ret, devid, i;
1130 unsigned int reg;
1131
1132 cs35l33 = devm_kzalloc(&i2c_client->dev, sizeof(struct cs35l33_private),
1133 GFP_KERNEL);
1134 if (!cs35l33)
1135 return -ENOMEM;
1136
1137 i2c_set_clientdata(i2c_client, cs35l33);
1138 cs35l33->regmap = devm_regmap_init_i2c(i2c_client, &cs35l33_regmap);
1139 if (IS_ERR(cs35l33->regmap)) {
1140 ret = PTR_ERR(cs35l33->regmap);
1141 dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret);
1142 return ret;
1143 }
1144
1145 regcache_cache_only(cs35l33->regmap, true);
1146
1147 for (i = 0; i < ARRAY_SIZE(cs35l33_core_supplies); i++)
1148 cs35l33->core_supplies[i].supply
1149 = cs35l33_core_supplies[i];
1150 cs35l33->num_core_supplies = ARRAY_SIZE(cs35l33_core_supplies);
1151
1152 ret = devm_regulator_bulk_get(&i2c_client->dev,
1153 cs35l33->num_core_supplies,
1154 cs35l33->core_supplies);
1155 if (ret != 0) {
1156 dev_err(&i2c_client->dev,
1157 "Failed to request core supplies: %d\n",
1158 ret);
1159 return ret;
1160 }
1161
1162 if (pdata) {
1163 cs35l33->pdata = *pdata;
1164 } else {
1165 cs35l33_of_get_pdata(&i2c_client->dev, cs35l33);
1166 pdata = &cs35l33->pdata;
1167 }
1168
1169 ret = devm_request_threaded_irq(&i2c_client->dev, i2c_client->irq, NULL,
1170 cs35l33_irq_thread, IRQF_ONESHOT | IRQF_TRIGGER_LOW,
1171 "cs35l33", cs35l33);
1172 if (ret != 0)
1173 dev_warn(&i2c_client->dev, "Failed to request IRQ: %d\n", ret);
1174
1175 /* We could issue !RST or skip it based on AMP topology */
1176 cs35l33->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev,
1177 "reset-gpios", GPIOD_OUT_HIGH);
1178 if (IS_ERR(cs35l33->reset_gpio)) {
1179 dev_err(&i2c_client->dev, "%s ERROR: Can't get reset GPIO\n",
1180 __func__);
1181 return PTR_ERR(cs35l33->reset_gpio);
1182 }
1183
1184 ret = regulator_bulk_enable(cs35l33->num_core_supplies,
1185 cs35l33->core_supplies);
1186 if (ret != 0) {
1187 dev_err(&i2c_client->dev,
1188 "Failed to enable core supplies: %d\n",
1189 ret);
1190 return ret;
1191 }
1192
1193 if (cs35l33->reset_gpio)
1194 gpiod_set_value_cansleep(cs35l33->reset_gpio, 1);
1195
1196 msleep(CS35L33_BOOT_DELAY);
1197 regcache_cache_only(cs35l33->regmap, false);
1198
1199 /* initialize codec */
1200 ret = regmap_read(cs35l33->regmap, CS35L33_DEVID_AB, &reg);
1201 devid = (reg & 0xFF) << 12;
1202 ret = regmap_read(cs35l33->regmap, CS35L33_DEVID_CD, &reg);
1203 devid |= (reg & 0xFF) << 4;
1204 ret = regmap_read(cs35l33->regmap, CS35L33_DEVID_E, &reg);
1205 devid |= (reg & 0xF0) >> 4;
1206
1207 if (devid != CS35L33_CHIP_ID) {
1208 dev_err(&i2c_client->dev,
1209 "CS35L33 Device ID (%X). Expected ID %X\n",
1210 devid, CS35L33_CHIP_ID);
1211 goto err_enable;
1212 }
1213
1214 ret = regmap_read(cs35l33->regmap, CS35L33_REV_ID, &reg);
1215 if (ret < 0) {
1216 dev_err(&i2c_client->dev, "Get Revision ID failed\n");
1217 goto err_enable;
1218 }
1219
1220 dev_info(&i2c_client->dev,
1221 "Cirrus Logic CS35L33, Revision: %02X\n", reg & 0xFF);
1222
1223 ret = regmap_register_patch(cs35l33->regmap,
1224 cs35l33_patch, ARRAY_SIZE(cs35l33_patch));
1225 if (ret < 0) {
1226 dev_err(&i2c_client->dev,
1227 "Error in applying regmap patch: %d\n", ret);
1228 goto err_enable;
1229 }
1230
1231 /* disable mclk and tdm */
1232 regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL,
1233 CS35L33_MCLKDIS | CS35L33_SDOUT_3ST_TDM,
1234 CS35L33_MCLKDIS | CS35L33_SDOUT_3ST_TDM);
1235
1236 pm_runtime_set_autosuspend_delay(&i2c_client->dev, 100);
1237 pm_runtime_use_autosuspend(&i2c_client->dev);
1238 pm_runtime_set_active(&i2c_client->dev);
1239 pm_runtime_enable(&i2c_client->dev);
1240
1241 ret = snd_soc_register_codec(&i2c_client->dev,
1242 &soc_codec_dev_cs35l33, &cs35l33_dai, 1);
1243 if (ret < 0) {
1244 dev_err(&i2c_client->dev, "%s: Register codec failed\n",
1245 __func__);
1246 goto err_enable;
1247 }
1248
1249 return 0;
1250
1251 err_enable:
1252 regulator_bulk_disable(cs35l33->num_core_supplies,
1253 cs35l33->core_supplies);
1254
1255 return ret;
1256 }
1257
1258 static int cs35l33_i2c_remove(struct i2c_client *client)
1259 {
1260 struct cs35l33_private *cs35l33 = i2c_get_clientdata(client);
1261
1262 snd_soc_unregister_codec(&client->dev);
1263
1264 if (cs35l33->reset_gpio)
1265 gpiod_set_value_cansleep(cs35l33->reset_gpio, 0);
1266
1267 pm_runtime_disable(&client->dev);
1268 regulator_bulk_disable(cs35l33->num_core_supplies,
1269 cs35l33->core_supplies);
1270
1271 return 0;
1272 }
1273
1274 static const struct of_device_id cs35l33_of_match[] = {
1275 { .compatible = "cirrus,cs35l33", },
1276 {},
1277 };
1278 MODULE_DEVICE_TABLE(of, cs35l33_of_match);
1279
1280 static const struct i2c_device_id cs35l33_id[] = {
1281 {"cs35l33", 0},
1282 {}
1283 };
1284
1285 MODULE_DEVICE_TABLE(i2c, cs35l33_id);
1286
1287 static struct i2c_driver cs35l33_i2c_driver = {
1288 .driver = {
1289 .name = "cs35l33",
1290 .pm = &cs35l33_pm_ops,
1291 .of_match_table = cs35l33_of_match,
1292
1293 },
1294 .id_table = cs35l33_id,
1295 .probe = cs35l33_i2c_probe,
1296 .remove = cs35l33_i2c_remove,
1297
1298 };
1299 module_i2c_driver(cs35l33_i2c_driver);
1300
1301 MODULE_DESCRIPTION("ASoC CS35L33 driver");
1302 MODULE_AUTHOR("Paul Handrigan, Cirrus Logic Inc, <paul.handrigan@cirrus.com>");
1303 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.059346 seconds and 5 git commands to generate.