1
2
3
4
5
6
7
8#include <linux/clk.h>
9#include <linux/module.h>
10#include <linux/of_platform.h>
11#include <linux/pm_runtime.h>
12#include <sound/soc.h>
13#include <sound/pcm_params.h>
14
15#include "fsl_audmix.h"
16
17#define SOC_ENUM_SINGLE_S(xreg, xshift, xtexts) \
18 SOC_ENUM_SINGLE(xreg, xshift, ARRAY_SIZE(xtexts), xtexts)
19
20static const char
21 *tdm_sel[] = { "TDM1", "TDM2", },
22 *mode_sel[] = { "Disabled", "TDM1", "TDM2", "Mixed", },
23 *width_sel[] = { "16b", "18b", "20b", "24b", "32b", },
24 *endis_sel[] = { "Disabled", "Enabled", },
25 *updn_sel[] = { "Downward", "Upward", },
26 *mask_sel[] = { "Unmask", "Mask", };
27
28static const struct soc_enum fsl_audmix_enum[] = {
29
30SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_MIXCLK_SHIFT, tdm_sel),
31SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_OUTSRC_SHIFT, mode_sel),
32SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_OUTWIDTH_SHIFT, width_sel),
33SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_MASKRTDF_SHIFT, mask_sel),
34SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_MASKCKDF_SHIFT, mask_sel),
35SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_SYNCMODE_SHIFT, endis_sel),
36SOC_ENUM_SINGLE_S(FSL_AUDMIX_CTR, FSL_AUDMIX_CTR_SYNCSRC_SHIFT, tdm_sel),
37
38SOC_ENUM_SINGLE_S(FSL_AUDMIX_ATCR0, 0, endis_sel),
39SOC_ENUM_SINGLE_S(FSL_AUDMIX_ATCR0, 1, updn_sel),
40
41SOC_ENUM_SINGLE_S(FSL_AUDMIX_ATCR1, 0, endis_sel),
42SOC_ENUM_SINGLE_S(FSL_AUDMIX_ATCR1, 1, updn_sel),
43};
44
45struct fsl_audmix_state {
46 u8 tdms;
47 u8 clk;
48 char msg[64];
49};
50
51static const struct fsl_audmix_state prms[4][4] = {{
52
53 { .tdms = 0, .clk = 0, .msg = "" },
54
55 { .tdms = 1, .clk = 1, .msg = "DIS->TDM1: TDM1 not started!\n" },
56
57 { .tdms = 2, .clk = 2, .msg = "DIS->TDM2: TDM2 not started!\n" },
58
59 { .tdms = 3, .clk = 0, .msg = "DIS->MIX: Please start both TDMs!\n" }
60}, {
61 { .tdms = 1, .clk = 0, .msg = "TDM1->DIS: TDM1 not started!\n" },
62
63 { .tdms = 0, .clk = 0, .msg = "" },
64
65 { .tdms = 3, .clk = 2, .msg = "TDM1->TDM2: Please start both TDMs!\n" },
66
67 { .tdms = 3, .clk = 0, .msg = "TDM1->MIX: Please start both TDMs!\n" }
68}, {
69 { .tdms = 2, .clk = 0, .msg = "TDM2->DIS: TDM2 not started!\n" },
70
71 { .tdms = 3, .clk = 1, .msg = "TDM2->TDM1: Please start both TDMs!\n" },
72
73 { .tdms = 0, .clk = 0, .msg = "" },
74
75 { .tdms = 3, .clk = 0, .msg = "TDM2->MIX: Please start both TDMs!\n" }
76}, {
77 { .tdms = 3, .clk = 0, .msg = "MIX->DIS: Please start both TDMs!\n" },
78
79 { .tdms = 3, .clk = 1, .msg = "MIX->TDM1: Please start both TDMs!\n" },
80
81 { .tdms = 3, .clk = 2, .msg = "MIX->TDM2: Please start both TDMs!\n" },
82
83 { .tdms = 0, .clk = 0, .msg = "" }
84}, };
85
86static int fsl_audmix_state_trans(struct snd_soc_component *comp,
87 unsigned int *mask, unsigned int *ctr,
88 const struct fsl_audmix_state prm)
89{
90 struct fsl_audmix *priv = snd_soc_component_get_drvdata(comp);
91
92 if ((priv->tdms & prm.tdms) != prm.tdms) {
93 dev_dbg(comp->dev, "%s", prm.msg);
94 return -EINVAL;
95 }
96
97 switch (prm.clk) {
98 case 1:
99 case 2:
100
101 (*mask) |= FSL_AUDMIX_CTR_MIXCLK_MASK;
102 (*ctr) |= FSL_AUDMIX_CTR_MIXCLK(prm.clk - 1);
103 break;
104 default:
105 break;
106 }
107
108 return 0;
109}
110
111static int fsl_audmix_put_mix_clk_src(struct snd_kcontrol *kcontrol,
112 struct snd_ctl_elem_value *ucontrol)
113{
114 struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
115 struct fsl_audmix *priv = snd_soc_component_get_drvdata(comp);
116 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
117 unsigned int *item = ucontrol->value.enumerated.item;
118 unsigned int reg_val, val, mix_clk;
119
120
121 reg_val = snd_soc_component_read(comp, FSL_AUDMIX_CTR);
122 mix_clk = ((reg_val & FSL_AUDMIX_CTR_MIXCLK_MASK)
123 >> FSL_AUDMIX_CTR_MIXCLK_SHIFT);
124 val = snd_soc_enum_item_to_val(e, item[0]);
125
126 dev_dbg(comp->dev, "TDMs=x%08x, val=x%08x\n", priv->tdms, val);
127
128
129
130
131
132 if (!(priv->tdms & BIT(mix_clk))) {
133 dev_err(comp->dev,
134 "Started TDM%d needed for config propagation!\n",
135 mix_clk + 1);
136 return -EINVAL;
137 }
138
139 if (!(priv->tdms & BIT(val))) {
140 dev_err(comp->dev,
141 "The selected clock source has no TDM%d enabled!\n",
142 val + 1);
143 return -EINVAL;
144 }
145
146 return snd_soc_put_enum_double(kcontrol, ucontrol);
147}
148
149static int fsl_audmix_put_out_src(struct snd_kcontrol *kcontrol,
150 struct snd_ctl_elem_value *ucontrol)
151{
152 struct snd_soc_component *comp = snd_kcontrol_chip(kcontrol);
153 struct fsl_audmix *priv = snd_soc_component_get_drvdata(comp);
154 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
155 unsigned int *item = ucontrol->value.enumerated.item;
156 u32 out_src, mix_clk;
157 unsigned int reg_val, val, mask = 0, ctr = 0;
158 int ret;
159
160
161 reg_val = snd_soc_component_read(comp, FSL_AUDMIX_CTR);
162
163
164 out_src = ((reg_val & FSL_AUDMIX_CTR_OUTSRC_MASK)
165 >> FSL_AUDMIX_CTR_OUTSRC_SHIFT);
166 mix_clk = ((reg_val & FSL_AUDMIX_CTR_MIXCLK_MASK)
167 >> FSL_AUDMIX_CTR_MIXCLK_SHIFT);
168
169
170 val = snd_soc_enum_item_to_val(e, item[0]);
171
172 dev_dbg(comp->dev, "TDMs=x%08x, val=x%08x\n", priv->tdms, val);
173
174
175 if (out_src == val)
176 return 0;
177
178
179
180
181 if (!(priv->tdms & BIT(mix_clk))) {
182 dev_err(comp->dev,
183 "Started TDM%d needed for config propagation!\n",
184 mix_clk + 1);
185 return -EINVAL;
186 }
187
188
189 ret = fsl_audmix_state_trans(comp, &mask, &ctr, prms[out_src][val]);
190 if (ret)
191 return ret;
192
193
194 mask |= FSL_AUDMIX_CTR_OUTSRC_MASK;
195 ctr |= FSL_AUDMIX_CTR_OUTSRC(val);
196
197 return snd_soc_component_update_bits(comp, FSL_AUDMIX_CTR, mask, ctr);
198}
199
200static const struct snd_kcontrol_new fsl_audmix_snd_controls[] = {
201
202 SOC_ENUM_EXT("Mixing Clock Source", fsl_audmix_enum[0],
203 snd_soc_get_enum_double, fsl_audmix_put_mix_clk_src),
204 SOC_ENUM_EXT("Output Source", fsl_audmix_enum[1],
205 snd_soc_get_enum_double, fsl_audmix_put_out_src),
206 SOC_ENUM("Output Width", fsl_audmix_enum[2]),
207 SOC_ENUM("Frame Rate Diff Error", fsl_audmix_enum[3]),
208 SOC_ENUM("Clock Freq Diff Error", fsl_audmix_enum[4]),
209 SOC_ENUM("Sync Mode Config", fsl_audmix_enum[5]),
210 SOC_ENUM("Sync Mode Clk Source", fsl_audmix_enum[6]),
211
212 SOC_ENUM("TDM1 Attenuation", fsl_audmix_enum[7]),
213 SOC_ENUM("TDM1 Attenuation Direction", fsl_audmix_enum[8]),
214 SOC_SINGLE("TDM1 Attenuation Step Divider", FSL_AUDMIX_ATCR0,
215 2, 0x00fff, 0),
216 SOC_SINGLE("TDM1 Attenuation Initial Value", FSL_AUDMIX_ATIVAL0,
217 0, 0x3ffff, 0),
218 SOC_SINGLE("TDM1 Attenuation Step Up Factor", FSL_AUDMIX_ATSTPUP0,
219 0, 0x3ffff, 0),
220 SOC_SINGLE("TDM1 Attenuation Step Down Factor", FSL_AUDMIX_ATSTPDN0,
221 0, 0x3ffff, 0),
222 SOC_SINGLE("TDM1 Attenuation Step Target", FSL_AUDMIX_ATSTPTGT0,
223 0, 0x3ffff, 0),
224
225 SOC_ENUM("TDM2 Attenuation", fsl_audmix_enum[9]),
226 SOC_ENUM("TDM2 Attenuation Direction", fsl_audmix_enum[10]),
227 SOC_SINGLE("TDM2 Attenuation Step Divider", FSL_AUDMIX_ATCR1,
228 2, 0x00fff, 0),
229 SOC_SINGLE("TDM2 Attenuation Initial Value", FSL_AUDMIX_ATIVAL1,
230 0, 0x3ffff, 0),
231 SOC_SINGLE("TDM2 Attenuation Step Up Factor", FSL_AUDMIX_ATSTPUP1,
232 0, 0x3ffff, 0),
233 SOC_SINGLE("TDM2 Attenuation Step Down Factor", FSL_AUDMIX_ATSTPDN1,
234 0, 0x3ffff, 0),
235 SOC_SINGLE("TDM2 Attenuation Step Target", FSL_AUDMIX_ATSTPTGT1,
236 0, 0x3ffff, 0),
237};
238
239static int fsl_audmix_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
240{
241 struct snd_soc_component *comp = dai->component;
242 u32 mask = 0, ctr = 0;
243
244
245 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
246 case SND_SOC_DAIFMT_DSP_A:
247 break;
248 default:
249 return -EINVAL;
250 }
251
252
253 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
254 case SND_SOC_DAIFMT_CBM_CFM:
255 case SND_SOC_DAIFMT_CBS_CFS:
256 break;
257 default:
258 return -EINVAL;
259 }
260
261 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
262 case SND_SOC_DAIFMT_IB_NF:
263
264 ctr |= FSL_AUDMIX_CTR_OUTCKPOL(0);
265 break;
266 case SND_SOC_DAIFMT_NB_NF:
267
268 ctr |= FSL_AUDMIX_CTR_OUTCKPOL(1);
269 break;
270 default:
271 return -EINVAL;
272 }
273
274 mask |= FSL_AUDMIX_CTR_OUTCKPOL_MASK;
275
276 return snd_soc_component_update_bits(comp, FSL_AUDMIX_CTR, mask, ctr);
277}
278
279static int fsl_audmix_dai_trigger(struct snd_pcm_substream *substream, int cmd,
280 struct snd_soc_dai *dai)
281{
282 struct fsl_audmix *priv = snd_soc_dai_get_drvdata(dai);
283 unsigned long lock_flags;
284
285
286 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
287 return 0;
288
289 switch (cmd) {
290 case SNDRV_PCM_TRIGGER_START:
291 case SNDRV_PCM_TRIGGER_RESUME:
292 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
293 spin_lock_irqsave(&priv->lock, lock_flags);
294 priv->tdms |= BIT(dai->driver->id);
295 spin_unlock_irqrestore(&priv->lock, lock_flags);
296 break;
297 case SNDRV_PCM_TRIGGER_STOP:
298 case SNDRV_PCM_TRIGGER_SUSPEND:
299 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
300 spin_lock_irqsave(&priv->lock, lock_flags);
301 priv->tdms &= ~BIT(dai->driver->id);
302 spin_unlock_irqrestore(&priv->lock, lock_flags);
303 break;
304 default:
305 return -EINVAL;
306 }
307
308 return 0;
309}
310
311static const struct snd_soc_dai_ops fsl_audmix_dai_ops = {
312 .set_fmt = fsl_audmix_dai_set_fmt,
313 .trigger = fsl_audmix_dai_trigger,
314};
315
316static struct snd_soc_dai_driver fsl_audmix_dai[] = {
317 {
318 .id = 0,
319 .name = "audmix-0",
320 .playback = {
321 .stream_name = "AUDMIX-Playback-0",
322 .channels_min = 8,
323 .channels_max = 8,
324 .rate_min = 8000,
325 .rate_max = 96000,
326 .rates = SNDRV_PCM_RATE_8000_96000,
327 .formats = FSL_AUDMIX_FORMATS,
328 },
329 .capture = {
330 .stream_name = "AUDMIX-Capture-0",
331 .channels_min = 8,
332 .channels_max = 8,
333 .rate_min = 8000,
334 .rate_max = 96000,
335 .rates = SNDRV_PCM_RATE_8000_96000,
336 .formats = FSL_AUDMIX_FORMATS,
337 },
338 .ops = &fsl_audmix_dai_ops,
339 },
340 {
341 .id = 1,
342 .name = "audmix-1",
343 .playback = {
344 .stream_name = "AUDMIX-Playback-1",
345 .channels_min = 8,
346 .channels_max = 8,
347 .rate_min = 8000,
348 .rate_max = 96000,
349 .rates = SNDRV_PCM_RATE_8000_96000,
350 .formats = FSL_AUDMIX_FORMATS,
351 },
352 .capture = {
353 .stream_name = "AUDMIX-Capture-1",
354 .channels_min = 8,
355 .channels_max = 8,
356 .rate_min = 8000,
357 .rate_max = 96000,
358 .rates = SNDRV_PCM_RATE_8000_96000,
359 .formats = FSL_AUDMIX_FORMATS,
360 },
361 .ops = &fsl_audmix_dai_ops,
362 },
363};
364
365static const struct snd_soc_component_driver fsl_audmix_component = {
366 .name = "fsl-audmix-dai",
367 .controls = fsl_audmix_snd_controls,
368 .num_controls = ARRAY_SIZE(fsl_audmix_snd_controls),
369};
370
371static bool fsl_audmix_readable_reg(struct device *dev, unsigned int reg)
372{
373 switch (reg) {
374 case FSL_AUDMIX_CTR:
375 case FSL_AUDMIX_STR:
376 case FSL_AUDMIX_ATCR0:
377 case FSL_AUDMIX_ATIVAL0:
378 case FSL_AUDMIX_ATSTPUP0:
379 case FSL_AUDMIX_ATSTPDN0:
380 case FSL_AUDMIX_ATSTPTGT0:
381 case FSL_AUDMIX_ATTNVAL0:
382 case FSL_AUDMIX_ATSTP0:
383 case FSL_AUDMIX_ATCR1:
384 case FSL_AUDMIX_ATIVAL1:
385 case FSL_AUDMIX_ATSTPUP1:
386 case FSL_AUDMIX_ATSTPDN1:
387 case FSL_AUDMIX_ATSTPTGT1:
388 case FSL_AUDMIX_ATTNVAL1:
389 case FSL_AUDMIX_ATSTP1:
390 return true;
391 default:
392 return false;
393 }
394}
395
396static bool fsl_audmix_writeable_reg(struct device *dev, unsigned int reg)
397{
398 switch (reg) {
399 case FSL_AUDMIX_CTR:
400 case FSL_AUDMIX_ATCR0:
401 case FSL_AUDMIX_ATIVAL0:
402 case FSL_AUDMIX_ATSTPUP0:
403 case FSL_AUDMIX_ATSTPDN0:
404 case FSL_AUDMIX_ATSTPTGT0:
405 case FSL_AUDMIX_ATCR1:
406 case FSL_AUDMIX_ATIVAL1:
407 case FSL_AUDMIX_ATSTPUP1:
408 case FSL_AUDMIX_ATSTPDN1:
409 case FSL_AUDMIX_ATSTPTGT1:
410 return true;
411 default:
412 return false;
413 }
414}
415
416static const struct reg_default fsl_audmix_reg[] = {
417 { FSL_AUDMIX_CTR, 0x00060 },
418 { FSL_AUDMIX_STR, 0x00003 },
419 { FSL_AUDMIX_ATCR0, 0x00000 },
420 { FSL_AUDMIX_ATIVAL0, 0x3FFFF },
421 { FSL_AUDMIX_ATSTPUP0, 0x2AAAA },
422 { FSL_AUDMIX_ATSTPDN0, 0x30000 },
423 { FSL_AUDMIX_ATSTPTGT0, 0x00010 },
424 { FSL_AUDMIX_ATTNVAL0, 0x00000 },
425 { FSL_AUDMIX_ATSTP0, 0x00000 },
426 { FSL_AUDMIX_ATCR1, 0x00000 },
427 { FSL_AUDMIX_ATIVAL1, 0x3FFFF },
428 { FSL_AUDMIX_ATSTPUP1, 0x2AAAA },
429 { FSL_AUDMIX_ATSTPDN1, 0x30000 },
430 { FSL_AUDMIX_ATSTPTGT1, 0x00010 },
431 { FSL_AUDMIX_ATTNVAL1, 0x00000 },
432 { FSL_AUDMIX_ATSTP1, 0x00000 },
433};
434
435static const struct regmap_config fsl_audmix_regmap_config = {
436 .reg_bits = 32,
437 .reg_stride = 4,
438 .val_bits = 32,
439 .max_register = FSL_AUDMIX_ATSTP1,
440 .reg_defaults = fsl_audmix_reg,
441 .num_reg_defaults = ARRAY_SIZE(fsl_audmix_reg),
442 .readable_reg = fsl_audmix_readable_reg,
443 .writeable_reg = fsl_audmix_writeable_reg,
444 .cache_type = REGCACHE_FLAT,
445};
446
447static const struct of_device_id fsl_audmix_ids[] = {
448 {
449 .compatible = "fsl,imx8qm-audmix",
450 .data = "imx-audmix",
451 },
452 { }
453};
454MODULE_DEVICE_TABLE(of, fsl_audmix_ids);
455
456static int fsl_audmix_probe(struct platform_device *pdev)
457{
458 struct device *dev = &pdev->dev;
459 struct fsl_audmix *priv;
460 const char *mdrv;
461 const struct of_device_id *of_id;
462 void __iomem *regs;
463 int ret;
464
465 of_id = of_match_device(fsl_audmix_ids, dev);
466 if (!of_id || !of_id->data)
467 return -EINVAL;
468
469 mdrv = of_id->data;
470
471 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
472 if (!priv)
473 return -ENOMEM;
474
475
476 regs = devm_platform_ioremap_resource(pdev, 0);
477 if (IS_ERR(regs))
478 return PTR_ERR(regs);
479
480 priv->regmap = devm_regmap_init_mmio_clk(dev, "ipg", regs,
481 &fsl_audmix_regmap_config);
482 if (IS_ERR(priv->regmap)) {
483 dev_err(dev, "failed to init regmap\n");
484 return PTR_ERR(priv->regmap);
485 }
486
487 priv->ipg_clk = devm_clk_get(dev, "ipg");
488 if (IS_ERR(priv->ipg_clk)) {
489 dev_err(dev, "failed to get ipg clock\n");
490 return PTR_ERR(priv->ipg_clk);
491 }
492
493 spin_lock_init(&priv->lock);
494 platform_set_drvdata(pdev, priv);
495 pm_runtime_enable(dev);
496
497 ret = devm_snd_soc_register_component(dev, &fsl_audmix_component,
498 fsl_audmix_dai,
499 ARRAY_SIZE(fsl_audmix_dai));
500 if (ret) {
501 dev_err(dev, "failed to register ASoC DAI\n");
502 goto err_disable_pm;
503 }
504
505 priv->pdev = platform_device_register_data(dev, mdrv, 0, NULL, 0);
506 if (IS_ERR(priv->pdev)) {
507 ret = PTR_ERR(priv->pdev);
508 dev_err(dev, "failed to register platform %s: %d\n", mdrv, ret);
509 goto err_disable_pm;
510 }
511
512 return 0;
513
514err_disable_pm:
515 pm_runtime_disable(dev);
516 return ret;
517}
518
519static int fsl_audmix_remove(struct platform_device *pdev)
520{
521 struct fsl_audmix *priv = dev_get_drvdata(&pdev->dev);
522
523 pm_runtime_disable(&pdev->dev);
524
525 if (priv->pdev)
526 platform_device_unregister(priv->pdev);
527
528 return 0;
529}
530
531#ifdef CONFIG_PM
532static int fsl_audmix_runtime_resume(struct device *dev)
533{
534 struct fsl_audmix *priv = dev_get_drvdata(dev);
535 int ret;
536
537 ret = clk_prepare_enable(priv->ipg_clk);
538 if (ret) {
539 dev_err(dev, "Failed to enable IPG clock: %d\n", ret);
540 return ret;
541 }
542
543 regcache_cache_only(priv->regmap, false);
544 regcache_mark_dirty(priv->regmap);
545
546 return regcache_sync(priv->regmap);
547}
548
549static int fsl_audmix_runtime_suspend(struct device *dev)
550{
551 struct fsl_audmix *priv = dev_get_drvdata(dev);
552
553 regcache_cache_only(priv->regmap, true);
554
555 clk_disable_unprepare(priv->ipg_clk);
556
557 return 0;
558}
559#endif
560
561static const struct dev_pm_ops fsl_audmix_pm = {
562 SET_RUNTIME_PM_OPS(fsl_audmix_runtime_suspend,
563 fsl_audmix_runtime_resume,
564 NULL)
565 SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
566 pm_runtime_force_resume)
567};
568
569static struct platform_driver fsl_audmix_driver = {
570 .probe = fsl_audmix_probe,
571 .remove = fsl_audmix_remove,
572 .driver = {
573 .name = "fsl-audmix",
574 .of_match_table = fsl_audmix_ids,
575 .pm = &fsl_audmix_pm,
576 },
577};
578module_platform_driver(fsl_audmix_driver);
579
580MODULE_DESCRIPTION("NXP AUDMIX ASoC DAI driver");
581MODULE_AUTHOR("Viorel Suman <viorel.suman@nxp.com>");
582MODULE_ALIAS("platform:fsl-audmix");
583MODULE_LICENSE("GPL v2");
584
