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