Loading...
1// SPDX-License-Identifier: GPL-2.0
2//
3// cs35l41.c -- CS35l41 ALSA SoC audio driver
4//
5// Copyright 2017-2021 Cirrus Logic, Inc.
6//
7// Author: David Rhodes <david.rhodes@cirrus.com>
8
9#include <linux/acpi.h>
10#include <linux/delay.h>
11#include <linux/err.h>
12#include <linux/init.h>
13#include <linux/kernel.h>
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/of_device.h>
17#include <linux/pm_runtime.h>
18#include <linux/property.h>
19#include <sound/initval.h>
20#include <sound/pcm.h>
21#include <sound/pcm_params.h>
22#include <sound/soc.h>
23#include <sound/soc-dapm.h>
24#include <sound/tlv.h>
25
26#include "cs35l41.h"
27
28static const char * const cs35l41_supplies[CS35L41_NUM_SUPPLIES] = {
29 "VA",
30 "VP",
31};
32
33struct cs35l41_pll_sysclk_config {
34 int freq;
35 int clk_cfg;
36};
37
38static const struct cs35l41_pll_sysclk_config cs35l41_pll_sysclk[] = {
39 { 32768, 0x00 },
40 { 8000, 0x01 },
41 { 11025, 0x02 },
42 { 12000, 0x03 },
43 { 16000, 0x04 },
44 { 22050, 0x05 },
45 { 24000, 0x06 },
46 { 32000, 0x07 },
47 { 44100, 0x08 },
48 { 48000, 0x09 },
49 { 88200, 0x0A },
50 { 96000, 0x0B },
51 { 128000, 0x0C },
52 { 176400, 0x0D },
53 { 192000, 0x0E },
54 { 256000, 0x0F },
55 { 352800, 0x10 },
56 { 384000, 0x11 },
57 { 512000, 0x12 },
58 { 705600, 0x13 },
59 { 750000, 0x14 },
60 { 768000, 0x15 },
61 { 1000000, 0x16 },
62 { 1024000, 0x17 },
63 { 1200000, 0x18 },
64 { 1411200, 0x19 },
65 { 1500000, 0x1A },
66 { 1536000, 0x1B },
67 { 2000000, 0x1C },
68 { 2048000, 0x1D },
69 { 2400000, 0x1E },
70 { 2822400, 0x1F },
71 { 3000000, 0x20 },
72 { 3072000, 0x21 },
73 { 3200000, 0x22 },
74 { 4000000, 0x23 },
75 { 4096000, 0x24 },
76 { 4800000, 0x25 },
77 { 5644800, 0x26 },
78 { 6000000, 0x27 },
79 { 6144000, 0x28 },
80 { 6250000, 0x29 },
81 { 6400000, 0x2A },
82 { 6500000, 0x2B },
83 { 6750000, 0x2C },
84 { 7526400, 0x2D },
85 { 8000000, 0x2E },
86 { 8192000, 0x2F },
87 { 9600000, 0x30 },
88 { 11289600, 0x31 },
89 { 12000000, 0x32 },
90 { 12288000, 0x33 },
91 { 12500000, 0x34 },
92 { 12800000, 0x35 },
93 { 13000000, 0x36 },
94 { 13500000, 0x37 },
95 { 19200000, 0x38 },
96 { 22579200, 0x39 },
97 { 24000000, 0x3A },
98 { 24576000, 0x3B },
99 { 25000000, 0x3C },
100 { 25600000, 0x3D },
101 { 26000000, 0x3E },
102 { 27000000, 0x3F },
103};
104
105struct cs35l41_fs_mon_config {
106 int freq;
107 unsigned int fs1;
108 unsigned int fs2;
109};
110
111static const struct cs35l41_fs_mon_config cs35l41_fs_mon[] = {
112 { 32768, 2254, 3754 },
113 { 8000, 9220, 15364 },
114 { 11025, 6148, 10244 },
115 { 12000, 6148, 10244 },
116 { 16000, 4612, 7684 },
117 { 22050, 3076, 5124 },
118 { 24000, 3076, 5124 },
119 { 32000, 2308, 3844 },
120 { 44100, 1540, 2564 },
121 { 48000, 1540, 2564 },
122 { 88200, 772, 1284 },
123 { 96000, 772, 1284 },
124 { 128000, 580, 964 },
125 { 176400, 388, 644 },
126 { 192000, 388, 644 },
127 { 256000, 292, 484 },
128 { 352800, 196, 324 },
129 { 384000, 196, 324 },
130 { 512000, 148, 244 },
131 { 705600, 100, 164 },
132 { 750000, 100, 164 },
133 { 768000, 100, 164 },
134 { 1000000, 76, 124 },
135 { 1024000, 76, 124 },
136 { 1200000, 64, 104 },
137 { 1411200, 52, 84 },
138 { 1500000, 52, 84 },
139 { 1536000, 52, 84 },
140 { 2000000, 40, 64 },
141 { 2048000, 40, 64 },
142 { 2400000, 34, 54 },
143 { 2822400, 28, 44 },
144 { 3000000, 28, 44 },
145 { 3072000, 28, 44 },
146 { 3200000, 27, 42 },
147 { 4000000, 22, 34 },
148 { 4096000, 22, 34 },
149 { 4800000, 19, 29 },
150 { 5644800, 16, 24 },
151 { 6000000, 16, 24 },
152 { 6144000, 16, 24 },
153};
154
155static int cs35l41_get_fs_mon_config_index(int freq)
156{
157 int i;
158
159 for (i = 0; i < ARRAY_SIZE(cs35l41_fs_mon); i++) {
160 if (cs35l41_fs_mon[i].freq == freq)
161 return i;
162 }
163
164 return -EINVAL;
165}
166
167static const DECLARE_TLV_DB_RANGE(dig_vol_tlv,
168 0, 0, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 1),
169 1, 913, TLV_DB_MINMAX_ITEM(-10200, 1200));
170static DECLARE_TLV_DB_SCALE(amp_gain_tlv, 0, 1, 1);
171
172static const struct snd_kcontrol_new dre_ctrl =
173 SOC_DAPM_SINGLE("Switch", CS35L41_PWR_CTRL3, 20, 1, 0);
174
175static const char * const cs35l41_pcm_sftramp_text[] = {
176 "Off", ".5ms", "1ms", "2ms", "4ms", "8ms", "15ms", "30ms"
177};
178
179static SOC_ENUM_SINGLE_DECL(pcm_sft_ramp,
180 CS35L41_AMP_DIG_VOL_CTRL, 0,
181 cs35l41_pcm_sftramp_text);
182
183static int cs35l41_dsp_preload_ev(struct snd_soc_dapm_widget *w,
184 struct snd_kcontrol *kcontrol, int event)
185{
186 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
187 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
188 int ret;
189
190 switch (event) {
191 case SND_SOC_DAPM_PRE_PMU:
192 if (cs35l41->dsp.cs_dsp.booted)
193 return 0;
194
195 return wm_adsp_early_event(w, kcontrol, event);
196 case SND_SOC_DAPM_PRE_PMD:
197 if (cs35l41->dsp.preloaded)
198 return 0;
199
200 if (cs35l41->dsp.cs_dsp.running) {
201 ret = wm_adsp_event(w, kcontrol, event);
202 if (ret)
203 return ret;
204 }
205
206 return wm_adsp_early_event(w, kcontrol, event);
207 default:
208 return 0;
209 }
210}
211
212static int cs35l41_dsp_audio_ev(struct snd_soc_dapm_widget *w,
213 struct snd_kcontrol *kcontrol, int event)
214{
215 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
216 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
217 unsigned int fw_status;
218 int ret;
219
220 switch (event) {
221 case SND_SOC_DAPM_POST_PMU:
222 if (!cs35l41->dsp.cs_dsp.running)
223 return wm_adsp_event(w, kcontrol, event);
224
225 ret = regmap_read(cs35l41->regmap, CS35L41_DSP_MBOX_2, &fw_status);
226 if (ret < 0) {
227 dev_err(cs35l41->dev,
228 "Failed to read firmware status: %d\n", ret);
229 return ret;
230 }
231
232 switch (fw_status) {
233 case CSPL_MBOX_STS_RUNNING:
234 case CSPL_MBOX_STS_PAUSED:
235 break;
236 default:
237 dev_err(cs35l41->dev, "Firmware status is invalid: %u\n",
238 fw_status);
239 return -EINVAL;
240 }
241
242 return cs35l41_set_cspl_mbox_cmd(cs35l41->dev, cs35l41->regmap,
243 CSPL_MBOX_CMD_RESUME);
244 case SND_SOC_DAPM_PRE_PMD:
245 return cs35l41_set_cspl_mbox_cmd(cs35l41->dev, cs35l41->regmap,
246 CSPL_MBOX_CMD_PAUSE);
247 default:
248 return 0;
249 }
250}
251
252static const char * const cs35l41_pcm_source_texts[] = {"ASP", "DSP"};
253static const unsigned int cs35l41_pcm_source_values[] = {0x08, 0x32};
254static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_pcm_source_enum,
255 CS35L41_DAC_PCM1_SRC,
256 0, CS35L41_ASP_SOURCE_MASK,
257 cs35l41_pcm_source_texts,
258 cs35l41_pcm_source_values);
259
260static const struct snd_kcontrol_new pcm_source_mux =
261 SOC_DAPM_ENUM("PCM Source", cs35l41_pcm_source_enum);
262
263static const char * const cs35l41_tx_input_texts[] = {
264 "Zero", "ASPRX1", "ASPRX2", "VMON", "IMON",
265 "VPMON", "VBSTMON", "DSPTX1", "DSPTX2"
266};
267
268static const unsigned int cs35l41_tx_input_values[] = {
269 0x00, CS35L41_INPUT_SRC_ASPRX1, CS35L41_INPUT_SRC_ASPRX2,
270 CS35L41_INPUT_SRC_VMON, CS35L41_INPUT_SRC_IMON, CS35L41_INPUT_SRC_VPMON,
271 CS35L41_INPUT_SRC_VBSTMON, CS35L41_INPUT_DSP_TX1, CS35L41_INPUT_DSP_TX2
272};
273
274static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx1_enum,
275 CS35L41_ASP_TX1_SRC,
276 0, CS35L41_ASP_SOURCE_MASK,
277 cs35l41_tx_input_texts,
278 cs35l41_tx_input_values);
279
280static const struct snd_kcontrol_new asp_tx1_mux =
281 SOC_DAPM_ENUM("ASPTX1 SRC", cs35l41_asptx1_enum);
282
283static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx2_enum,
284 CS35L41_ASP_TX2_SRC,
285 0, CS35L41_ASP_SOURCE_MASK,
286 cs35l41_tx_input_texts,
287 cs35l41_tx_input_values);
288
289static const struct snd_kcontrol_new asp_tx2_mux =
290 SOC_DAPM_ENUM("ASPTX2 SRC", cs35l41_asptx2_enum);
291
292static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx3_enum,
293 CS35L41_ASP_TX3_SRC,
294 0, CS35L41_ASP_SOURCE_MASK,
295 cs35l41_tx_input_texts,
296 cs35l41_tx_input_values);
297
298static const struct snd_kcontrol_new asp_tx3_mux =
299 SOC_DAPM_ENUM("ASPTX3 SRC", cs35l41_asptx3_enum);
300
301static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx4_enum,
302 CS35L41_ASP_TX4_SRC,
303 0, CS35L41_ASP_SOURCE_MASK,
304 cs35l41_tx_input_texts,
305 cs35l41_tx_input_values);
306
307static const struct snd_kcontrol_new asp_tx4_mux =
308 SOC_DAPM_ENUM("ASPTX4 SRC", cs35l41_asptx4_enum);
309
310static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_dsprx1_enum,
311 CS35L41_DSP1_RX1_SRC,
312 0, CS35L41_ASP_SOURCE_MASK,
313 cs35l41_tx_input_texts,
314 cs35l41_tx_input_values);
315
316static const struct snd_kcontrol_new dsp_rx1_mux =
317 SOC_DAPM_ENUM("DSPRX1 SRC", cs35l41_dsprx1_enum);
318
319static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_dsprx2_enum,
320 CS35L41_DSP1_RX2_SRC,
321 0, CS35L41_ASP_SOURCE_MASK,
322 cs35l41_tx_input_texts,
323 cs35l41_tx_input_values);
324
325static const struct snd_kcontrol_new dsp_rx2_mux =
326 SOC_DAPM_ENUM("DSPRX2 SRC", cs35l41_dsprx2_enum);
327
328static const struct snd_kcontrol_new cs35l41_aud_controls[] = {
329 SOC_SINGLE_SX_TLV("Digital PCM Volume", CS35L41_AMP_DIG_VOL_CTRL,
330 3, 0x4CF, 0x391, dig_vol_tlv),
331 SOC_SINGLE_TLV("Analog PCM Volume", CS35L41_AMP_GAIN_CTRL, 5, 0x14, 0,
332 amp_gain_tlv),
333 SOC_ENUM("PCM Soft Ramp", pcm_sft_ramp),
334 SOC_SINGLE("HW Noise Gate Enable", CS35L41_NG_CFG, 8, 63, 0),
335 SOC_SINGLE("HW Noise Gate Delay", CS35L41_NG_CFG, 4, 7, 0),
336 SOC_SINGLE("HW Noise Gate Threshold", CS35L41_NG_CFG, 0, 7, 0),
337 SOC_SINGLE("Aux Noise Gate CH1 Switch",
338 CS35L41_MIXER_NGATE_CH1_CFG, 16, 1, 0),
339 SOC_SINGLE("Aux Noise Gate CH1 Entry Delay",
340 CS35L41_MIXER_NGATE_CH1_CFG, 8, 15, 0),
341 SOC_SINGLE("Aux Noise Gate CH1 Threshold",
342 CS35L41_MIXER_NGATE_CH1_CFG, 0, 7, 0),
343 SOC_SINGLE("Aux Noise Gate CH2 Entry Delay",
344 CS35L41_MIXER_NGATE_CH2_CFG, 8, 15, 0),
345 SOC_SINGLE("Aux Noise Gate CH2 Switch",
346 CS35L41_MIXER_NGATE_CH2_CFG, 16, 1, 0),
347 SOC_SINGLE("Aux Noise Gate CH2 Threshold",
348 CS35L41_MIXER_NGATE_CH2_CFG, 0, 7, 0),
349 SOC_SINGLE("SCLK Force Switch", CS35L41_SP_FORMAT, CS35L41_SCLK_FRC_SHIFT, 1, 0),
350 SOC_SINGLE("LRCLK Force Switch", CS35L41_SP_FORMAT, CS35L41_LRCLK_FRC_SHIFT, 1, 0),
351 SOC_SINGLE("Invert Class D Switch", CS35L41_AMP_DIG_VOL_CTRL,
352 CS35L41_AMP_INV_PCM_SHIFT, 1, 0),
353 SOC_SINGLE("Amp Gain ZC Switch", CS35L41_AMP_GAIN_CTRL,
354 CS35L41_AMP_GAIN_ZC_SHIFT, 1, 0),
355 WM_ADSP2_PRELOAD_SWITCH("DSP1", 1),
356 WM_ADSP_FW_CONTROL("DSP1", 0),
357};
358
359static irqreturn_t cs35l41_irq(int irq, void *data)
360{
361 struct cs35l41_private *cs35l41 = data;
362 unsigned int status[4] = { 0, 0, 0, 0 };
363 unsigned int masks[4] = { 0, 0, 0, 0 };
364 int ret = IRQ_NONE;
365 unsigned int i;
366
367 pm_runtime_get_sync(cs35l41->dev);
368
369 for (i = 0; i < ARRAY_SIZE(status); i++) {
370 regmap_read(cs35l41->regmap,
371 CS35L41_IRQ1_STATUS1 + (i * CS35L41_REGSTRIDE),
372 &status[i]);
373 regmap_read(cs35l41->regmap,
374 CS35L41_IRQ1_MASK1 + (i * CS35L41_REGSTRIDE),
375 &masks[i]);
376 }
377
378 /* Check to see if unmasked bits are active */
379 if (!(status[0] & ~masks[0]) && !(status[1] & ~masks[1]) &&
380 !(status[2] & ~masks[2]) && !(status[3] & ~masks[3]))
381 goto done;
382
383 if (status[3] & CS35L41_OTP_BOOT_DONE) {
384 regmap_update_bits(cs35l41->regmap, CS35L41_IRQ1_MASK4,
385 CS35L41_OTP_BOOT_DONE, CS35L41_OTP_BOOT_DONE);
386 }
387
388 /*
389 * The following interrupts require a
390 * protection release cycle to get the
391 * speaker out of Safe-Mode.
392 */
393 if (status[0] & CS35L41_AMP_SHORT_ERR) {
394 dev_crit_ratelimited(cs35l41->dev, "Amp short error\n");
395 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
396 CS35L41_AMP_SHORT_ERR);
397 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
398 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
399 CS35L41_AMP_SHORT_ERR_RLS,
400 CS35L41_AMP_SHORT_ERR_RLS);
401 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
402 CS35L41_AMP_SHORT_ERR_RLS, 0);
403 ret = IRQ_HANDLED;
404 }
405
406 if (status[0] & CS35L41_TEMP_WARN) {
407 dev_crit_ratelimited(cs35l41->dev, "Over temperature warning\n");
408 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
409 CS35L41_TEMP_WARN);
410 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
411 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
412 CS35L41_TEMP_WARN_ERR_RLS,
413 CS35L41_TEMP_WARN_ERR_RLS);
414 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
415 CS35L41_TEMP_WARN_ERR_RLS, 0);
416 ret = IRQ_HANDLED;
417 }
418
419 if (status[0] & CS35L41_TEMP_ERR) {
420 dev_crit_ratelimited(cs35l41->dev, "Over temperature error\n");
421 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
422 CS35L41_TEMP_ERR);
423 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
424 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
425 CS35L41_TEMP_ERR_RLS,
426 CS35L41_TEMP_ERR_RLS);
427 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
428 CS35L41_TEMP_ERR_RLS, 0);
429 ret = IRQ_HANDLED;
430 }
431
432 if (status[0] & CS35L41_BST_OVP_ERR) {
433 dev_crit_ratelimited(cs35l41->dev, "VBST Over Voltage error\n");
434 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2,
435 CS35L41_BST_EN_MASK, 0);
436 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
437 CS35L41_BST_OVP_ERR);
438 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
439 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
440 CS35L41_BST_OVP_ERR_RLS,
441 CS35L41_BST_OVP_ERR_RLS);
442 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
443 CS35L41_BST_OVP_ERR_RLS, 0);
444 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2,
445 CS35L41_BST_EN_MASK,
446 CS35L41_BST_EN_DEFAULT << CS35L41_BST_EN_SHIFT);
447 ret = IRQ_HANDLED;
448 }
449
450 if (status[0] & CS35L41_BST_DCM_UVP_ERR) {
451 dev_crit_ratelimited(cs35l41->dev, "DCM VBST Under Voltage Error\n");
452 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2,
453 CS35L41_BST_EN_MASK, 0);
454 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
455 CS35L41_BST_DCM_UVP_ERR);
456 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
457 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
458 CS35L41_BST_UVP_ERR_RLS,
459 CS35L41_BST_UVP_ERR_RLS);
460 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
461 CS35L41_BST_UVP_ERR_RLS, 0);
462 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2,
463 CS35L41_BST_EN_MASK,
464 CS35L41_BST_EN_DEFAULT << CS35L41_BST_EN_SHIFT);
465 ret = IRQ_HANDLED;
466 }
467
468 if (status[0] & CS35L41_BST_SHORT_ERR) {
469 dev_crit_ratelimited(cs35l41->dev, "LBST error: powering off!\n");
470 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2,
471 CS35L41_BST_EN_MASK, 0);
472 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
473 CS35L41_BST_SHORT_ERR);
474 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
475 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
476 CS35L41_BST_SHORT_ERR_RLS,
477 CS35L41_BST_SHORT_ERR_RLS);
478 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN,
479 CS35L41_BST_SHORT_ERR_RLS, 0);
480 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2,
481 CS35L41_BST_EN_MASK,
482 CS35L41_BST_EN_DEFAULT << CS35L41_BST_EN_SHIFT);
483 ret = IRQ_HANDLED;
484 }
485
486done:
487 pm_runtime_mark_last_busy(cs35l41->dev);
488 pm_runtime_put_autosuspend(cs35l41->dev);
489
490 return ret;
491}
492
493static const struct reg_sequence cs35l41_pup_patch[] = {
494 { CS35L41_TEST_KEY_CTL, 0x00000055 },
495 { CS35L41_TEST_KEY_CTL, 0x000000AA },
496 { 0x00002084, 0x002F1AA0 },
497 { CS35L41_TEST_KEY_CTL, 0x000000CC },
498 { CS35L41_TEST_KEY_CTL, 0x00000033 },
499};
500
501static const struct reg_sequence cs35l41_pdn_patch[] = {
502 { CS35L41_TEST_KEY_CTL, 0x00000055 },
503 { CS35L41_TEST_KEY_CTL, 0x000000AA },
504 { 0x00002084, 0x002F1AA3 },
505 { CS35L41_TEST_KEY_CTL, 0x000000CC },
506 { CS35L41_TEST_KEY_CTL, 0x00000033 },
507};
508
509static int cs35l41_main_amp_event(struct snd_soc_dapm_widget *w,
510 struct snd_kcontrol *kcontrol, int event)
511{
512 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
513 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
514 unsigned int val;
515 int ret = 0;
516
517 switch (event) {
518 case SND_SOC_DAPM_PRE_PMU:
519 regmap_multi_reg_write_bypassed(cs35l41->regmap,
520 cs35l41_pup_patch,
521 ARRAY_SIZE(cs35l41_pup_patch));
522
523 cs35l41_global_enable(cs35l41->regmap, cs35l41->hw_cfg.bst_type, 1);
524 break;
525 case SND_SOC_DAPM_POST_PMD:
526 cs35l41_global_enable(cs35l41->regmap, cs35l41->hw_cfg.bst_type, 0);
527
528 ret = regmap_read_poll_timeout(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
529 val, val & CS35L41_PDN_DONE_MASK,
530 1000, 100000);
531 if (ret)
532 dev_warn(cs35l41->dev, "PDN failed: %d\n", ret);
533
534 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1,
535 CS35L41_PDN_DONE_MASK);
536
537 regmap_multi_reg_write_bypassed(cs35l41->regmap,
538 cs35l41_pdn_patch,
539 ARRAY_SIZE(cs35l41_pdn_patch));
540 break;
541 default:
542 dev_err(cs35l41->dev, "Invalid event = 0x%x\n", event);
543 ret = -EINVAL;
544 }
545
546 return ret;
547}
548
549static const struct snd_soc_dapm_widget cs35l41_dapm_widgets[] = {
550 SND_SOC_DAPM_SPK("DSP1 Preload", NULL),
551 SND_SOC_DAPM_SUPPLY_S("DSP1 Preloader", 100, SND_SOC_NOPM, 0, 0,
552 cs35l41_dsp_preload_ev,
553 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
554 SND_SOC_DAPM_OUT_DRV_E("DSP1", SND_SOC_NOPM, 0, 0, NULL, 0,
555 cs35l41_dsp_audio_ev,
556 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
557
558 SND_SOC_DAPM_OUTPUT("SPK"),
559
560 SND_SOC_DAPM_AIF_IN("ASPRX1", NULL, 0, CS35L41_SP_ENABLES, 16, 0),
561 SND_SOC_DAPM_AIF_IN("ASPRX2", NULL, 0, CS35L41_SP_ENABLES, 17, 0),
562 SND_SOC_DAPM_AIF_OUT("ASPTX1", NULL, 0, CS35L41_SP_ENABLES, 0, 0),
563 SND_SOC_DAPM_AIF_OUT("ASPTX2", NULL, 0, CS35L41_SP_ENABLES, 1, 0),
564 SND_SOC_DAPM_AIF_OUT("ASPTX3", NULL, 0, CS35L41_SP_ENABLES, 2, 0),
565 SND_SOC_DAPM_AIF_OUT("ASPTX4", NULL, 0, CS35L41_SP_ENABLES, 3, 0),
566
567 SND_SOC_DAPM_SIGGEN("VSENSE"),
568 SND_SOC_DAPM_SIGGEN("ISENSE"),
569 SND_SOC_DAPM_SIGGEN("VP"),
570 SND_SOC_DAPM_SIGGEN("VBST"),
571 SND_SOC_DAPM_SIGGEN("TEMP"),
572
573 SND_SOC_DAPM_SUPPLY("VMON", CS35L41_PWR_CTRL2, 12, 0, NULL, 0),
574 SND_SOC_DAPM_SUPPLY("IMON", CS35L41_PWR_CTRL2, 13, 0, NULL, 0),
575 SND_SOC_DAPM_SUPPLY("VPMON", CS35L41_PWR_CTRL2, 8, 0, NULL, 0),
576 SND_SOC_DAPM_SUPPLY("VBSTMON", CS35L41_PWR_CTRL2, 9, 0, NULL, 0),
577 SND_SOC_DAPM_SUPPLY("TEMPMON", CS35L41_PWR_CTRL2, 10, 0, NULL, 0),
578
579 SND_SOC_DAPM_ADC("VMON ADC", NULL, SND_SOC_NOPM, 0, 0),
580 SND_SOC_DAPM_ADC("IMON ADC", NULL, SND_SOC_NOPM, 0, 0),
581 SND_SOC_DAPM_ADC("VPMON ADC", NULL, SND_SOC_NOPM, 0, 0),
582 SND_SOC_DAPM_ADC("VBSTMON ADC", NULL, SND_SOC_NOPM, 0, 0),
583 SND_SOC_DAPM_ADC("TEMPMON ADC", NULL, SND_SOC_NOPM, 0, 0),
584
585 SND_SOC_DAPM_ADC("CLASS H", NULL, CS35L41_PWR_CTRL3, 4, 0),
586
587 SND_SOC_DAPM_OUT_DRV_E("Main AMP", CS35L41_PWR_CTRL2, 0, 0, NULL, 0,
588 cs35l41_main_amp_event,
589 SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),
590
591 SND_SOC_DAPM_MUX("ASP TX1 Source", SND_SOC_NOPM, 0, 0, &asp_tx1_mux),
592 SND_SOC_DAPM_MUX("ASP TX2 Source", SND_SOC_NOPM, 0, 0, &asp_tx2_mux),
593 SND_SOC_DAPM_MUX("ASP TX3 Source", SND_SOC_NOPM, 0, 0, &asp_tx3_mux),
594 SND_SOC_DAPM_MUX("ASP TX4 Source", SND_SOC_NOPM, 0, 0, &asp_tx4_mux),
595 SND_SOC_DAPM_MUX("DSP RX1 Source", SND_SOC_NOPM, 0, 0, &dsp_rx1_mux),
596 SND_SOC_DAPM_MUX("DSP RX2 Source", SND_SOC_NOPM, 0, 0, &dsp_rx2_mux),
597 SND_SOC_DAPM_MUX("PCM Source", SND_SOC_NOPM, 0, 0, &pcm_source_mux),
598 SND_SOC_DAPM_SWITCH("DRE", SND_SOC_NOPM, 0, 0, &dre_ctrl),
599};
600
601static const struct snd_soc_dapm_route cs35l41_audio_map[] = {
602 {"DSP RX1 Source", "ASPRX1", "ASPRX1"},
603 {"DSP RX1 Source", "ASPRX2", "ASPRX2"},
604 {"DSP RX2 Source", "ASPRX1", "ASPRX1"},
605 {"DSP RX2 Source", "ASPRX2", "ASPRX2"},
606
607 {"DSP1", NULL, "DSP RX1 Source"},
608 {"DSP1", NULL, "DSP RX2 Source"},
609
610 {"ASP TX1 Source", "VMON", "VMON ADC"},
611 {"ASP TX1 Source", "IMON", "IMON ADC"},
612 {"ASP TX1 Source", "VPMON", "VPMON ADC"},
613 {"ASP TX1 Source", "VBSTMON", "VBSTMON ADC"},
614 {"ASP TX1 Source", "DSPTX1", "DSP1"},
615 {"ASP TX1 Source", "DSPTX2", "DSP1"},
616 {"ASP TX1 Source", "ASPRX1", "ASPRX1" },
617 {"ASP TX1 Source", "ASPRX2", "ASPRX2" },
618 {"ASP TX2 Source", "VMON", "VMON ADC"},
619 {"ASP TX2 Source", "IMON", "IMON ADC"},
620 {"ASP TX2 Source", "VPMON", "VPMON ADC"},
621 {"ASP TX2 Source", "VBSTMON", "VBSTMON ADC"},
622 {"ASP TX2 Source", "DSPTX1", "DSP1"},
623 {"ASP TX2 Source", "DSPTX2", "DSP1"},
624 {"ASP TX2 Source", "ASPRX1", "ASPRX1" },
625 {"ASP TX2 Source", "ASPRX2", "ASPRX2" },
626 {"ASP TX3 Source", "VMON", "VMON ADC"},
627 {"ASP TX3 Source", "IMON", "IMON ADC"},
628 {"ASP TX3 Source", "VPMON", "VPMON ADC"},
629 {"ASP TX3 Source", "VBSTMON", "VBSTMON ADC"},
630 {"ASP TX3 Source", "DSPTX1", "DSP1"},
631 {"ASP TX3 Source", "DSPTX2", "DSP1"},
632 {"ASP TX3 Source", "ASPRX1", "ASPRX1" },
633 {"ASP TX3 Source", "ASPRX2", "ASPRX2" },
634 {"ASP TX4 Source", "VMON", "VMON ADC"},
635 {"ASP TX4 Source", "IMON", "IMON ADC"},
636 {"ASP TX4 Source", "VPMON", "VPMON ADC"},
637 {"ASP TX4 Source", "VBSTMON", "VBSTMON ADC"},
638 {"ASP TX4 Source", "DSPTX1", "DSP1"},
639 {"ASP TX4 Source", "DSPTX2", "DSP1"},
640 {"ASP TX4 Source", "ASPRX1", "ASPRX1" },
641 {"ASP TX4 Source", "ASPRX2", "ASPRX2" },
642 {"ASPTX1", NULL, "ASP TX1 Source"},
643 {"ASPTX2", NULL, "ASP TX2 Source"},
644 {"ASPTX3", NULL, "ASP TX3 Source"},
645 {"ASPTX4", NULL, "ASP TX4 Source"},
646 {"AMP Capture", NULL, "ASPTX1"},
647 {"AMP Capture", NULL, "ASPTX2"},
648 {"AMP Capture", NULL, "ASPTX3"},
649 {"AMP Capture", NULL, "ASPTX4"},
650
651 {"DSP1", NULL, "VMON"},
652 {"DSP1", NULL, "IMON"},
653 {"DSP1", NULL, "VPMON"},
654 {"DSP1", NULL, "VBSTMON"},
655 {"DSP1", NULL, "TEMPMON"},
656
657 {"VMON ADC", NULL, "VMON"},
658 {"IMON ADC", NULL, "IMON"},
659 {"VPMON ADC", NULL, "VPMON"},
660 {"VBSTMON ADC", NULL, "VBSTMON"},
661 {"TEMPMON ADC", NULL, "TEMPMON"},
662
663 {"VMON ADC", NULL, "VSENSE"},
664 {"IMON ADC", NULL, "ISENSE"},
665 {"VPMON ADC", NULL, "VP"},
666 {"VBSTMON ADC", NULL, "VBST"},
667 {"TEMPMON ADC", NULL, "TEMP"},
668
669 {"DSP1 Preload", NULL, "DSP1 Preloader"},
670 {"DSP1", NULL, "DSP1 Preloader"},
671
672 {"ASPRX1", NULL, "AMP Playback"},
673 {"ASPRX2", NULL, "AMP Playback"},
674 {"DRE", "Switch", "CLASS H"},
675 {"Main AMP", NULL, "CLASS H"},
676 {"Main AMP", NULL, "DRE"},
677 {"SPK", NULL, "Main AMP"},
678
679 {"PCM Source", "ASP", "ASPRX1"},
680 {"PCM Source", "DSP", "DSP1"},
681 {"CLASS H", NULL, "PCM Source"},
682};
683
684static int cs35l41_set_channel_map(struct snd_soc_dai *dai, unsigned int tx_n,
685 unsigned int *tx_slot, unsigned int rx_n, unsigned int *rx_slot)
686{
687 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
688
689 return cs35l41_set_channels(cs35l41->dev, cs35l41->regmap, tx_n, tx_slot, rx_n, rx_slot);
690}
691
692static int cs35l41_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
693{
694 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
695 unsigned int daifmt = 0;
696
697 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
698 case SND_SOC_DAIFMT_CBP_CFP:
699 daifmt |= CS35L41_SCLK_MSTR_MASK | CS35L41_LRCLK_MSTR_MASK;
700 break;
701 case SND_SOC_DAIFMT_CBC_CFC:
702 break;
703 default:
704 dev_warn(cs35l41->dev, "Mixed provider/consumer mode unsupported\n");
705 return -EINVAL;
706 }
707
708 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
709 case SND_SOC_DAIFMT_DSP_A:
710 break;
711 case SND_SOC_DAIFMT_I2S:
712 daifmt |= 2 << CS35L41_ASP_FMT_SHIFT;
713 break;
714 default:
715 dev_warn(cs35l41->dev, "Invalid or unsupported DAI format\n");
716 return -EINVAL;
717 }
718
719 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
720 case SND_SOC_DAIFMT_NB_IF:
721 daifmt |= CS35L41_LRCLK_INV_MASK;
722 break;
723 case SND_SOC_DAIFMT_IB_NF:
724 daifmt |= CS35L41_SCLK_INV_MASK;
725 break;
726 case SND_SOC_DAIFMT_IB_IF:
727 daifmt |= CS35L41_LRCLK_INV_MASK | CS35L41_SCLK_INV_MASK;
728 break;
729 case SND_SOC_DAIFMT_NB_NF:
730 break;
731 default:
732 dev_warn(cs35l41->dev, "Invalid DAI clock INV\n");
733 return -EINVAL;
734 }
735
736 return regmap_update_bits(cs35l41->regmap, CS35L41_SP_FORMAT,
737 CS35L41_SCLK_MSTR_MASK | CS35L41_LRCLK_MSTR_MASK |
738 CS35L41_ASP_FMT_MASK | CS35L41_LRCLK_INV_MASK |
739 CS35L41_SCLK_INV_MASK, daifmt);
740}
741
742struct cs35l41_global_fs_config {
743 int rate;
744 int fs_cfg;
745};
746
747static const struct cs35l41_global_fs_config cs35l41_fs_rates[] = {
748 { 12000, 0x01 },
749 { 24000, 0x02 },
750 { 48000, 0x03 },
751 { 96000, 0x04 },
752 { 192000, 0x05 },
753 { 11025, 0x09 },
754 { 22050, 0x0A },
755 { 44100, 0x0B },
756 { 88200, 0x0C },
757 { 176400, 0x0D },
758 { 8000, 0x11 },
759 { 16000, 0x12 },
760 { 32000, 0x13 },
761};
762
763static int cs35l41_pcm_hw_params(struct snd_pcm_substream *substream,
764 struct snd_pcm_hw_params *params,
765 struct snd_soc_dai *dai)
766{
767 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
768 unsigned int rate = params_rate(params);
769 u8 asp_wl;
770 int i;
771
772 for (i = 0; i < ARRAY_SIZE(cs35l41_fs_rates); i++) {
773 if (rate == cs35l41_fs_rates[i].rate)
774 break;
775 }
776
777 if (i >= ARRAY_SIZE(cs35l41_fs_rates)) {
778 dev_err(cs35l41->dev, "Unsupported rate: %u\n", rate);
779 return -EINVAL;
780 }
781
782 asp_wl = params_width(params);
783
784 if (i < ARRAY_SIZE(cs35l41_fs_rates))
785 regmap_update_bits(cs35l41->regmap, CS35L41_GLOBAL_CLK_CTRL,
786 CS35L41_GLOBAL_FS_MASK,
787 cs35l41_fs_rates[i].fs_cfg << CS35L41_GLOBAL_FS_SHIFT);
788
789 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
790 regmap_update_bits(cs35l41->regmap, CS35L41_SP_FORMAT,
791 CS35L41_ASP_WIDTH_RX_MASK,
792 asp_wl << CS35L41_ASP_WIDTH_RX_SHIFT);
793 regmap_update_bits(cs35l41->regmap, CS35L41_SP_RX_WL,
794 CS35L41_ASP_RX_WL_MASK,
795 asp_wl << CS35L41_ASP_RX_WL_SHIFT);
796 } else {
797 regmap_update_bits(cs35l41->regmap, CS35L41_SP_FORMAT,
798 CS35L41_ASP_WIDTH_TX_MASK,
799 asp_wl << CS35L41_ASP_WIDTH_TX_SHIFT);
800 regmap_update_bits(cs35l41->regmap, CS35L41_SP_TX_WL,
801 CS35L41_ASP_TX_WL_MASK,
802 asp_wl << CS35L41_ASP_TX_WL_SHIFT);
803 }
804
805 return 0;
806}
807
808static int cs35l41_get_clk_config(int freq)
809{
810 int i;
811
812 for (i = 0; i < ARRAY_SIZE(cs35l41_pll_sysclk); i++) {
813 if (cs35l41_pll_sysclk[i].freq == freq)
814 return cs35l41_pll_sysclk[i].clk_cfg;
815 }
816
817 return -EINVAL;
818}
819
820static const unsigned int cs35l41_src_rates[] = {
821 8000, 12000, 11025, 16000, 22050, 24000, 32000,
822 44100, 48000, 88200, 96000, 176400, 192000
823};
824
825static const struct snd_pcm_hw_constraint_list cs35l41_constraints = {
826 .count = ARRAY_SIZE(cs35l41_src_rates),
827 .list = cs35l41_src_rates,
828};
829
830static int cs35l41_pcm_startup(struct snd_pcm_substream *substream,
831 struct snd_soc_dai *dai)
832{
833 if (substream->runtime)
834 return snd_pcm_hw_constraint_list(substream->runtime, 0,
835 SNDRV_PCM_HW_PARAM_RATE,
836 &cs35l41_constraints);
837 return 0;
838}
839
840static int cs35l41_component_set_sysclk(struct snd_soc_component *component,
841 int clk_id, int source,
842 unsigned int freq, int dir)
843{
844 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
845 int extclk_cfg, clksrc;
846
847 switch (clk_id) {
848 case CS35L41_CLKID_SCLK:
849 clksrc = CS35L41_PLLSRC_SCLK;
850 break;
851 case CS35L41_CLKID_LRCLK:
852 clksrc = CS35L41_PLLSRC_LRCLK;
853 break;
854 case CS35L41_CLKID_MCLK:
855 clksrc = CS35L41_PLLSRC_MCLK;
856 break;
857 default:
858 dev_err(cs35l41->dev, "Invalid CLK Config\n");
859 return -EINVAL;
860 }
861
862 extclk_cfg = cs35l41_get_clk_config(freq);
863
864 if (extclk_cfg < 0) {
865 dev_err(cs35l41->dev, "Invalid CLK Config: %d, freq: %u\n",
866 extclk_cfg, freq);
867 return -EINVAL;
868 }
869
870 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
871 CS35L41_PLL_OPENLOOP_MASK,
872 1 << CS35L41_PLL_OPENLOOP_SHIFT);
873 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
874 CS35L41_REFCLK_FREQ_MASK,
875 extclk_cfg << CS35L41_REFCLK_FREQ_SHIFT);
876 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
877 CS35L41_PLL_CLK_EN_MASK,
878 0 << CS35L41_PLL_CLK_EN_SHIFT);
879 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
880 CS35L41_PLL_CLK_SEL_MASK, clksrc);
881 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
882 CS35L41_PLL_OPENLOOP_MASK,
883 0 << CS35L41_PLL_OPENLOOP_SHIFT);
884 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
885 CS35L41_PLL_CLK_EN_MASK,
886 1 << CS35L41_PLL_CLK_EN_SHIFT);
887
888 return 0;
889}
890
891static int cs35l41_dai_set_sysclk(struct snd_soc_dai *dai,
892 int clk_id, unsigned int freq, int dir)
893{
894 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
895 unsigned int fs1_val;
896 unsigned int fs2_val;
897 unsigned int val;
898 int fsindex;
899
900 fsindex = cs35l41_get_fs_mon_config_index(freq);
901 if (fsindex < 0) {
902 dev_err(cs35l41->dev, "Invalid CLK Config freq: %u\n", freq);
903 return -EINVAL;
904 }
905
906 dev_dbg(cs35l41->dev, "Set DAI sysclk %d\n", freq);
907
908 if (freq <= 6144000) {
909 /* Use the lookup table */
910 fs1_val = cs35l41_fs_mon[fsindex].fs1;
911 fs2_val = cs35l41_fs_mon[fsindex].fs2;
912 } else {
913 /* Use hard-coded values */
914 fs1_val = 0x10;
915 fs2_val = 0x24;
916 }
917
918 val = fs1_val;
919 val |= (fs2_val << CS35L41_FS2_WINDOW_SHIFT) & CS35L41_FS2_WINDOW_MASK;
920 regmap_write(cs35l41->regmap, CS35L41_TST_FS_MON0, val);
921
922 return 0;
923}
924
925static int cs35l41_set_pdata(struct cs35l41_private *cs35l41)
926{
927 struct cs35l41_hw_cfg *hw_cfg = &cs35l41->hw_cfg;
928 int ret;
929
930 if (!hw_cfg->valid)
931 return -EINVAL;
932
933 if (hw_cfg->bst_type == CS35L41_EXT_BOOST_NO_VSPK_SWITCH)
934 return -EINVAL;
935
936 /* Required */
937 ret = cs35l41_init_boost(cs35l41->dev, cs35l41->regmap, hw_cfg);
938 if (ret)
939 return ret;
940
941 /* Optional */
942 if (hw_cfg->dout_hiz <= CS35L41_ASP_DOUT_HIZ_MASK && hw_cfg->dout_hiz >= 0)
943 regmap_update_bits(cs35l41->regmap, CS35L41_SP_HIZ_CTRL, CS35L41_ASP_DOUT_HIZ_MASK,
944 hw_cfg->dout_hiz);
945
946 return 0;
947}
948
949static const struct snd_soc_dapm_route cs35l41_ext_bst_routes[] = {
950 {"Main AMP", NULL, "VSPK"},
951};
952
953static const struct snd_soc_dapm_widget cs35l41_ext_bst_widget[] = {
954 SND_SOC_DAPM_SUPPLY("VSPK", CS35L41_GPIO1_CTRL1, CS35L41_GPIO_LVL_SHIFT, 0, NULL, 0),
955};
956
957static int cs35l41_component_probe(struct snd_soc_component *component)
958{
959 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
960 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
961 int ret;
962
963 if (cs35l41->hw_cfg.bst_type == CS35L41_EXT_BOOST) {
964 ret = snd_soc_dapm_new_controls(dapm, cs35l41_ext_bst_widget,
965 ARRAY_SIZE(cs35l41_ext_bst_widget));
966 if (ret)
967 return ret;
968
969 ret = snd_soc_dapm_add_routes(dapm, cs35l41_ext_bst_routes,
970 ARRAY_SIZE(cs35l41_ext_bst_routes));
971 if (ret)
972 return ret;
973 }
974
975 return wm_adsp2_component_probe(&cs35l41->dsp, component);
976}
977
978static void cs35l41_component_remove(struct snd_soc_component *component)
979{
980 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
981
982 wm_adsp2_component_remove(&cs35l41->dsp, component);
983}
984
985static const struct snd_soc_dai_ops cs35l41_ops = {
986 .startup = cs35l41_pcm_startup,
987 .set_fmt = cs35l41_set_dai_fmt,
988 .hw_params = cs35l41_pcm_hw_params,
989 .set_sysclk = cs35l41_dai_set_sysclk,
990 .set_channel_map = cs35l41_set_channel_map,
991};
992
993static struct snd_soc_dai_driver cs35l41_dai[] = {
994 {
995 .name = "cs35l41-pcm",
996 .id = 0,
997 .playback = {
998 .stream_name = "AMP Playback",
999 .channels_min = 1,
1000 .channels_max = 2,
1001 .rates = SNDRV_PCM_RATE_KNOT,
1002 .formats = CS35L41_RX_FORMATS,
1003 },
1004 .capture = {
1005 .stream_name = "AMP Capture",
1006 .channels_min = 1,
1007 .channels_max = 4,
1008 .rates = SNDRV_PCM_RATE_KNOT,
1009 .formats = CS35L41_TX_FORMATS,
1010 },
1011 .ops = &cs35l41_ops,
1012 .symmetric_rate = 1,
1013 },
1014};
1015
1016static const struct snd_soc_component_driver soc_component_dev_cs35l41 = {
1017 .name = "cs35l41-codec",
1018 .probe = cs35l41_component_probe,
1019 .remove = cs35l41_component_remove,
1020
1021 .dapm_widgets = cs35l41_dapm_widgets,
1022 .num_dapm_widgets = ARRAY_SIZE(cs35l41_dapm_widgets),
1023 .dapm_routes = cs35l41_audio_map,
1024 .num_dapm_routes = ARRAY_SIZE(cs35l41_audio_map),
1025
1026 .controls = cs35l41_aud_controls,
1027 .num_controls = ARRAY_SIZE(cs35l41_aud_controls),
1028 .set_sysclk = cs35l41_component_set_sysclk,
1029
1030 .endianness = 1,
1031};
1032
1033static int cs35l41_handle_pdata(struct device *dev, struct cs35l41_hw_cfg *hw_cfg)
1034{
1035 struct cs35l41_gpio_cfg *gpio1 = &hw_cfg->gpio1;
1036 struct cs35l41_gpio_cfg *gpio2 = &hw_cfg->gpio2;
1037 unsigned int val;
1038 int ret;
1039
1040 ret = device_property_read_u32(dev, "cirrus,boost-type", &val);
1041 if (ret >= 0)
1042 hw_cfg->bst_type = val;
1043
1044 ret = device_property_read_u32(dev, "cirrus,boost-peak-milliamp", &val);
1045 if (ret >= 0)
1046 hw_cfg->bst_ipk = val;
1047 else
1048 hw_cfg->bst_ipk = -1;
1049
1050 ret = device_property_read_u32(dev, "cirrus,boost-ind-nanohenry", &val);
1051 if (ret >= 0)
1052 hw_cfg->bst_ind = val;
1053 else
1054 hw_cfg->bst_ind = -1;
1055
1056 ret = device_property_read_u32(dev, "cirrus,boost-cap-microfarad", &val);
1057 if (ret >= 0)
1058 hw_cfg->bst_cap = val;
1059 else
1060 hw_cfg->bst_cap = -1;
1061
1062 ret = device_property_read_u32(dev, "cirrus,asp-sdout-hiz", &val);
1063 if (ret >= 0)
1064 hw_cfg->dout_hiz = val;
1065 else
1066 hw_cfg->dout_hiz = -1;
1067
1068 /* GPIO1 Pin Config */
1069 gpio1->pol_inv = device_property_read_bool(dev, "cirrus,gpio1-polarity-invert");
1070 gpio1->out_en = device_property_read_bool(dev, "cirrus,gpio1-output-enable");
1071 ret = device_property_read_u32(dev, "cirrus,gpio1-src-select", &val);
1072 if (ret >= 0) {
1073 gpio1->func = val;
1074 gpio1->valid = true;
1075 }
1076
1077 /* GPIO2 Pin Config */
1078 gpio2->pol_inv = device_property_read_bool(dev, "cirrus,gpio2-polarity-invert");
1079 gpio2->out_en = device_property_read_bool(dev, "cirrus,gpio2-output-enable");
1080 ret = device_property_read_u32(dev, "cirrus,gpio2-src-select", &val);
1081 if (ret >= 0) {
1082 gpio2->func = val;
1083 gpio2->valid = true;
1084 }
1085
1086 hw_cfg->valid = true;
1087
1088 return 0;
1089}
1090
1091static int cs35l41_dsp_init(struct cs35l41_private *cs35l41)
1092{
1093 struct wm_adsp *dsp;
1094 int ret;
1095
1096 dsp = &cs35l41->dsp;
1097 dsp->part = "cs35l41";
1098 dsp->fw = 9; /* 9 is WM_ADSP_FW_SPK_PROT in wm_adsp.c */
1099 dsp->toggle_preload = true;
1100
1101 cs35l41_configure_cs_dsp(cs35l41->dev, cs35l41->regmap, &dsp->cs_dsp);
1102
1103 ret = cs35l41_write_fs_errata(cs35l41->dev, cs35l41->regmap);
1104 if (ret < 0)
1105 return ret;
1106
1107 ret = wm_halo_init(dsp);
1108 if (ret) {
1109 dev_err(cs35l41->dev, "wm_halo_init failed: %d\n", ret);
1110 return ret;
1111 }
1112
1113 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX5_SRC,
1114 CS35L41_INPUT_SRC_VPMON);
1115 if (ret < 0) {
1116 dev_err(cs35l41->dev, "Write INPUT_SRC_VPMON failed: %d\n", ret);
1117 goto err_dsp;
1118 }
1119 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX6_SRC,
1120 CS35L41_INPUT_SRC_CLASSH);
1121 if (ret < 0) {
1122 dev_err(cs35l41->dev, "Write INPUT_SRC_CLASSH failed: %d\n", ret);
1123 goto err_dsp;
1124 }
1125 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX7_SRC,
1126 CS35L41_INPUT_SRC_TEMPMON);
1127 if (ret < 0) {
1128 dev_err(cs35l41->dev, "Write INPUT_SRC_TEMPMON failed: %d\n", ret);
1129 goto err_dsp;
1130 }
1131 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX8_SRC,
1132 CS35L41_INPUT_SRC_RSVD);
1133 if (ret < 0) {
1134 dev_err(cs35l41->dev, "Write INPUT_SRC_RSVD failed: %d\n", ret);
1135 goto err_dsp;
1136 }
1137
1138 return 0;
1139
1140err_dsp:
1141 wm_adsp2_remove(dsp);
1142
1143 return ret;
1144}
1145
1146static int cs35l41_acpi_get_name(struct cs35l41_private *cs35l41)
1147{
1148 acpi_handle handle = ACPI_HANDLE(cs35l41->dev);
1149 const char *sub;
1150
1151 /* If there is no ACPI_HANDLE, there is no ACPI for this system, return 0 */
1152 if (!handle)
1153 return 0;
1154
1155 sub = acpi_get_subsystem_id(handle);
1156 if (IS_ERR(sub)) {
1157 /* If bad ACPI, return 0 and fallback to legacy firmware path, otherwise fail */
1158 if (PTR_ERR(sub) == -ENODATA)
1159 return 0;
1160 else
1161 return PTR_ERR(sub);
1162 }
1163
1164 cs35l41->dsp.system_name = sub;
1165 dev_dbg(cs35l41->dev, "Subsystem ID: %s\n", cs35l41->dsp.system_name);
1166
1167 return 0;
1168}
1169
1170int cs35l41_probe(struct cs35l41_private *cs35l41, const struct cs35l41_hw_cfg *hw_cfg)
1171{
1172 u32 regid, reg_revid, i, mtl_revid, int_status, chipid_match;
1173 int irq_pol = 0;
1174 int ret;
1175
1176 if (hw_cfg) {
1177 cs35l41->hw_cfg = *hw_cfg;
1178 } else {
1179 ret = cs35l41_handle_pdata(cs35l41->dev, &cs35l41->hw_cfg);
1180 if (ret != 0)
1181 return ret;
1182 }
1183
1184 for (i = 0; i < CS35L41_NUM_SUPPLIES; i++)
1185 cs35l41->supplies[i].supply = cs35l41_supplies[i];
1186
1187 ret = devm_regulator_bulk_get(cs35l41->dev, CS35L41_NUM_SUPPLIES,
1188 cs35l41->supplies);
1189 if (ret != 0) {
1190 dev_err(cs35l41->dev, "Failed to request core supplies: %d\n", ret);
1191 return ret;
1192 }
1193
1194 ret = regulator_bulk_enable(CS35L41_NUM_SUPPLIES, cs35l41->supplies);
1195 if (ret != 0) {
1196 dev_err(cs35l41->dev, "Failed to enable core supplies: %d\n", ret);
1197 return ret;
1198 }
1199
1200 /* returning NULL can be an option if in stereo mode */
1201 cs35l41->reset_gpio = devm_gpiod_get_optional(cs35l41->dev, "reset",
1202 GPIOD_OUT_LOW);
1203 if (IS_ERR(cs35l41->reset_gpio)) {
1204 ret = PTR_ERR(cs35l41->reset_gpio);
1205 cs35l41->reset_gpio = NULL;
1206 if (ret == -EBUSY) {
1207 dev_info(cs35l41->dev,
1208 "Reset line busy, assuming shared reset\n");
1209 } else {
1210 dev_err(cs35l41->dev,
1211 "Failed to get reset GPIO: %d\n", ret);
1212 goto err;
1213 }
1214 }
1215 if (cs35l41->reset_gpio) {
1216 /* satisfy minimum reset pulse width spec */
1217 usleep_range(2000, 2100);
1218 gpiod_set_value_cansleep(cs35l41->reset_gpio, 1);
1219 }
1220
1221 usleep_range(2000, 2100);
1222
1223 ret = regmap_read_poll_timeout(cs35l41->regmap, CS35L41_IRQ1_STATUS4,
1224 int_status, int_status & CS35L41_OTP_BOOT_DONE,
1225 1000, 100000);
1226 if (ret) {
1227 dev_err(cs35l41->dev,
1228 "Failed waiting for OTP_BOOT_DONE: %d\n", ret);
1229 goto err;
1230 }
1231
1232 regmap_read(cs35l41->regmap, CS35L41_IRQ1_STATUS3, &int_status);
1233 if (int_status & CS35L41_OTP_BOOT_ERR) {
1234 dev_err(cs35l41->dev, "OTP Boot error\n");
1235 ret = -EINVAL;
1236 goto err;
1237 }
1238
1239 ret = regmap_read(cs35l41->regmap, CS35L41_DEVID, ®id);
1240 if (ret < 0) {
1241 dev_err(cs35l41->dev, "Get Device ID failed: %d\n", ret);
1242 goto err;
1243 }
1244
1245 ret = regmap_read(cs35l41->regmap, CS35L41_REVID, ®_revid);
1246 if (ret < 0) {
1247 dev_err(cs35l41->dev, "Get Revision ID failed: %d\n", ret);
1248 goto err;
1249 }
1250
1251 mtl_revid = reg_revid & CS35L41_MTLREVID_MASK;
1252
1253 /* CS35L41 will have even MTLREVID
1254 * CS35L41R will have odd MTLREVID
1255 */
1256 chipid_match = (mtl_revid % 2) ? CS35L41R_CHIP_ID : CS35L41_CHIP_ID;
1257 if (regid != chipid_match) {
1258 dev_err(cs35l41->dev, "CS35L41 Device ID (%X). Expected ID %X\n",
1259 regid, chipid_match);
1260 ret = -ENODEV;
1261 goto err;
1262 }
1263
1264 cs35l41_test_key_unlock(cs35l41->dev, cs35l41->regmap);
1265
1266 ret = cs35l41_register_errata_patch(cs35l41->dev, cs35l41->regmap, reg_revid);
1267 if (ret)
1268 goto err;
1269
1270 ret = cs35l41_otp_unpack(cs35l41->dev, cs35l41->regmap);
1271 if (ret < 0) {
1272 dev_err(cs35l41->dev, "OTP Unpack failed: %d\n", ret);
1273 goto err;
1274 }
1275
1276 cs35l41_test_key_lock(cs35l41->dev, cs35l41->regmap);
1277
1278 irq_pol = cs35l41_gpio_config(cs35l41->regmap, &cs35l41->hw_cfg);
1279
1280 /* Set interrupt masks for critical errors */
1281 regmap_write(cs35l41->regmap, CS35L41_IRQ1_MASK1,
1282 CS35L41_INT1_MASK_DEFAULT);
1283
1284 ret = devm_request_threaded_irq(cs35l41->dev, cs35l41->irq, NULL, cs35l41_irq,
1285 IRQF_ONESHOT | IRQF_SHARED | irq_pol,
1286 "cs35l41", cs35l41);
1287 if (ret != 0) {
1288 dev_err(cs35l41->dev, "Failed to request IRQ: %d\n", ret);
1289 goto err;
1290 }
1291
1292 ret = cs35l41_set_pdata(cs35l41);
1293 if (ret < 0) {
1294 dev_err(cs35l41->dev, "Set pdata failed: %d\n", ret);
1295 goto err;
1296 }
1297
1298 ret = cs35l41_acpi_get_name(cs35l41);
1299 if (ret < 0)
1300 goto err;
1301
1302 ret = cs35l41_dsp_init(cs35l41);
1303 if (ret < 0)
1304 goto err;
1305
1306 pm_runtime_set_autosuspend_delay(cs35l41->dev, 3000);
1307 pm_runtime_use_autosuspend(cs35l41->dev);
1308 pm_runtime_mark_last_busy(cs35l41->dev);
1309 pm_runtime_set_active(cs35l41->dev);
1310 pm_runtime_get_noresume(cs35l41->dev);
1311 pm_runtime_enable(cs35l41->dev);
1312
1313 ret = devm_snd_soc_register_component(cs35l41->dev,
1314 &soc_component_dev_cs35l41,
1315 cs35l41_dai, ARRAY_SIZE(cs35l41_dai));
1316 if (ret < 0) {
1317 dev_err(cs35l41->dev, "Register codec failed: %d\n", ret);
1318 goto err_pm;
1319 }
1320
1321 pm_runtime_put_autosuspend(cs35l41->dev);
1322
1323 dev_info(cs35l41->dev, "Cirrus Logic CS35L41 (%x), Revision: %02X\n",
1324 regid, reg_revid);
1325
1326 return 0;
1327
1328err_pm:
1329 pm_runtime_disable(cs35l41->dev);
1330 pm_runtime_put_noidle(cs35l41->dev);
1331
1332 wm_adsp2_remove(&cs35l41->dsp);
1333err:
1334 cs35l41_safe_reset(cs35l41->regmap, cs35l41->hw_cfg.bst_type);
1335 regulator_bulk_disable(CS35L41_NUM_SUPPLIES, cs35l41->supplies);
1336 gpiod_set_value_cansleep(cs35l41->reset_gpio, 0);
1337
1338 return ret;
1339}
1340EXPORT_SYMBOL_GPL(cs35l41_probe);
1341
1342void cs35l41_remove(struct cs35l41_private *cs35l41)
1343{
1344 pm_runtime_get_sync(cs35l41->dev);
1345 pm_runtime_disable(cs35l41->dev);
1346
1347 regmap_write(cs35l41->regmap, CS35L41_IRQ1_MASK1, 0xFFFFFFFF);
1348 kfree(cs35l41->dsp.system_name);
1349 wm_adsp2_remove(&cs35l41->dsp);
1350 cs35l41_safe_reset(cs35l41->regmap, cs35l41->hw_cfg.bst_type);
1351
1352 pm_runtime_put_noidle(cs35l41->dev);
1353
1354 regulator_bulk_disable(CS35L41_NUM_SUPPLIES, cs35l41->supplies);
1355 gpiod_set_value_cansleep(cs35l41->reset_gpio, 0);
1356}
1357EXPORT_SYMBOL_GPL(cs35l41_remove);
1358
1359static int __maybe_unused cs35l41_runtime_suspend(struct device *dev)
1360{
1361 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1362
1363 dev_dbg(cs35l41->dev, "Runtime suspend\n");
1364
1365 if (!cs35l41->dsp.preloaded || !cs35l41->dsp.cs_dsp.running)
1366 return 0;
1367
1368 cs35l41_enter_hibernate(dev, cs35l41->regmap, cs35l41->hw_cfg.bst_type);
1369
1370 regcache_cache_only(cs35l41->regmap, true);
1371 regcache_mark_dirty(cs35l41->regmap);
1372
1373 return 0;
1374}
1375
1376static int __maybe_unused cs35l41_runtime_resume(struct device *dev)
1377{
1378 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1379 int ret;
1380
1381 dev_dbg(cs35l41->dev, "Runtime resume\n");
1382
1383 if (!cs35l41->dsp.preloaded || !cs35l41->dsp.cs_dsp.running)
1384 return 0;
1385
1386 regcache_cache_only(cs35l41->regmap, false);
1387
1388 ret = cs35l41_exit_hibernate(cs35l41->dev, cs35l41->regmap);
1389 if (ret)
1390 return ret;
1391
1392 /* Test key needs to be unlocked to allow the OTP settings to re-apply */
1393 cs35l41_test_key_unlock(cs35l41->dev, cs35l41->regmap);
1394 ret = regcache_sync(cs35l41->regmap);
1395 cs35l41_test_key_lock(cs35l41->dev, cs35l41->regmap);
1396 if (ret) {
1397 dev_err(cs35l41->dev, "Failed to restore register cache: %d\n", ret);
1398 return ret;
1399 }
1400 cs35l41_init_boost(cs35l41->dev, cs35l41->regmap, &cs35l41->hw_cfg);
1401
1402 return 0;
1403}
1404
1405static int __maybe_unused cs35l41_sys_suspend(struct device *dev)
1406{
1407 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1408
1409 dev_dbg(cs35l41->dev, "System suspend, disabling IRQ\n");
1410 disable_irq(cs35l41->irq);
1411
1412 return 0;
1413}
1414
1415static int __maybe_unused cs35l41_sys_suspend_noirq(struct device *dev)
1416{
1417 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1418
1419 dev_dbg(cs35l41->dev, "Late system suspend, reenabling IRQ\n");
1420 enable_irq(cs35l41->irq);
1421
1422 return 0;
1423}
1424
1425static int __maybe_unused cs35l41_sys_resume_noirq(struct device *dev)
1426{
1427 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1428
1429 dev_dbg(cs35l41->dev, "Early system resume, disabling IRQ\n");
1430 disable_irq(cs35l41->irq);
1431
1432 return 0;
1433}
1434
1435static int __maybe_unused cs35l41_sys_resume(struct device *dev)
1436{
1437 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1438
1439 dev_dbg(cs35l41->dev, "System resume, reenabling IRQ\n");
1440 enable_irq(cs35l41->irq);
1441
1442 return 0;
1443}
1444
1445const struct dev_pm_ops cs35l41_pm_ops = {
1446 SET_RUNTIME_PM_OPS(cs35l41_runtime_suspend, cs35l41_runtime_resume, NULL)
1447
1448 SET_SYSTEM_SLEEP_PM_OPS(cs35l41_sys_suspend, cs35l41_sys_resume)
1449 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(cs35l41_sys_suspend_noirq, cs35l41_sys_resume_noirq)
1450};
1451EXPORT_SYMBOL_GPL(cs35l41_pm_ops);
1452
1453MODULE_DESCRIPTION("ASoC CS35L41 driver");
1454MODULE_AUTHOR("David Rhodes, Cirrus Logic Inc, <david.rhodes@cirrus.com>");
1455MODULE_LICENSE("GPL");
1// SPDX-License-Identifier: GPL-2.0
2//
3// cs35l41.c -- CS35l41 ALSA SoC audio driver
4//
5// Copyright 2017-2021 Cirrus Logic, Inc.
6//
7// Author: David Rhodes <david.rhodes@cirrus.com>
8
9#include <linux/acpi.h>
10#include <linux/delay.h>
11#include <linux/err.h>
12#include <linux/init.h>
13#include <linux/kernel.h>
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/pm_runtime.h>
17#include <linux/property.h>
18#include <sound/initval.h>
19#include <sound/pcm.h>
20#include <sound/pcm_params.h>
21#include <sound/soc.h>
22#include <sound/soc-dapm.h>
23#include <sound/tlv.h>
24
25#include "cs35l41.h"
26
27static const char * const cs35l41_supplies[CS35L41_NUM_SUPPLIES] = {
28 "VA",
29 "VP",
30};
31
32struct cs35l41_pll_sysclk_config {
33 int freq;
34 int clk_cfg;
35};
36
37static const struct cs35l41_pll_sysclk_config cs35l41_pll_sysclk[] = {
38 { 32768, 0x00 },
39 { 8000, 0x01 },
40 { 11025, 0x02 },
41 { 12000, 0x03 },
42 { 16000, 0x04 },
43 { 22050, 0x05 },
44 { 24000, 0x06 },
45 { 32000, 0x07 },
46 { 44100, 0x08 },
47 { 48000, 0x09 },
48 { 88200, 0x0A },
49 { 96000, 0x0B },
50 { 128000, 0x0C },
51 { 176400, 0x0D },
52 { 192000, 0x0E },
53 { 256000, 0x0F },
54 { 352800, 0x10 },
55 { 384000, 0x11 },
56 { 512000, 0x12 },
57 { 705600, 0x13 },
58 { 750000, 0x14 },
59 { 768000, 0x15 },
60 { 1000000, 0x16 },
61 { 1024000, 0x17 },
62 { 1200000, 0x18 },
63 { 1411200, 0x19 },
64 { 1500000, 0x1A },
65 { 1536000, 0x1B },
66 { 2000000, 0x1C },
67 { 2048000, 0x1D },
68 { 2400000, 0x1E },
69 { 2822400, 0x1F },
70 { 3000000, 0x20 },
71 { 3072000, 0x21 },
72 { 3200000, 0x22 },
73 { 4000000, 0x23 },
74 { 4096000, 0x24 },
75 { 4800000, 0x25 },
76 { 5644800, 0x26 },
77 { 6000000, 0x27 },
78 { 6144000, 0x28 },
79 { 6250000, 0x29 },
80 { 6400000, 0x2A },
81 { 6500000, 0x2B },
82 { 6750000, 0x2C },
83 { 7526400, 0x2D },
84 { 8000000, 0x2E },
85 { 8192000, 0x2F },
86 { 9600000, 0x30 },
87 { 11289600, 0x31 },
88 { 12000000, 0x32 },
89 { 12288000, 0x33 },
90 { 12500000, 0x34 },
91 { 12800000, 0x35 },
92 { 13000000, 0x36 },
93 { 13500000, 0x37 },
94 { 19200000, 0x38 },
95 { 22579200, 0x39 },
96 { 24000000, 0x3A },
97 { 24576000, 0x3B },
98 { 25000000, 0x3C },
99 { 25600000, 0x3D },
100 { 26000000, 0x3E },
101 { 27000000, 0x3F },
102};
103
104struct cs35l41_fs_mon_config {
105 int freq;
106 unsigned int fs1;
107 unsigned int fs2;
108};
109
110static const struct cs35l41_fs_mon_config cs35l41_fs_mon[] = {
111 { 32768, 2254, 3754 },
112 { 8000, 9220, 15364 },
113 { 11025, 6148, 10244 },
114 { 12000, 6148, 10244 },
115 { 16000, 4612, 7684 },
116 { 22050, 3076, 5124 },
117 { 24000, 3076, 5124 },
118 { 32000, 2308, 3844 },
119 { 44100, 1540, 2564 },
120 { 48000, 1540, 2564 },
121 { 88200, 772, 1284 },
122 { 96000, 772, 1284 },
123 { 128000, 580, 964 },
124 { 176400, 388, 644 },
125 { 192000, 388, 644 },
126 { 256000, 292, 484 },
127 { 352800, 196, 324 },
128 { 384000, 196, 324 },
129 { 512000, 148, 244 },
130 { 705600, 100, 164 },
131 { 750000, 100, 164 },
132 { 768000, 100, 164 },
133 { 1000000, 76, 124 },
134 { 1024000, 76, 124 },
135 { 1200000, 64, 104 },
136 { 1411200, 52, 84 },
137 { 1500000, 52, 84 },
138 { 1536000, 52, 84 },
139 { 2000000, 40, 64 },
140 { 2048000, 40, 64 },
141 { 2400000, 34, 54 },
142 { 2822400, 28, 44 },
143 { 3000000, 28, 44 },
144 { 3072000, 28, 44 },
145 { 3200000, 27, 42 },
146 { 4000000, 22, 34 },
147 { 4096000, 22, 34 },
148 { 4800000, 19, 29 },
149 { 5644800, 16, 24 },
150 { 6000000, 16, 24 },
151 { 6144000, 16, 24 },
152 { 12288000, 0, 0 },
153};
154
155static int cs35l41_get_fs_mon_config_index(int freq)
156{
157 int i;
158
159 for (i = 0; i < ARRAY_SIZE(cs35l41_fs_mon); i++) {
160 if (cs35l41_fs_mon[i].freq == freq)
161 return i;
162 }
163
164 return -EINVAL;
165}
166
167static const DECLARE_TLV_DB_RANGE(dig_vol_tlv,
168 0, 0, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 1),
169 1, 913, TLV_DB_MINMAX_ITEM(-10200, 1200));
170static DECLARE_TLV_DB_SCALE(amp_gain_tlv, 50, 100, 0);
171
172static const struct snd_kcontrol_new dre_ctrl =
173 SOC_DAPM_SINGLE("Switch", CS35L41_PWR_CTRL3, 20, 1, 0);
174
175static const char * const cs35l41_pcm_sftramp_text[] = {
176 "Off", ".5ms", "1ms", "2ms", "4ms", "8ms", "15ms", "30ms"
177};
178
179static SOC_ENUM_SINGLE_DECL(pcm_sft_ramp,
180 CS35L41_AMP_DIG_VOL_CTRL, 0,
181 cs35l41_pcm_sftramp_text);
182
183static int cs35l41_dsp_preload_ev(struct snd_soc_dapm_widget *w,
184 struct snd_kcontrol *kcontrol, int event)
185{
186 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
187 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
188 int ret;
189
190 switch (event) {
191 case SND_SOC_DAPM_PRE_PMU:
192 if (cs35l41->dsp.cs_dsp.booted)
193 return 0;
194
195 return wm_adsp_early_event(w, kcontrol, event);
196 case SND_SOC_DAPM_PRE_PMD:
197 if (cs35l41->dsp.preloaded)
198 return 0;
199
200 if (cs35l41->dsp.cs_dsp.running) {
201 ret = wm_adsp_event(w, kcontrol, event);
202 if (ret)
203 return ret;
204 }
205
206 return wm_adsp_early_event(w, kcontrol, event);
207 default:
208 return 0;
209 }
210}
211
212static int cs35l41_dsp_audio_ev(struct snd_soc_dapm_widget *w,
213 struct snd_kcontrol *kcontrol, int event)
214{
215 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
216 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
217 unsigned int fw_status;
218 int ret;
219
220 switch (event) {
221 case SND_SOC_DAPM_POST_PMU:
222 if (!cs35l41->dsp.cs_dsp.running)
223 return wm_adsp_event(w, kcontrol, event);
224
225 ret = regmap_read(cs35l41->regmap, CS35L41_DSP_MBOX_2, &fw_status);
226 if (ret < 0) {
227 dev_err(cs35l41->dev,
228 "Failed to read firmware status: %d\n", ret);
229 return ret;
230 }
231
232 switch (fw_status) {
233 case CSPL_MBOX_STS_RUNNING:
234 case CSPL_MBOX_STS_PAUSED:
235 break;
236 default:
237 dev_err(cs35l41->dev, "Firmware status is invalid: %u\n",
238 fw_status);
239 return -EINVAL;
240 }
241
242 return cs35l41_set_cspl_mbox_cmd(cs35l41->dev, cs35l41->regmap,
243 CSPL_MBOX_CMD_RESUME);
244 case SND_SOC_DAPM_PRE_PMD:
245 return cs35l41_set_cspl_mbox_cmd(cs35l41->dev, cs35l41->regmap,
246 CSPL_MBOX_CMD_PAUSE);
247 default:
248 return 0;
249 }
250}
251
252static const char * const cs35l41_pcm_source_texts[] = {"ASP", "DSP"};
253static const unsigned int cs35l41_pcm_source_values[] = {0x08, 0x32};
254static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_pcm_source_enum,
255 CS35L41_DAC_PCM1_SRC,
256 0, CS35L41_ASP_SOURCE_MASK,
257 cs35l41_pcm_source_texts,
258 cs35l41_pcm_source_values);
259
260static const struct snd_kcontrol_new pcm_source_mux =
261 SOC_DAPM_ENUM("PCM Source", cs35l41_pcm_source_enum);
262
263static const char * const cs35l41_tx_input_texts[] = {
264 "Zero", "ASPRX1", "ASPRX2", "VMON", "IMON",
265 "VPMON", "VBSTMON", "DSPTX1", "DSPTX2"
266};
267
268static const unsigned int cs35l41_tx_input_values[] = {
269 0x00, CS35L41_INPUT_SRC_ASPRX1, CS35L41_INPUT_SRC_ASPRX2,
270 CS35L41_INPUT_SRC_VMON, CS35L41_INPUT_SRC_IMON, CS35L41_INPUT_SRC_VPMON,
271 CS35L41_INPUT_SRC_VBSTMON, CS35L41_INPUT_DSP_TX1, CS35L41_INPUT_DSP_TX2
272};
273
274static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx1_enum,
275 CS35L41_ASP_TX1_SRC,
276 0, CS35L41_ASP_SOURCE_MASK,
277 cs35l41_tx_input_texts,
278 cs35l41_tx_input_values);
279
280static const struct snd_kcontrol_new asp_tx1_mux =
281 SOC_DAPM_ENUM("ASPTX1 SRC", cs35l41_asptx1_enum);
282
283static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx2_enum,
284 CS35L41_ASP_TX2_SRC,
285 0, CS35L41_ASP_SOURCE_MASK,
286 cs35l41_tx_input_texts,
287 cs35l41_tx_input_values);
288
289static const struct snd_kcontrol_new asp_tx2_mux =
290 SOC_DAPM_ENUM("ASPTX2 SRC", cs35l41_asptx2_enum);
291
292static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx3_enum,
293 CS35L41_ASP_TX3_SRC,
294 0, CS35L41_ASP_SOURCE_MASK,
295 cs35l41_tx_input_texts,
296 cs35l41_tx_input_values);
297
298static const struct snd_kcontrol_new asp_tx3_mux =
299 SOC_DAPM_ENUM("ASPTX3 SRC", cs35l41_asptx3_enum);
300
301static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_asptx4_enum,
302 CS35L41_ASP_TX4_SRC,
303 0, CS35L41_ASP_SOURCE_MASK,
304 cs35l41_tx_input_texts,
305 cs35l41_tx_input_values);
306
307static const struct snd_kcontrol_new asp_tx4_mux =
308 SOC_DAPM_ENUM("ASPTX4 SRC", cs35l41_asptx4_enum);
309
310static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_dsprx1_enum,
311 CS35L41_DSP1_RX1_SRC,
312 0, CS35L41_ASP_SOURCE_MASK,
313 cs35l41_tx_input_texts,
314 cs35l41_tx_input_values);
315
316static const struct snd_kcontrol_new dsp_rx1_mux =
317 SOC_DAPM_ENUM("DSPRX1 SRC", cs35l41_dsprx1_enum);
318
319static SOC_VALUE_ENUM_SINGLE_DECL(cs35l41_dsprx2_enum,
320 CS35L41_DSP1_RX2_SRC,
321 0, CS35L41_ASP_SOURCE_MASK,
322 cs35l41_tx_input_texts,
323 cs35l41_tx_input_values);
324
325static const struct snd_kcontrol_new dsp_rx2_mux =
326 SOC_DAPM_ENUM("DSPRX2 SRC", cs35l41_dsprx2_enum);
327
328static const struct snd_kcontrol_new cs35l41_aud_controls[] = {
329 SOC_SINGLE_SX_TLV("Digital PCM Volume", CS35L41_AMP_DIG_VOL_CTRL,
330 3, 0x4CF, 0x391, dig_vol_tlv),
331 SOC_SINGLE_TLV("Analog PCM Volume", CS35L41_AMP_GAIN_CTRL, 5, 0x14, 0,
332 amp_gain_tlv),
333 SOC_ENUM("PCM Soft Ramp", pcm_sft_ramp),
334 SOC_SINGLE("HW Noise Gate Enable", CS35L41_NG_CFG, 8, 63, 0),
335 SOC_SINGLE("HW Noise Gate Delay", CS35L41_NG_CFG, 4, 7, 0),
336 SOC_SINGLE("HW Noise Gate Threshold", CS35L41_NG_CFG, 0, 7, 0),
337 SOC_SINGLE("Aux Noise Gate CH1 Switch",
338 CS35L41_MIXER_NGATE_CH1_CFG, 16, 1, 0),
339 SOC_SINGLE("Aux Noise Gate CH1 Entry Delay",
340 CS35L41_MIXER_NGATE_CH1_CFG, 8, 15, 0),
341 SOC_SINGLE("Aux Noise Gate CH1 Threshold",
342 CS35L41_MIXER_NGATE_CH1_CFG, 0, 7, 0),
343 SOC_SINGLE("Aux Noise Gate CH2 Entry Delay",
344 CS35L41_MIXER_NGATE_CH2_CFG, 8, 15, 0),
345 SOC_SINGLE("Aux Noise Gate CH2 Switch",
346 CS35L41_MIXER_NGATE_CH2_CFG, 16, 1, 0),
347 SOC_SINGLE("Aux Noise Gate CH2 Threshold",
348 CS35L41_MIXER_NGATE_CH2_CFG, 0, 7, 0),
349 SOC_SINGLE("SCLK Force Switch", CS35L41_SP_FORMAT, CS35L41_SCLK_FRC_SHIFT, 1, 0),
350 SOC_SINGLE("LRCLK Force Switch", CS35L41_SP_FORMAT, CS35L41_LRCLK_FRC_SHIFT, 1, 0),
351 SOC_SINGLE("Invert Class D Switch", CS35L41_AMP_DIG_VOL_CTRL,
352 CS35L41_AMP_INV_PCM_SHIFT, 1, 0),
353 SOC_SINGLE("Amp Gain ZC Switch", CS35L41_AMP_GAIN_CTRL,
354 CS35L41_AMP_GAIN_ZC_SHIFT, 1, 0),
355 WM_ADSP2_PRELOAD_SWITCH("DSP1", 1),
356 WM_ADSP_FW_CONTROL("DSP1", 0),
357};
358
359static void cs35l41_boost_enable(struct cs35l41_private *cs35l41, unsigned int enable)
360{
361 switch (cs35l41->hw_cfg.bst_type) {
362 case CS35L41_INT_BOOST:
363 case CS35L41_SHD_BOOST_ACTV:
364 enable = enable ? CS35L41_BST_EN_DEFAULT : CS35L41_BST_DIS_FET_OFF;
365 regmap_update_bits(cs35l41->regmap, CS35L41_PWR_CTRL2, CS35L41_BST_EN_MASK,
366 enable << CS35L41_BST_EN_SHIFT);
367 break;
368 default:
369 break;
370 }
371}
372
373
374static void cs35l41_error_release(struct cs35l41_private *cs35l41, unsigned int irq_err_bit,
375 unsigned int rel_err_bit)
376{
377 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS1, irq_err_bit);
378 regmap_write(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, 0);
379 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, rel_err_bit, rel_err_bit);
380 regmap_update_bits(cs35l41->regmap, CS35L41_PROTECT_REL_ERR_IGN, rel_err_bit, 0);
381}
382
383static irqreturn_t cs35l41_irq(int irq, void *data)
384{
385 struct cs35l41_private *cs35l41 = data;
386 unsigned int status[4] = { 0, 0, 0, 0 };
387 unsigned int masks[4] = { 0, 0, 0, 0 };
388 unsigned int i;
389 int ret;
390
391 ret = pm_runtime_resume_and_get(cs35l41->dev);
392 if (ret < 0) {
393 dev_err(cs35l41->dev,
394 "pm_runtime_resume_and_get failed in %s: %d\n",
395 __func__, ret);
396 return IRQ_NONE;
397 }
398
399 ret = IRQ_NONE;
400
401 for (i = 0; i < ARRAY_SIZE(status); i++) {
402 regmap_read(cs35l41->regmap,
403 CS35L41_IRQ1_STATUS1 + (i * CS35L41_REGSTRIDE),
404 &status[i]);
405 regmap_read(cs35l41->regmap,
406 CS35L41_IRQ1_MASK1 + (i * CS35L41_REGSTRIDE),
407 &masks[i]);
408 }
409
410 /* Check to see if unmasked bits are active */
411 if (!(status[0] & ~masks[0]) && !(status[1] & ~masks[1]) &&
412 !(status[2] & ~masks[2]) && !(status[3] & ~masks[3]))
413 goto done;
414
415 if (status[3] & CS35L41_OTP_BOOT_DONE) {
416 regmap_update_bits(cs35l41->regmap, CS35L41_IRQ1_MASK4,
417 CS35L41_OTP_BOOT_DONE, CS35L41_OTP_BOOT_DONE);
418 }
419
420 /*
421 * The following interrupts require a
422 * protection release cycle to get the
423 * speaker out of Safe-Mode.
424 */
425 if (status[0] & CS35L41_AMP_SHORT_ERR) {
426 dev_crit_ratelimited(cs35l41->dev, "Amp short error\n");
427 cs35l41_error_release(cs35l41, CS35L41_AMP_SHORT_ERR, CS35L41_AMP_SHORT_ERR_RLS);
428 ret = IRQ_HANDLED;
429 }
430
431 if (status[0] & CS35L41_TEMP_WARN) {
432 dev_crit_ratelimited(cs35l41->dev, "Over temperature warning\n");
433 cs35l41_error_release(cs35l41, CS35L41_TEMP_WARN, CS35L41_TEMP_WARN_ERR_RLS);
434 ret = IRQ_HANDLED;
435 }
436
437 if (status[0] & CS35L41_TEMP_ERR) {
438 dev_crit_ratelimited(cs35l41->dev, "Over temperature error\n");
439 cs35l41_error_release(cs35l41, CS35L41_TEMP_ERR, CS35L41_TEMP_ERR_RLS);
440 ret = IRQ_HANDLED;
441 }
442
443 if (status[0] & CS35L41_BST_OVP_ERR) {
444 dev_crit_ratelimited(cs35l41->dev, "VBST Over Voltage error\n");
445 cs35l41_boost_enable(cs35l41, 0);
446 cs35l41_error_release(cs35l41, CS35L41_BST_OVP_ERR, CS35L41_BST_OVP_ERR_RLS);
447 cs35l41_boost_enable(cs35l41, 1);
448 ret = IRQ_HANDLED;
449 }
450
451 if (status[0] & CS35L41_BST_DCM_UVP_ERR) {
452 dev_crit_ratelimited(cs35l41->dev, "DCM VBST Under Voltage Error\n");
453 cs35l41_boost_enable(cs35l41, 0);
454 cs35l41_error_release(cs35l41, CS35L41_BST_DCM_UVP_ERR, CS35L41_BST_UVP_ERR_RLS);
455 cs35l41_boost_enable(cs35l41, 1);
456 ret = IRQ_HANDLED;
457 }
458
459 if (status[0] & CS35L41_BST_SHORT_ERR) {
460 dev_crit_ratelimited(cs35l41->dev, "LBST error: powering off!\n");
461 cs35l41_boost_enable(cs35l41, 0);
462 cs35l41_error_release(cs35l41, CS35L41_BST_SHORT_ERR, CS35L41_BST_SHORT_ERR_RLS);
463 cs35l41_boost_enable(cs35l41, 1);
464 ret = IRQ_HANDLED;
465 }
466
467 if (status[2] & CS35L41_PLL_LOCK) {
468 regmap_write(cs35l41->regmap, CS35L41_IRQ1_STATUS3, CS35L41_PLL_LOCK);
469
470 if (cs35l41->hw_cfg.bst_type == CS35L41_SHD_BOOST_ACTV ||
471 cs35l41->hw_cfg.bst_type == CS35L41_SHD_BOOST_PASS) {
472 ret = cs35l41_mdsync_up(cs35l41->regmap);
473 if (ret)
474 dev_err(cs35l41->dev, "MDSYNC-up failed: %d\n", ret);
475 else
476 dev_dbg(cs35l41->dev, "MDSYNC-up done\n");
477
478 dev_dbg(cs35l41->dev, "PUP-done status: %d\n",
479 !!(status[0] & CS35L41_PUP_DONE_MASK));
480 }
481
482 ret = IRQ_HANDLED;
483 }
484
485done:
486 pm_runtime_mark_last_busy(cs35l41->dev);
487 pm_runtime_put_autosuspend(cs35l41->dev);
488
489 return ret;
490}
491
492static const struct reg_sequence cs35l41_pup_patch[] = {
493 { CS35L41_TEST_KEY_CTL, 0x00000055 },
494 { CS35L41_TEST_KEY_CTL, 0x000000AA },
495 { 0x00002084, 0x002F1AA0 },
496 { CS35L41_TEST_KEY_CTL, 0x000000CC },
497 { CS35L41_TEST_KEY_CTL, 0x00000033 },
498};
499
500static const struct reg_sequence cs35l41_pdn_patch[] = {
501 { CS35L41_TEST_KEY_CTL, 0x00000055 },
502 { CS35L41_TEST_KEY_CTL, 0x000000AA },
503 { 0x00002084, 0x002F1AA3 },
504 { CS35L41_TEST_KEY_CTL, 0x000000CC },
505 { CS35L41_TEST_KEY_CTL, 0x00000033 },
506};
507
508static int cs35l41_main_amp_event(struct snd_soc_dapm_widget *w,
509 struct snd_kcontrol *kcontrol, int event)
510{
511 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
512 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
513 int ret = 0;
514
515 switch (event) {
516 case SND_SOC_DAPM_PRE_PMU:
517 regmap_multi_reg_write_bypassed(cs35l41->regmap,
518 cs35l41_pup_patch,
519 ARRAY_SIZE(cs35l41_pup_patch));
520
521 ret = cs35l41_global_enable(cs35l41->dev, cs35l41->regmap, cs35l41->hw_cfg.bst_type,
522 1, &cs35l41->dsp.cs_dsp);
523 break;
524 case SND_SOC_DAPM_POST_PMD:
525 ret = cs35l41_global_enable(cs35l41->dev, cs35l41->regmap, cs35l41->hw_cfg.bst_type,
526 0, &cs35l41->dsp.cs_dsp);
527
528 regmap_multi_reg_write_bypassed(cs35l41->regmap,
529 cs35l41_pdn_patch,
530 ARRAY_SIZE(cs35l41_pdn_patch));
531 break;
532 default:
533 dev_err(cs35l41->dev, "Invalid event = 0x%x\n", event);
534 ret = -EINVAL;
535 }
536
537 return ret;
538}
539
540static const struct snd_soc_dapm_widget cs35l41_dapm_widgets[] = {
541 SND_SOC_DAPM_SPK("DSP1 Preload", NULL),
542 SND_SOC_DAPM_SUPPLY_S("DSP1 Preloader", 100, SND_SOC_NOPM, 0, 0,
543 cs35l41_dsp_preload_ev,
544 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD),
545 SND_SOC_DAPM_OUT_DRV_E("DSP1", SND_SOC_NOPM, 0, 0, NULL, 0,
546 cs35l41_dsp_audio_ev,
547 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
548
549 SND_SOC_DAPM_OUTPUT("SPK"),
550
551 SND_SOC_DAPM_AIF_IN("ASPRX1", NULL, 0, CS35L41_SP_ENABLES, 16, 0),
552 SND_SOC_DAPM_AIF_IN("ASPRX2", NULL, 0, CS35L41_SP_ENABLES, 17, 0),
553 SND_SOC_DAPM_AIF_OUT("ASPTX1", NULL, 0, CS35L41_SP_ENABLES, 0, 0),
554 SND_SOC_DAPM_AIF_OUT("ASPTX2", NULL, 0, CS35L41_SP_ENABLES, 1, 0),
555 SND_SOC_DAPM_AIF_OUT("ASPTX3", NULL, 0, CS35L41_SP_ENABLES, 2, 0),
556 SND_SOC_DAPM_AIF_OUT("ASPTX4", NULL, 0, CS35L41_SP_ENABLES, 3, 0),
557
558 SND_SOC_DAPM_SIGGEN("VSENSE"),
559 SND_SOC_DAPM_SIGGEN("ISENSE"),
560 SND_SOC_DAPM_SIGGEN("VP"),
561 SND_SOC_DAPM_SIGGEN("VBST"),
562 SND_SOC_DAPM_SIGGEN("TEMP"),
563
564 SND_SOC_DAPM_SUPPLY("VMON", CS35L41_PWR_CTRL2, 12, 0, NULL, 0),
565 SND_SOC_DAPM_SUPPLY("IMON", CS35L41_PWR_CTRL2, 13, 0, NULL, 0),
566 SND_SOC_DAPM_SUPPLY("VPMON", CS35L41_PWR_CTRL2, 8, 0, NULL, 0),
567 SND_SOC_DAPM_SUPPLY("VBSTMON", CS35L41_PWR_CTRL2, 9, 0, NULL, 0),
568 SND_SOC_DAPM_SUPPLY("TEMPMON", CS35L41_PWR_CTRL2, 10, 0, NULL, 0),
569
570 SND_SOC_DAPM_ADC("VMON ADC", NULL, SND_SOC_NOPM, 0, 0),
571 SND_SOC_DAPM_ADC("IMON ADC", NULL, SND_SOC_NOPM, 0, 0),
572 SND_SOC_DAPM_ADC("VPMON ADC", NULL, SND_SOC_NOPM, 0, 0),
573 SND_SOC_DAPM_ADC("VBSTMON ADC", NULL, SND_SOC_NOPM, 0, 0),
574 SND_SOC_DAPM_ADC("TEMPMON ADC", NULL, SND_SOC_NOPM, 0, 0),
575
576 SND_SOC_DAPM_ADC("CLASS H", NULL, CS35L41_PWR_CTRL3, 4, 0),
577
578 SND_SOC_DAPM_OUT_DRV_E("Main AMP", CS35L41_PWR_CTRL2, 0, 0, NULL, 0,
579 cs35l41_main_amp_event,
580 SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_PRE_PMU),
581
582 SND_SOC_DAPM_MUX("ASP TX1 Source", SND_SOC_NOPM, 0, 0, &asp_tx1_mux),
583 SND_SOC_DAPM_MUX("ASP TX2 Source", SND_SOC_NOPM, 0, 0, &asp_tx2_mux),
584 SND_SOC_DAPM_MUX("ASP TX3 Source", SND_SOC_NOPM, 0, 0, &asp_tx3_mux),
585 SND_SOC_DAPM_MUX("ASP TX4 Source", SND_SOC_NOPM, 0, 0, &asp_tx4_mux),
586 SND_SOC_DAPM_MUX("DSP RX1 Source", SND_SOC_NOPM, 0, 0, &dsp_rx1_mux),
587 SND_SOC_DAPM_MUX("DSP RX2 Source", SND_SOC_NOPM, 0, 0, &dsp_rx2_mux),
588 SND_SOC_DAPM_MUX("PCM Source", SND_SOC_NOPM, 0, 0, &pcm_source_mux),
589 SND_SOC_DAPM_SWITCH("DRE", SND_SOC_NOPM, 0, 0, &dre_ctrl),
590};
591
592static const struct snd_soc_dapm_route cs35l41_audio_map[] = {
593 {"DSP RX1 Source", "ASPRX1", "ASPRX1"},
594 {"DSP RX1 Source", "ASPRX2", "ASPRX2"},
595 {"DSP RX2 Source", "ASPRX1", "ASPRX1"},
596 {"DSP RX2 Source", "ASPRX2", "ASPRX2"},
597
598 {"DSP1", NULL, "DSP RX1 Source"},
599 {"DSP1", NULL, "DSP RX2 Source"},
600
601 {"ASP TX1 Source", "VMON", "VMON ADC"},
602 {"ASP TX1 Source", "IMON", "IMON ADC"},
603 {"ASP TX1 Source", "VPMON", "VPMON ADC"},
604 {"ASP TX1 Source", "VBSTMON", "VBSTMON ADC"},
605 {"ASP TX1 Source", "DSPTX1", "DSP1"},
606 {"ASP TX1 Source", "DSPTX2", "DSP1"},
607 {"ASP TX1 Source", "ASPRX1", "ASPRX1" },
608 {"ASP TX1 Source", "ASPRX2", "ASPRX2" },
609 {"ASP TX2 Source", "VMON", "VMON ADC"},
610 {"ASP TX2 Source", "IMON", "IMON ADC"},
611 {"ASP TX2 Source", "VPMON", "VPMON ADC"},
612 {"ASP TX2 Source", "VBSTMON", "VBSTMON ADC"},
613 {"ASP TX2 Source", "DSPTX1", "DSP1"},
614 {"ASP TX2 Source", "DSPTX2", "DSP1"},
615 {"ASP TX2 Source", "ASPRX1", "ASPRX1" },
616 {"ASP TX2 Source", "ASPRX2", "ASPRX2" },
617 {"ASP TX3 Source", "VMON", "VMON ADC"},
618 {"ASP TX3 Source", "IMON", "IMON ADC"},
619 {"ASP TX3 Source", "VPMON", "VPMON ADC"},
620 {"ASP TX3 Source", "VBSTMON", "VBSTMON ADC"},
621 {"ASP TX3 Source", "DSPTX1", "DSP1"},
622 {"ASP TX3 Source", "DSPTX2", "DSP1"},
623 {"ASP TX3 Source", "ASPRX1", "ASPRX1" },
624 {"ASP TX3 Source", "ASPRX2", "ASPRX2" },
625 {"ASP TX4 Source", "VMON", "VMON ADC"},
626 {"ASP TX4 Source", "IMON", "IMON ADC"},
627 {"ASP TX4 Source", "VPMON", "VPMON ADC"},
628 {"ASP TX4 Source", "VBSTMON", "VBSTMON ADC"},
629 {"ASP TX4 Source", "DSPTX1", "DSP1"},
630 {"ASP TX4 Source", "DSPTX2", "DSP1"},
631 {"ASP TX4 Source", "ASPRX1", "ASPRX1" },
632 {"ASP TX4 Source", "ASPRX2", "ASPRX2" },
633 {"ASPTX1", NULL, "ASP TX1 Source"},
634 {"ASPTX2", NULL, "ASP TX2 Source"},
635 {"ASPTX3", NULL, "ASP TX3 Source"},
636 {"ASPTX4", NULL, "ASP TX4 Source"},
637 {"AMP Capture", NULL, "ASPTX1"},
638 {"AMP Capture", NULL, "ASPTX2"},
639 {"AMP Capture", NULL, "ASPTX3"},
640 {"AMP Capture", NULL, "ASPTX4"},
641
642 {"DSP1", NULL, "VMON"},
643 {"DSP1", NULL, "IMON"},
644 {"DSP1", NULL, "VPMON"},
645 {"DSP1", NULL, "VBSTMON"},
646 {"DSP1", NULL, "TEMPMON"},
647
648 {"VMON ADC", NULL, "VMON"},
649 {"IMON ADC", NULL, "IMON"},
650 {"VPMON ADC", NULL, "VPMON"},
651 {"VBSTMON ADC", NULL, "VBSTMON"},
652 {"TEMPMON ADC", NULL, "TEMPMON"},
653
654 {"VMON ADC", NULL, "VSENSE"},
655 {"IMON ADC", NULL, "ISENSE"},
656 {"VPMON ADC", NULL, "VP"},
657 {"VBSTMON ADC", NULL, "VBST"},
658 {"TEMPMON ADC", NULL, "TEMP"},
659
660 {"DSP1 Preload", NULL, "DSP1 Preloader"},
661 {"DSP1", NULL, "DSP1 Preloader"},
662
663 {"ASPRX1", NULL, "AMP Playback"},
664 {"ASPRX2", NULL, "AMP Playback"},
665 {"DRE", "Switch", "CLASS H"},
666 {"Main AMP", NULL, "CLASS H"},
667 {"Main AMP", NULL, "DRE"},
668 {"SPK", NULL, "Main AMP"},
669
670 {"PCM Source", "ASP", "ASPRX1"},
671 {"PCM Source", "DSP", "DSP1"},
672 {"CLASS H", NULL, "PCM Source"},
673};
674
675static int cs35l41_set_channel_map(struct snd_soc_dai *dai, unsigned int tx_n,
676 const unsigned int *tx_slot,
677 unsigned int rx_n, const unsigned int *rx_slot)
678{
679 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
680
681 return cs35l41_set_channels(cs35l41->dev, cs35l41->regmap, tx_n, tx_slot, rx_n, rx_slot);
682}
683
684static int cs35l41_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
685{
686 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
687 unsigned int daifmt = 0;
688
689 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
690 case SND_SOC_DAIFMT_CBP_CFP:
691 daifmt |= CS35L41_SCLK_MSTR_MASK | CS35L41_LRCLK_MSTR_MASK;
692 break;
693 case SND_SOC_DAIFMT_CBC_CFC:
694 break;
695 default:
696 dev_warn(cs35l41->dev, "Mixed provider/consumer mode unsupported\n");
697 return -EINVAL;
698 }
699
700 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
701 case SND_SOC_DAIFMT_DSP_A:
702 break;
703 case SND_SOC_DAIFMT_I2S:
704 daifmt |= 2 << CS35L41_ASP_FMT_SHIFT;
705 break;
706 default:
707 dev_warn(cs35l41->dev, "Invalid or unsupported DAI format\n");
708 return -EINVAL;
709 }
710
711 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
712 case SND_SOC_DAIFMT_NB_IF:
713 daifmt |= CS35L41_LRCLK_INV_MASK;
714 break;
715 case SND_SOC_DAIFMT_IB_NF:
716 daifmt |= CS35L41_SCLK_INV_MASK;
717 break;
718 case SND_SOC_DAIFMT_IB_IF:
719 daifmt |= CS35L41_LRCLK_INV_MASK | CS35L41_SCLK_INV_MASK;
720 break;
721 case SND_SOC_DAIFMT_NB_NF:
722 break;
723 default:
724 dev_warn(cs35l41->dev, "Invalid DAI clock INV\n");
725 return -EINVAL;
726 }
727
728 return regmap_update_bits(cs35l41->regmap, CS35L41_SP_FORMAT,
729 CS35L41_SCLK_MSTR_MASK | CS35L41_LRCLK_MSTR_MASK |
730 CS35L41_ASP_FMT_MASK | CS35L41_LRCLK_INV_MASK |
731 CS35L41_SCLK_INV_MASK, daifmt);
732}
733
734struct cs35l41_global_fs_config {
735 int rate;
736 int fs_cfg;
737};
738
739static const struct cs35l41_global_fs_config cs35l41_fs_rates[] = {
740 { 12000, 0x01 },
741 { 24000, 0x02 },
742 { 48000, 0x03 },
743 { 96000, 0x04 },
744 { 192000, 0x05 },
745 { 11025, 0x09 },
746 { 22050, 0x0A },
747 { 44100, 0x0B },
748 { 88200, 0x0C },
749 { 176400, 0x0D },
750 { 8000, 0x11 },
751 { 16000, 0x12 },
752 { 32000, 0x13 },
753};
754
755static int cs35l41_pcm_hw_params(struct snd_pcm_substream *substream,
756 struct snd_pcm_hw_params *params,
757 struct snd_soc_dai *dai)
758{
759 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
760 unsigned int rate = params_rate(params);
761 u8 asp_wl;
762 int i;
763
764 for (i = 0; i < ARRAY_SIZE(cs35l41_fs_rates); i++) {
765 if (rate == cs35l41_fs_rates[i].rate)
766 break;
767 }
768
769 if (i >= ARRAY_SIZE(cs35l41_fs_rates)) {
770 dev_err(cs35l41->dev, "Unsupported rate: %u\n", rate);
771 return -EINVAL;
772 }
773
774 asp_wl = params_width(params);
775
776 regmap_update_bits(cs35l41->regmap, CS35L41_GLOBAL_CLK_CTRL,
777 CS35L41_GLOBAL_FS_MASK,
778 cs35l41_fs_rates[i].fs_cfg << CS35L41_GLOBAL_FS_SHIFT);
779
780 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
781 regmap_update_bits(cs35l41->regmap, CS35L41_SP_FORMAT,
782 CS35L41_ASP_WIDTH_RX_MASK,
783 asp_wl << CS35L41_ASP_WIDTH_RX_SHIFT);
784 regmap_update_bits(cs35l41->regmap, CS35L41_SP_RX_WL,
785 CS35L41_ASP_RX_WL_MASK,
786 asp_wl << CS35L41_ASP_RX_WL_SHIFT);
787 } else {
788 regmap_update_bits(cs35l41->regmap, CS35L41_SP_FORMAT,
789 CS35L41_ASP_WIDTH_TX_MASK,
790 asp_wl << CS35L41_ASP_WIDTH_TX_SHIFT);
791 regmap_update_bits(cs35l41->regmap, CS35L41_SP_TX_WL,
792 CS35L41_ASP_TX_WL_MASK,
793 asp_wl << CS35L41_ASP_TX_WL_SHIFT);
794 }
795
796 return 0;
797}
798
799static int cs35l41_get_clk_config(int freq)
800{
801 int i;
802
803 for (i = 0; i < ARRAY_SIZE(cs35l41_pll_sysclk); i++) {
804 if (cs35l41_pll_sysclk[i].freq == freq)
805 return cs35l41_pll_sysclk[i].clk_cfg;
806 }
807
808 return -EINVAL;
809}
810
811static int cs35l41_component_set_sysclk(struct snd_soc_component *component,
812 int clk_id, int source,
813 unsigned int freq, int dir)
814{
815 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
816 int extclk_cfg, clksrc;
817
818 switch (clk_id) {
819 case CS35L41_CLKID_SCLK:
820 clksrc = CS35L41_PLLSRC_SCLK;
821 break;
822 case CS35L41_CLKID_LRCLK:
823 clksrc = CS35L41_PLLSRC_LRCLK;
824 break;
825 case CS35L41_CLKID_MCLK:
826 clksrc = CS35L41_PLLSRC_MCLK;
827 break;
828 default:
829 dev_err(cs35l41->dev, "Invalid CLK Config\n");
830 return -EINVAL;
831 }
832
833 extclk_cfg = cs35l41_get_clk_config(freq);
834
835 if (extclk_cfg < 0) {
836 dev_err(cs35l41->dev, "Invalid CLK Config: %d, freq: %u\n",
837 extclk_cfg, freq);
838 return -EINVAL;
839 }
840
841 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
842 CS35L41_PLL_OPENLOOP_MASK,
843 1 << CS35L41_PLL_OPENLOOP_SHIFT);
844 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
845 CS35L41_REFCLK_FREQ_MASK,
846 extclk_cfg << CS35L41_REFCLK_FREQ_SHIFT);
847 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
848 CS35L41_PLL_CLK_EN_MASK,
849 0 << CS35L41_PLL_CLK_EN_SHIFT);
850 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
851 CS35L41_PLL_CLK_SEL_MASK, clksrc);
852 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
853 CS35L41_PLL_OPENLOOP_MASK,
854 0 << CS35L41_PLL_OPENLOOP_SHIFT);
855 regmap_update_bits(cs35l41->regmap, CS35L41_PLL_CLK_CTRL,
856 CS35L41_PLL_CLK_EN_MASK,
857 1 << CS35L41_PLL_CLK_EN_SHIFT);
858
859 return 0;
860}
861
862static int cs35l41_dai_set_sysclk(struct snd_soc_dai *dai,
863 int clk_id, unsigned int freq, int dir)
864{
865 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(dai->component);
866 unsigned int fs1_val;
867 unsigned int fs2_val;
868 unsigned int val;
869 int fsindex;
870
871 fsindex = cs35l41_get_fs_mon_config_index(freq);
872 if (fsindex < 0) {
873 dev_err(cs35l41->dev, "Invalid CLK Config freq: %u\n", freq);
874 return -EINVAL;
875 }
876
877 dev_dbg(cs35l41->dev, "Set DAI sysclk %d\n", freq);
878
879 if (freq <= 6144000) {
880 /* Use the lookup table */
881 fs1_val = cs35l41_fs_mon[fsindex].fs1;
882 fs2_val = cs35l41_fs_mon[fsindex].fs2;
883 } else {
884 /* Use hard-coded values */
885 fs1_val = 0x10;
886 fs2_val = 0x24;
887 }
888
889 val = fs1_val;
890 val |= (fs2_val << CS35L41_FS2_WINDOW_SHIFT) & CS35L41_FS2_WINDOW_MASK;
891 regmap_write(cs35l41->regmap, CS35L41_TST_FS_MON0, val);
892
893 return 0;
894}
895
896static int cs35l41_set_pdata(struct cs35l41_private *cs35l41)
897{
898 struct cs35l41_hw_cfg *hw_cfg = &cs35l41->hw_cfg;
899 int ret;
900
901 if (!hw_cfg->valid)
902 return -EINVAL;
903
904 if (hw_cfg->bst_type == CS35L41_EXT_BOOST_NO_VSPK_SWITCH)
905 return -EINVAL;
906
907 /* Required */
908 ret = cs35l41_init_boost(cs35l41->dev, cs35l41->regmap, hw_cfg);
909 if (ret)
910 return ret;
911
912 /* Optional */
913 if (hw_cfg->dout_hiz <= CS35L41_ASP_DOUT_HIZ_MASK && hw_cfg->dout_hiz >= 0)
914 regmap_update_bits(cs35l41->regmap, CS35L41_SP_HIZ_CTRL, CS35L41_ASP_DOUT_HIZ_MASK,
915 hw_cfg->dout_hiz);
916
917 return 0;
918}
919
920static const struct snd_soc_dapm_route cs35l41_ext_bst_routes[] = {
921 {"Main AMP", NULL, "VSPK"},
922};
923
924static const struct snd_soc_dapm_widget cs35l41_ext_bst_widget[] = {
925 SND_SOC_DAPM_SUPPLY("VSPK", CS35L41_GPIO1_CTRL1, CS35L41_GPIO_LVL_SHIFT, 0, NULL, 0),
926};
927
928static int cs35l41_component_probe(struct snd_soc_component *component)
929{
930 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
931 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
932 int ret;
933
934 if (cs35l41->hw_cfg.bst_type == CS35L41_EXT_BOOST) {
935 ret = snd_soc_dapm_new_controls(dapm, cs35l41_ext_bst_widget,
936 ARRAY_SIZE(cs35l41_ext_bst_widget));
937 if (ret)
938 return ret;
939
940 ret = snd_soc_dapm_add_routes(dapm, cs35l41_ext_bst_routes,
941 ARRAY_SIZE(cs35l41_ext_bst_routes));
942 if (ret)
943 return ret;
944 }
945
946 return wm_adsp2_component_probe(&cs35l41->dsp, component);
947}
948
949static void cs35l41_component_remove(struct snd_soc_component *component)
950{
951 struct cs35l41_private *cs35l41 = snd_soc_component_get_drvdata(component);
952
953 wm_adsp2_component_remove(&cs35l41->dsp, component);
954}
955
956static const struct snd_soc_dai_ops cs35l41_ops = {
957 .set_fmt = cs35l41_set_dai_fmt,
958 .hw_params = cs35l41_pcm_hw_params,
959 .set_sysclk = cs35l41_dai_set_sysclk,
960 .set_channel_map = cs35l41_set_channel_map,
961};
962
963#define CS35L41_RATES ( \
964 SNDRV_PCM_RATE_8000_48000 | \
965 SNDRV_PCM_RATE_12000 | \
966 SNDRV_PCM_RATE_24000 | \
967 SNDRV_PCM_RATE_88200 | \
968 SNDRV_PCM_RATE_96000 | \
969 SNDRV_PCM_RATE_176400 | \
970 SNDRV_PCM_RATE_192000)
971
972static struct snd_soc_dai_driver cs35l41_dai[] = {
973 {
974 .name = "cs35l41-pcm",
975 .id = 0,
976 .playback = {
977 .stream_name = "AMP Playback",
978 .channels_min = 1,
979 .channels_max = 2,
980 .rates = CS35L41_RATES,
981 .formats = CS35L41_RX_FORMATS,
982 },
983 .capture = {
984 .stream_name = "AMP Capture",
985 .channels_min = 1,
986 .channels_max = 4,
987 .rates = CS35L41_RATES,
988 .formats = CS35L41_TX_FORMATS,
989 },
990 .ops = &cs35l41_ops,
991 .symmetric_rate = 1,
992 },
993};
994
995static const struct snd_soc_component_driver soc_component_dev_cs35l41 = {
996 .name = "cs35l41-codec",
997 .probe = cs35l41_component_probe,
998 .remove = cs35l41_component_remove,
999
1000 .dapm_widgets = cs35l41_dapm_widgets,
1001 .num_dapm_widgets = ARRAY_SIZE(cs35l41_dapm_widgets),
1002 .dapm_routes = cs35l41_audio_map,
1003 .num_dapm_routes = ARRAY_SIZE(cs35l41_audio_map),
1004
1005 .controls = cs35l41_aud_controls,
1006 .num_controls = ARRAY_SIZE(cs35l41_aud_controls),
1007 .set_sysclk = cs35l41_component_set_sysclk,
1008
1009 .endianness = 1,
1010};
1011
1012static int cs35l41_handle_pdata(struct device *dev, struct cs35l41_hw_cfg *hw_cfg)
1013{
1014 struct cs35l41_gpio_cfg *gpio1 = &hw_cfg->gpio1;
1015 struct cs35l41_gpio_cfg *gpio2 = &hw_cfg->gpio2;
1016 unsigned int val;
1017 int ret;
1018
1019 /* Some ACPI systems received the Shared Boost feature before the upstream driver,
1020 * leaving those systems with deprecated _DSD properties.
1021 * To correctly configure those systems add shared-boost-active and shared-boost-passive
1022 * properties mapped to the correct value in boost-type.
1023 * These two are not DT properties and should not be used in new systems designs.
1024 */
1025 if (device_property_read_bool(dev, "cirrus,shared-boost-active")) {
1026 hw_cfg->bst_type = CS35L41_SHD_BOOST_ACTV;
1027 } else if (device_property_read_bool(dev, "cirrus,shared-boost-passive")) {
1028 hw_cfg->bst_type = CS35L41_SHD_BOOST_PASS;
1029 } else {
1030 ret = device_property_read_u32(dev, "cirrus,boost-type", &val);
1031 if (ret >= 0)
1032 hw_cfg->bst_type = val;
1033 }
1034
1035 ret = device_property_read_u32(dev, "cirrus,boost-peak-milliamp", &val);
1036 if (ret >= 0)
1037 hw_cfg->bst_ipk = val;
1038 else
1039 hw_cfg->bst_ipk = -1;
1040
1041 ret = device_property_read_u32(dev, "cirrus,boost-ind-nanohenry", &val);
1042 if (ret >= 0)
1043 hw_cfg->bst_ind = val;
1044 else
1045 hw_cfg->bst_ind = -1;
1046
1047 ret = device_property_read_u32(dev, "cirrus,boost-cap-microfarad", &val);
1048 if (ret >= 0)
1049 hw_cfg->bst_cap = val;
1050 else
1051 hw_cfg->bst_cap = -1;
1052
1053 ret = device_property_read_u32(dev, "cirrus,asp-sdout-hiz", &val);
1054 if (ret >= 0)
1055 hw_cfg->dout_hiz = val;
1056 else
1057 hw_cfg->dout_hiz = -1;
1058
1059 /* GPIO1 Pin Config */
1060 gpio1->pol_inv = device_property_read_bool(dev, "cirrus,gpio1-polarity-invert");
1061 gpio1->out_en = device_property_read_bool(dev, "cirrus,gpio1-output-enable");
1062 ret = device_property_read_u32(dev, "cirrus,gpio1-src-select", &val);
1063 if (ret >= 0) {
1064 gpio1->func = val;
1065 gpio1->valid = true;
1066 }
1067
1068 /* GPIO2 Pin Config */
1069 gpio2->pol_inv = device_property_read_bool(dev, "cirrus,gpio2-polarity-invert");
1070 gpio2->out_en = device_property_read_bool(dev, "cirrus,gpio2-output-enable");
1071 ret = device_property_read_u32(dev, "cirrus,gpio2-src-select", &val);
1072 if (ret >= 0) {
1073 gpio2->func = val;
1074 gpio2->valid = true;
1075 }
1076
1077 hw_cfg->valid = true;
1078
1079 return 0;
1080}
1081
1082static int cs35l41_dsp_init(struct cs35l41_private *cs35l41)
1083{
1084 struct wm_adsp *dsp;
1085 uint32_t dsp1rx5_src;
1086 int ret;
1087
1088 dsp = &cs35l41->dsp;
1089 dsp->part = "cs35l41";
1090 dsp->fw = 9; /* 9 is WM_ADSP_FW_SPK_PROT in wm_adsp.c */
1091 dsp->toggle_preload = true;
1092
1093 cs35l41_configure_cs_dsp(cs35l41->dev, cs35l41->regmap, &dsp->cs_dsp);
1094
1095 ret = cs35l41_write_fs_errata(cs35l41->dev, cs35l41->regmap);
1096 if (ret < 0)
1097 return ret;
1098
1099 ret = wm_halo_init(dsp);
1100 if (ret) {
1101 dev_err(cs35l41->dev, "wm_halo_init failed: %d\n", ret);
1102 return ret;
1103 }
1104
1105 switch (cs35l41->hw_cfg.bst_type) {
1106 case CS35L41_INT_BOOST:
1107 case CS35L41_SHD_BOOST_ACTV:
1108 dsp1rx5_src = CS35L41_INPUT_SRC_VPMON;
1109 break;
1110 case CS35L41_EXT_BOOST:
1111 case CS35L41_SHD_BOOST_PASS:
1112 dsp1rx5_src = CS35L41_INPUT_SRC_VBSTMON;
1113 break;
1114 default:
1115 dev_err(cs35l41->dev, "wm_halo_init failed - Invalid Boost Type: %d\n",
1116 cs35l41->hw_cfg.bst_type);
1117 goto err_dsp;
1118 }
1119
1120 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX5_SRC, dsp1rx5_src);
1121 if (ret < 0) {
1122 dev_err(cs35l41->dev, "Write DSP1RX5_SRC: %d failed: %d\n", dsp1rx5_src, ret);
1123 goto err_dsp;
1124 }
1125 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX6_SRC, CS35L41_INPUT_SRC_VBSTMON);
1126 if (ret < 0) {
1127 dev_err(cs35l41->dev, "Write CS35L41_INPUT_SRC_VBSTMON failed: %d\n", ret);
1128 goto err_dsp;
1129 }
1130 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX7_SRC,
1131 CS35L41_INPUT_SRC_TEMPMON);
1132 if (ret < 0) {
1133 dev_err(cs35l41->dev, "Write INPUT_SRC_TEMPMON failed: %d\n", ret);
1134 goto err_dsp;
1135 }
1136 ret = regmap_write(cs35l41->regmap, CS35L41_DSP1_RX8_SRC,
1137 CS35L41_INPUT_SRC_RSVD);
1138 if (ret < 0) {
1139 dev_err(cs35l41->dev, "Write INPUT_SRC_RSVD failed: %d\n", ret);
1140 goto err_dsp;
1141 }
1142
1143 return 0;
1144
1145err_dsp:
1146 wm_adsp2_remove(dsp);
1147
1148 return ret;
1149}
1150
1151static int cs35l41_acpi_get_name(struct cs35l41_private *cs35l41)
1152{
1153 acpi_handle handle = ACPI_HANDLE(cs35l41->dev);
1154 const char *sub;
1155
1156 /* If there is no ACPI_HANDLE, there is no ACPI for this system, return 0 */
1157 if (!handle)
1158 return 0;
1159
1160 sub = acpi_get_subsystem_id(handle);
1161 if (IS_ERR(sub)) {
1162 /* If bad ACPI, return 0 and fallback to legacy firmware path, otherwise fail */
1163 if (PTR_ERR(sub) == -ENODATA)
1164 return 0;
1165 else
1166 return PTR_ERR(sub);
1167 }
1168
1169 cs35l41->dsp.system_name = sub;
1170 dev_dbg(cs35l41->dev, "Subsystem ID: %s\n", cs35l41->dsp.system_name);
1171
1172 return 0;
1173}
1174
1175int cs35l41_probe(struct cs35l41_private *cs35l41, const struct cs35l41_hw_cfg *hw_cfg)
1176{
1177 u32 regid, reg_revid, i, mtl_revid, int_status, chipid_match;
1178 int irq_pol = 0;
1179 int ret;
1180
1181 if (hw_cfg) {
1182 cs35l41->hw_cfg = *hw_cfg;
1183 } else {
1184 ret = cs35l41_handle_pdata(cs35l41->dev, &cs35l41->hw_cfg);
1185 if (ret != 0)
1186 return ret;
1187 }
1188
1189 for (i = 0; i < CS35L41_NUM_SUPPLIES; i++)
1190 cs35l41->supplies[i].supply = cs35l41_supplies[i];
1191
1192 ret = devm_regulator_bulk_get(cs35l41->dev, CS35L41_NUM_SUPPLIES,
1193 cs35l41->supplies);
1194 if (ret != 0)
1195 return dev_err_probe(cs35l41->dev, ret,
1196 "Failed to request core supplies\n");
1197
1198 ret = regulator_bulk_enable(CS35L41_NUM_SUPPLIES, cs35l41->supplies);
1199 if (ret != 0)
1200 return dev_err_probe(cs35l41->dev, ret,
1201 "Failed to enable core supplies\n");
1202
1203 /* returning NULL can be an option if in stereo mode */
1204 cs35l41->reset_gpio = devm_gpiod_get_optional(cs35l41->dev, "reset",
1205 GPIOD_OUT_LOW);
1206 if (IS_ERR(cs35l41->reset_gpio)) {
1207 ret = PTR_ERR(cs35l41->reset_gpio);
1208 cs35l41->reset_gpio = NULL;
1209 if (ret == -EBUSY) {
1210 dev_info(cs35l41->dev,
1211 "Reset line busy, assuming shared reset\n");
1212 } else {
1213 dev_err_probe(cs35l41->dev, ret,
1214 "Failed to get reset GPIO\n");
1215 goto err;
1216 }
1217 }
1218 if (cs35l41->reset_gpio) {
1219 /* satisfy minimum reset pulse width spec */
1220 usleep_range(2000, 2100);
1221 gpiod_set_value_cansleep(cs35l41->reset_gpio, 1);
1222 }
1223
1224 usleep_range(2000, 2100);
1225
1226 ret = regmap_read_poll_timeout(cs35l41->regmap, CS35L41_IRQ1_STATUS4,
1227 int_status, int_status & CS35L41_OTP_BOOT_DONE,
1228 1000, 100000);
1229 if (ret) {
1230 dev_err_probe(cs35l41->dev, ret,
1231 "Failed waiting for OTP_BOOT_DONE\n");
1232 goto err;
1233 }
1234
1235 regmap_read(cs35l41->regmap, CS35L41_IRQ1_STATUS3, &int_status);
1236 if (int_status & CS35L41_OTP_BOOT_ERR) {
1237 dev_err(cs35l41->dev, "OTP Boot error\n");
1238 ret = -EINVAL;
1239 goto err;
1240 }
1241
1242 ret = regmap_read(cs35l41->regmap, CS35L41_DEVID, ®id);
1243 if (ret < 0) {
1244 dev_err_probe(cs35l41->dev, ret, "Get Device ID failed\n");
1245 goto err;
1246 }
1247
1248 ret = regmap_read(cs35l41->regmap, CS35L41_REVID, ®_revid);
1249 if (ret < 0) {
1250 dev_err_probe(cs35l41->dev, ret, "Get Revision ID failed\n");
1251 goto err;
1252 }
1253
1254 mtl_revid = reg_revid & CS35L41_MTLREVID_MASK;
1255
1256 /* CS35L41 will have even MTLREVID
1257 * CS35L41R will have odd MTLREVID
1258 */
1259 chipid_match = (mtl_revid % 2) ? CS35L41R_CHIP_ID : CS35L41_CHIP_ID;
1260 if (regid != chipid_match) {
1261 dev_err(cs35l41->dev, "CS35L41 Device ID (%X). Expected ID %X\n",
1262 regid, chipid_match);
1263 ret = -ENODEV;
1264 goto err;
1265 }
1266
1267 cs35l41_test_key_unlock(cs35l41->dev, cs35l41->regmap);
1268
1269 ret = cs35l41_register_errata_patch(cs35l41->dev, cs35l41->regmap, reg_revid);
1270 if (ret)
1271 goto err;
1272
1273 ret = cs35l41_otp_unpack(cs35l41->dev, cs35l41->regmap);
1274 if (ret < 0) {
1275 dev_err_probe(cs35l41->dev, ret, "OTP Unpack failed\n");
1276 goto err;
1277 }
1278
1279 cs35l41_test_key_lock(cs35l41->dev, cs35l41->regmap);
1280
1281 irq_pol = cs35l41_gpio_config(cs35l41->regmap, &cs35l41->hw_cfg);
1282
1283 /* Set interrupt masks for critical errors */
1284 regmap_write(cs35l41->regmap, CS35L41_IRQ1_MASK1,
1285 CS35L41_INT1_MASK_DEFAULT);
1286 if (cs35l41->hw_cfg.bst_type == CS35L41_SHD_BOOST_PASS ||
1287 cs35l41->hw_cfg.bst_type == CS35L41_SHD_BOOST_ACTV)
1288 regmap_update_bits(cs35l41->regmap, CS35L41_IRQ1_MASK3, CS35L41_INT3_PLL_LOCK_MASK,
1289 0 << CS35L41_INT3_PLL_LOCK_SHIFT);
1290
1291 ret = devm_request_threaded_irq(cs35l41->dev, cs35l41->irq, NULL, cs35l41_irq,
1292 IRQF_ONESHOT | IRQF_SHARED | irq_pol,
1293 "cs35l41", cs35l41);
1294 if (ret != 0) {
1295 dev_err_probe(cs35l41->dev, ret, "Failed to request IRQ\n");
1296 goto err;
1297 }
1298
1299 ret = cs35l41_set_pdata(cs35l41);
1300 if (ret < 0) {
1301 dev_err_probe(cs35l41->dev, ret, "Set pdata failed\n");
1302 goto err;
1303 }
1304
1305 ret = cs35l41_acpi_get_name(cs35l41);
1306 if (ret < 0)
1307 goto err;
1308
1309 ret = cs35l41_dsp_init(cs35l41);
1310 if (ret < 0)
1311 goto err;
1312
1313 pm_runtime_set_autosuspend_delay(cs35l41->dev, 3000);
1314 pm_runtime_use_autosuspend(cs35l41->dev);
1315 pm_runtime_mark_last_busy(cs35l41->dev);
1316 pm_runtime_set_active(cs35l41->dev);
1317 pm_runtime_get_noresume(cs35l41->dev);
1318 pm_runtime_enable(cs35l41->dev);
1319
1320 ret = devm_snd_soc_register_component(cs35l41->dev,
1321 &soc_component_dev_cs35l41,
1322 cs35l41_dai, ARRAY_SIZE(cs35l41_dai));
1323 if (ret < 0) {
1324 dev_err_probe(cs35l41->dev, ret, "Register codec failed\n");
1325 goto err_pm;
1326 }
1327
1328 pm_runtime_put_autosuspend(cs35l41->dev);
1329
1330 dev_info(cs35l41->dev, "Cirrus Logic CS35L41 (%x), Revision: %02X\n",
1331 regid, reg_revid);
1332
1333 return 0;
1334
1335err_pm:
1336 pm_runtime_dont_use_autosuspend(cs35l41->dev);
1337 pm_runtime_disable(cs35l41->dev);
1338 pm_runtime_put_noidle(cs35l41->dev);
1339
1340 wm_adsp2_remove(&cs35l41->dsp);
1341err:
1342 cs35l41_safe_reset(cs35l41->regmap, cs35l41->hw_cfg.bst_type);
1343 regulator_bulk_disable(CS35L41_NUM_SUPPLIES, cs35l41->supplies);
1344 gpiod_set_value_cansleep(cs35l41->reset_gpio, 0);
1345
1346 return ret;
1347}
1348EXPORT_SYMBOL_GPL(cs35l41_probe);
1349
1350void cs35l41_remove(struct cs35l41_private *cs35l41)
1351{
1352 pm_runtime_get_sync(cs35l41->dev);
1353 pm_runtime_dont_use_autosuspend(cs35l41->dev);
1354 pm_runtime_disable(cs35l41->dev);
1355
1356 regmap_write(cs35l41->regmap, CS35L41_IRQ1_MASK1, 0xFFFFFFFF);
1357 if (cs35l41->hw_cfg.bst_type == CS35L41_SHD_BOOST_PASS ||
1358 cs35l41->hw_cfg.bst_type == CS35L41_SHD_BOOST_ACTV)
1359 regmap_update_bits(cs35l41->regmap, CS35L41_IRQ1_MASK3, CS35L41_INT3_PLL_LOCK_MASK,
1360 1 << CS35L41_INT3_PLL_LOCK_SHIFT);
1361 kfree(cs35l41->dsp.system_name);
1362 wm_adsp2_remove(&cs35l41->dsp);
1363 cs35l41_safe_reset(cs35l41->regmap, cs35l41->hw_cfg.bst_type);
1364
1365 pm_runtime_put_noidle(cs35l41->dev);
1366
1367 regulator_bulk_disable(CS35L41_NUM_SUPPLIES, cs35l41->supplies);
1368 gpiod_set_value_cansleep(cs35l41->reset_gpio, 0);
1369}
1370EXPORT_SYMBOL_GPL(cs35l41_remove);
1371
1372static int cs35l41_runtime_suspend(struct device *dev)
1373{
1374 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1375
1376 dev_dbg(cs35l41->dev, "Runtime suspend\n");
1377
1378 if (!cs35l41->dsp.preloaded || !cs35l41->dsp.cs_dsp.running)
1379 return 0;
1380
1381 cs35l41_enter_hibernate(dev, cs35l41->regmap, cs35l41->hw_cfg.bst_type);
1382
1383 regcache_cache_only(cs35l41->regmap, true);
1384 regcache_mark_dirty(cs35l41->regmap);
1385
1386 return 0;
1387}
1388
1389static int cs35l41_runtime_resume(struct device *dev)
1390{
1391 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1392 int ret;
1393
1394 dev_dbg(cs35l41->dev, "Runtime resume\n");
1395
1396 if (!cs35l41->dsp.preloaded || !cs35l41->dsp.cs_dsp.running)
1397 return 0;
1398
1399 regcache_cache_only(cs35l41->regmap, false);
1400
1401 ret = cs35l41_exit_hibernate(cs35l41->dev, cs35l41->regmap);
1402 if (ret)
1403 return ret;
1404
1405 /* Test key needs to be unlocked to allow the OTP settings to re-apply */
1406 cs35l41_test_key_unlock(cs35l41->dev, cs35l41->regmap);
1407 ret = regcache_sync(cs35l41->regmap);
1408 cs35l41_test_key_lock(cs35l41->dev, cs35l41->regmap);
1409 if (ret) {
1410 dev_err(cs35l41->dev, "Failed to restore register cache: %d\n", ret);
1411 return ret;
1412 }
1413 cs35l41_init_boost(cs35l41->dev, cs35l41->regmap, &cs35l41->hw_cfg);
1414
1415 return 0;
1416}
1417
1418static int cs35l41_sys_suspend(struct device *dev)
1419{
1420 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1421
1422 dev_dbg(cs35l41->dev, "System suspend, disabling IRQ\n");
1423 disable_irq(cs35l41->irq);
1424
1425 return 0;
1426}
1427
1428static int cs35l41_sys_suspend_noirq(struct device *dev)
1429{
1430 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1431
1432 dev_dbg(cs35l41->dev, "Late system suspend, reenabling IRQ\n");
1433 enable_irq(cs35l41->irq);
1434
1435 return 0;
1436}
1437
1438static int cs35l41_sys_resume_noirq(struct device *dev)
1439{
1440 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1441
1442 dev_dbg(cs35l41->dev, "Early system resume, disabling IRQ\n");
1443 disable_irq(cs35l41->irq);
1444
1445 return 0;
1446}
1447
1448static int cs35l41_sys_resume(struct device *dev)
1449{
1450 struct cs35l41_private *cs35l41 = dev_get_drvdata(dev);
1451
1452 dev_dbg(cs35l41->dev, "System resume, reenabling IRQ\n");
1453 enable_irq(cs35l41->irq);
1454
1455 return 0;
1456}
1457
1458EXPORT_GPL_DEV_PM_OPS(cs35l41_pm_ops) = {
1459 RUNTIME_PM_OPS(cs35l41_runtime_suspend, cs35l41_runtime_resume, NULL)
1460
1461 SYSTEM_SLEEP_PM_OPS(cs35l41_sys_suspend, cs35l41_sys_resume)
1462 NOIRQ_SYSTEM_SLEEP_PM_OPS(cs35l41_sys_suspend_noirq, cs35l41_sys_resume_noirq)
1463};
1464
1465MODULE_DESCRIPTION("ASoC CS35L41 driver");
1466MODULE_AUTHOR("David Rhodes, Cirrus Logic Inc, <david.rhodes@cirrus.com>");
1467MODULE_LICENSE("GPL");