1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com
4 * Author: Peter Ujfalusi <peter.ujfalusi@ti.com>
5 */
6
7 #include <linux/clk.h>
8 #include <linux/module.h>
9 #include <linux/of.h>
10 #include <linux/platform_device.h>
11
12 #include <sound/core.h>
13 #include <sound/pcm.h>
14 #include <sound/pcm_params.h>
15 #include <sound/soc.h>
16
17 #include "davinci-mcasp.h"
18
19 /*
20 * Maximum number of configuration entries for prefixes:
21 * CPB: 2 (mcasp10 + codec)
22 * IVI: 3 (mcasp0 + 2x codec)
23 */
24 #define J721E_CODEC_CONF_COUNT 5
25
26 enum j721e_audio_domain_id {
27 J721E_AUDIO_DOMAIN_CPB = 0,
28 J721E_AUDIO_DOMAIN_IVI,
29 J721E_AUDIO_DOMAIN_LAST,
30 };
31
32 #define J721E_CLK_PARENT_48000 0
33 #define J721E_CLK_PARENT_44100 1
34
35 #define J721E_MAX_CLK_HSDIV 128
36 #define PCM1368A_MAX_SYSCLK 36864000
37
38 #define J721E_DAI_FMT (SND_SOC_DAIFMT_RIGHT_J | \
39 SND_SOC_DAIFMT_NB_NF | \
40 SND_SOC_DAIFMT_CBS_CFS)
41
42 enum j721e_board_type {
43 J721E_BOARD_CPB = 1,
44 J721E_BOARD_CPB_IVI,
45 };
46
47 struct j721e_audio_match_data {
48 enum j721e_board_type board_type;
49 int num_links;
50 unsigned int pll_rates[2];
51 };
52
53 static unsigned int ratios_for_pcm3168a[] = {
54 256,
55 512,
56 768,
57 };
58
59 struct j721e_audio_clocks {
60 struct clk *target;
61 struct clk *parent[2];
62 };
63
64 struct j721e_audio_domain {
65 struct j721e_audio_clocks codec;
66 struct j721e_audio_clocks mcasp;
67 int parent_clk_id;
68
69 int active;
70 unsigned int active_link;
71 unsigned int rate;
72 };
73
74 struct j721e_priv {
75 struct device *dev;
76 struct snd_soc_card card;
77 struct snd_soc_dai_link *dai_links;
78 struct snd_soc_codec_conf codec_conf[J721E_CODEC_CONF_COUNT];
79 struct snd_interval rate_range;
80 const struct j721e_audio_match_data *match_data;
81 u32 pll_rates[2];
82 unsigned int hsdiv_rates[2];
83
84 struct j721e_audio_domain audio_domains[J721E_AUDIO_DOMAIN_LAST];
85
86 struct mutex mutex;
87 };
88
89 static const struct snd_soc_dapm_widget j721e_cpb_dapm_widgets[] = {
90 SND_SOC_DAPM_HP("CPB Stereo HP 1", NULL),
91 SND_SOC_DAPM_HP("CPB Stereo HP 2", NULL),
92 SND_SOC_DAPM_HP("CPB Stereo HP 3", NULL),
93 SND_SOC_DAPM_LINE("CPB Line Out", NULL),
94 SND_SOC_DAPM_MIC("CPB Stereo Mic 1", NULL),
95 SND_SOC_DAPM_MIC("CPB Stereo Mic 2", NULL),
96 SND_SOC_DAPM_LINE("CPB Line In", NULL),
97 };
98
99 static const struct snd_soc_dapm_route j721e_cpb_dapm_routes[] = {
100 {"CPB Stereo HP 1", NULL, "codec-1 AOUT1L"},
101 {"CPB Stereo HP 1", NULL, "codec-1 AOUT1R"},
102 {"CPB Stereo HP 2", NULL, "codec-1 AOUT2L"},
103 {"CPB Stereo HP 2", NULL, "codec-1 AOUT2R"},
104 {"CPB Stereo HP 3", NULL, "codec-1 AOUT3L"},
105 {"CPB Stereo HP 3", NULL, "codec-1 AOUT3R"},
106 {"CPB Line Out", NULL, "codec-1 AOUT4L"},
107 {"CPB Line Out", NULL, "codec-1 AOUT4R"},
108
109 {"codec-1 AIN1L", NULL, "CPB Stereo Mic 1"},
110 {"codec-1 AIN1R", NULL, "CPB Stereo Mic 1"},
111 {"codec-1 AIN2L", NULL, "CPB Stereo Mic 2"},
112 {"codec-1 AIN2R", NULL, "CPB Stereo Mic 2"},
113 {"codec-1 AIN3L", NULL, "CPB Line In"},
114 {"codec-1 AIN3R", NULL, "CPB Line In"},
115 };
116
117 static const struct snd_soc_dapm_widget j721e_ivi_codec_a_dapm_widgets[] = {
118 SND_SOC_DAPM_LINE("IVI A Line Out 1", NULL),
119 SND_SOC_DAPM_LINE("IVI A Line Out 2", NULL),
120 SND_SOC_DAPM_LINE("IVI A Line Out 3", NULL),
121 SND_SOC_DAPM_LINE("IVI A Line Out 4", NULL),
122 SND_SOC_DAPM_MIC("IVI A Stereo Mic 1", NULL),
123 SND_SOC_DAPM_MIC("IVI A Stereo Mic 2", NULL),
124 SND_SOC_DAPM_LINE("IVI A Line In", NULL),
125 };
126
127 static const struct snd_soc_dapm_route j721e_codec_a_dapm_routes[] = {
128 {"IVI A Line Out 1", NULL, "codec-a AOUT1L"},
129 {"IVI A Line Out 1", NULL, "codec-a AOUT1R"},
130 {"IVI A Line Out 2", NULL, "codec-a AOUT2L"},
131 {"IVI A Line Out 2", NULL, "codec-a AOUT2R"},
132 {"IVI A Line Out 3", NULL, "codec-a AOUT3L"},
133 {"IVI A Line Out 3", NULL, "codec-a AOUT3R"},
134 {"IVI A Line Out 4", NULL, "codec-a AOUT4L"},
135 {"IVI A Line Out 4", NULL, "codec-a AOUT4R"},
136
137 {"codec-a AIN1L", NULL, "IVI A Stereo Mic 1"},
138 {"codec-a AIN1R", NULL, "IVI A Stereo Mic 1"},
139 {"codec-a AIN2L", NULL, "IVI A Stereo Mic 2"},
140 {"codec-a AIN2R", NULL, "IVI A Stereo Mic 2"},
141 {"codec-a AIN3L", NULL, "IVI A Line In"},
142 {"codec-a AIN3R", NULL, "IVI A Line In"},
143 };
144
145 static const struct snd_soc_dapm_widget j721e_ivi_codec_b_dapm_widgets[] = {
146 SND_SOC_DAPM_LINE("IVI B Line Out 1", NULL),
147 SND_SOC_DAPM_LINE("IVI B Line Out 2", NULL),
148 SND_SOC_DAPM_LINE("IVI B Line Out 3", NULL),
149 SND_SOC_DAPM_LINE("IVI B Line Out 4", NULL),
150 SND_SOC_DAPM_MIC("IVI B Stereo Mic 1", NULL),
151 SND_SOC_DAPM_MIC("IVI B Stereo Mic 2", NULL),
152 SND_SOC_DAPM_LINE("IVI B Line In", NULL),
153 };
154
155 static const struct snd_soc_dapm_route j721e_codec_b_dapm_routes[] = {
156 {"IVI B Line Out 1", NULL, "codec-b AOUT1L"},
157 {"IVI B Line Out 1", NULL, "codec-b AOUT1R"},
158 {"IVI B Line Out 2", NULL, "codec-b AOUT2L"},
159 {"IVI B Line Out 2", NULL, "codec-b AOUT2R"},
160 {"IVI B Line Out 3", NULL, "codec-b AOUT3L"},
161 {"IVI B Line Out 3", NULL, "codec-b AOUT3R"},
162 {"IVI B Line Out 4", NULL, "codec-b AOUT4L"},
163 {"IVI B Line Out 4", NULL, "codec-b AOUT4R"},
164
165 {"codec-b AIN1L", NULL, "IVI B Stereo Mic 1"},
166 {"codec-b AIN1R", NULL, "IVI B Stereo Mic 1"},
167 {"codec-b AIN2L", NULL, "IVI B Stereo Mic 2"},
168 {"codec-b AIN2R", NULL, "IVI B Stereo Mic 2"},
169 {"codec-b AIN3L", NULL, "IVI B Line In"},
170 {"codec-b AIN3R", NULL, "IVI B Line In"},
171 };
172
j721e_configure_refclk(struct j721e_priv * priv,unsigned int audio_domain,unsigned int rate)173 static int j721e_configure_refclk(struct j721e_priv *priv,
174 unsigned int audio_domain, unsigned int rate)
175 {
176 struct j721e_audio_domain *domain = &priv->audio_domains[audio_domain];
177 unsigned int scki;
178 int ret = -EINVAL;
179 int i, clk_id;
180
181 if (!(rate % 8000) && priv->pll_rates[J721E_CLK_PARENT_48000])
182 clk_id = J721E_CLK_PARENT_48000;
183 else if (!(rate % 11025) && priv->pll_rates[J721E_CLK_PARENT_44100])
184 clk_id = J721E_CLK_PARENT_44100;
185 else
186 return ret;
187
188 for (i = 0; i < ARRAY_SIZE(ratios_for_pcm3168a); i++) {
189 scki = ratios_for_pcm3168a[i] * rate;
190
191 if (priv->pll_rates[clk_id] / scki <= J721E_MAX_CLK_HSDIV) {
192 ret = 0;
193 break;
194 }
195 }
196
197 if (ret) {
198 dev_err(priv->dev, "No valid clock configuration for %u Hz\n",
199 rate);
200 return ret;
201 }
202
203 if (domain->parent_clk_id == -1 || priv->hsdiv_rates[domain->parent_clk_id] != scki) {
204 dev_dbg(priv->dev,
205 "domain%u configuration for %u Hz: %s, %dxFS (SCKI: %u Hz)\n",
206 audio_domain, rate,
207 clk_id == J721E_CLK_PARENT_48000 ? "PLL4" : "PLL15",
208 ratios_for_pcm3168a[i], scki);
209
210 if (domain->parent_clk_id != clk_id) {
211 ret = clk_set_parent(domain->codec.target,
212 domain->codec.parent[clk_id]);
213 if (ret)
214 return ret;
215
216 ret = clk_set_parent(domain->mcasp.target,
217 domain->mcasp.parent[clk_id]);
218 if (ret)
219 return ret;
220
221 domain->parent_clk_id = clk_id;
222 }
223
224 ret = clk_set_rate(domain->codec.target, scki);
225 if (ret) {
226 dev_err(priv->dev, "codec set rate failed for %u Hz\n",
227 scki);
228 return ret;
229 }
230
231 ret = clk_set_rate(domain->mcasp.target, scki);
232 if (!ret) {
233 priv->hsdiv_rates[domain->parent_clk_id] = scki;
234 } else {
235 dev_err(priv->dev, "mcasp set rate failed for %u Hz\n",
236 scki);
237 return ret;
238 }
239 }
240
241 return ret;
242 }
243
j721e_rule_rate(struct snd_pcm_hw_params * params,struct snd_pcm_hw_rule * rule)244 static int j721e_rule_rate(struct snd_pcm_hw_params *params,
245 struct snd_pcm_hw_rule *rule)
246 {
247 struct snd_interval *t = rule->private;
248
249 return snd_interval_refine(hw_param_interval(params, rule->var), t);
250 }
251
j721e_audio_startup(struct snd_pcm_substream * substream)252 static int j721e_audio_startup(struct snd_pcm_substream *substream)
253 {
254 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
255 struct j721e_priv *priv = snd_soc_card_get_drvdata(rtd->card);
256 unsigned int domain_id = rtd->dai_link->id;
257 struct j721e_audio_domain *domain = &priv->audio_domains[domain_id];
258 struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
259 struct snd_soc_dai *codec_dai;
260 unsigned int active_rate;
261 int ret = 0;
262 int i;
263
264 mutex_lock(&priv->mutex);
265
266 domain->active++;
267
268 for (i = 0; i < J721E_AUDIO_DOMAIN_LAST; i++) {
269 active_rate = priv->audio_domains[i].rate;
270 if (active_rate)
271 break;
272 }
273
274 if (active_rate)
275 ret = snd_pcm_hw_constraint_single(substream->runtime,
276 SNDRV_PCM_HW_PARAM_RATE,
277 active_rate);
278 else
279 ret = snd_pcm_hw_rule_add(substream->runtime, 0,
280 SNDRV_PCM_HW_PARAM_RATE,
281 j721e_rule_rate, &priv->rate_range,
282 SNDRV_PCM_HW_PARAM_RATE, -1);
283
284
285 if (ret)
286 goto out;
287
288 /* Reset TDM slots to 32 */
289 ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0x3, 0x3, 2, 32);
290 if (ret && ret != -ENOTSUPP)
291 goto out;
292
293 for_each_rtd_codec_dais(rtd, i, codec_dai) {
294 ret = snd_soc_dai_set_tdm_slot(codec_dai, 0x3, 0x3, 2, 32);
295 if (ret && ret != -ENOTSUPP)
296 goto out;
297 }
298
299 if (ret == -ENOTSUPP)
300 ret = 0;
301 out:
302 if (ret)
303 domain->active--;
304 mutex_unlock(&priv->mutex);
305
306 return ret;
307 }
308
j721e_audio_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params)309 static int j721e_audio_hw_params(struct snd_pcm_substream *substream,
310 struct snd_pcm_hw_params *params)
311 {
312 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
313 struct snd_soc_card *card = rtd->card;
314 struct j721e_priv *priv = snd_soc_card_get_drvdata(card);
315 unsigned int domain_id = rtd->dai_link->id;
316 struct j721e_audio_domain *domain = &priv->audio_domains[domain_id];
317 struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
318 struct snd_soc_dai *codec_dai;
319 unsigned int sysclk_rate;
320 int slot_width = 32;
321 int ret;
322 int i;
323
324 mutex_lock(&priv->mutex);
325
326 if (domain->rate && domain->rate != params_rate(params)) {
327 ret = -EINVAL;
328 goto out;
329 }
330
331 if (params_width(params) == 16)
332 slot_width = 16;
333
334 ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0x3, 0x3, 2, slot_width);
335 if (ret && ret != -ENOTSUPP)
336 goto out;
337
338 for_each_rtd_codec_dais(rtd, i, codec_dai) {
339 ret = snd_soc_dai_set_tdm_slot(codec_dai, 0x3, 0x3, 2,
340 slot_width);
341 if (ret && ret != -ENOTSUPP)
342 goto out;
343 }
344
345 ret = j721e_configure_refclk(priv, domain_id, params_rate(params));
346 if (ret)
347 goto out;
348
349 sysclk_rate = priv->hsdiv_rates[domain->parent_clk_id];
350 for_each_rtd_codec_dais(rtd, i, codec_dai) {
351 ret = snd_soc_dai_set_sysclk(codec_dai, 0, sysclk_rate,
352 SND_SOC_CLOCK_IN);
353 if (ret && ret != -ENOTSUPP) {
354 dev_err(priv->dev,
355 "codec set_sysclk failed for %u Hz\n",
356 sysclk_rate);
357 goto out;
358 }
359 }
360
361 ret = snd_soc_dai_set_sysclk(cpu_dai, MCASP_CLK_HCLK_AUXCLK,
362 sysclk_rate, SND_SOC_CLOCK_IN);
363
364 if (ret && ret != -ENOTSUPP) {
365 dev_err(priv->dev, "mcasp set_sysclk failed for %u Hz\n",
366 sysclk_rate);
367 } else {
368 domain->rate = params_rate(params);
369 ret = 0;
370 }
371
372 out:
373 mutex_unlock(&priv->mutex);
374 return ret;
375 }
376
j721e_audio_shutdown(struct snd_pcm_substream * substream)377 static void j721e_audio_shutdown(struct snd_pcm_substream *substream)
378 {
379 struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
380 struct j721e_priv *priv = snd_soc_card_get_drvdata(rtd->card);
381 unsigned int domain_id = rtd->dai_link->id;
382 struct j721e_audio_domain *domain = &priv->audio_domains[domain_id];
383
384 mutex_lock(&priv->mutex);
385
386 domain->active--;
387 if (!domain->active) {
388 domain->rate = 0;
389 domain->active_link = 0;
390 }
391
392 mutex_unlock(&priv->mutex);
393 }
394
395 static const struct snd_soc_ops j721e_audio_ops = {
396 .startup = j721e_audio_startup,
397 .hw_params = j721e_audio_hw_params,
398 .shutdown = j721e_audio_shutdown,
399 };
400
j721e_audio_init(struct snd_soc_pcm_runtime * rtd)401 static int j721e_audio_init(struct snd_soc_pcm_runtime *rtd)
402 {
403 struct j721e_priv *priv = snd_soc_card_get_drvdata(rtd->card);
404 unsigned int domain_id = rtd->dai_link->id;
405 struct j721e_audio_domain *domain = &priv->audio_domains[domain_id];
406 struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(rtd, 0);
407 struct snd_soc_dai *codec_dai;
408 unsigned int sysclk_rate;
409 int i, ret;
410
411 /* Set up initial clock configuration */
412 ret = j721e_configure_refclk(priv, domain_id, 48000);
413 if (ret)
414 return ret;
415
416 sysclk_rate = priv->hsdiv_rates[domain->parent_clk_id];
417 for_each_rtd_codec_dais(rtd, i, codec_dai) {
418 ret = snd_soc_dai_set_sysclk(codec_dai, 0, sysclk_rate,
419 SND_SOC_CLOCK_IN);
420 if (ret && ret != -ENOTSUPP)
421 return ret;
422 }
423
424 ret = snd_soc_dai_set_sysclk(cpu_dai, MCASP_CLK_HCLK_AUXCLK,
425 sysclk_rate, SND_SOC_CLOCK_IN);
426 if (ret && ret != -ENOTSUPP)
427 return ret;
428
429 /* Set initial tdm slots */
430 ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0x3, 0x3, 2, 32);
431 if (ret && ret != -ENOTSUPP)
432 return ret;
433
434 for_each_rtd_codec_dais(rtd, i, codec_dai) {
435 ret = snd_soc_dai_set_tdm_slot(codec_dai, 0x3, 0x3, 2, 32);
436 if (ret && ret != -ENOTSUPP)
437 return ret;
438 }
439
440 return 0;
441 }
442
j721e_audio_init_ivi(struct snd_soc_pcm_runtime * rtd)443 static int j721e_audio_init_ivi(struct snd_soc_pcm_runtime *rtd)
444 {
445 struct snd_soc_dapm_context *dapm = &rtd->card->dapm;
446
447 snd_soc_dapm_new_controls(dapm, j721e_ivi_codec_a_dapm_widgets,
448 ARRAY_SIZE(j721e_ivi_codec_a_dapm_widgets));
449 snd_soc_dapm_add_routes(dapm, j721e_codec_a_dapm_routes,
450 ARRAY_SIZE(j721e_codec_a_dapm_routes));
451 snd_soc_dapm_new_controls(dapm, j721e_ivi_codec_b_dapm_widgets,
452 ARRAY_SIZE(j721e_ivi_codec_b_dapm_widgets));
453 snd_soc_dapm_add_routes(dapm, j721e_codec_b_dapm_routes,
454 ARRAY_SIZE(j721e_codec_b_dapm_routes));
455
456 return j721e_audio_init(rtd);
457 }
458
j721e_get_clocks(struct device * dev,struct j721e_audio_clocks * clocks,char * prefix)459 static int j721e_get_clocks(struct device *dev,
460 struct j721e_audio_clocks *clocks, char *prefix)
461 {
462 struct clk *parent;
463 char *clk_name;
464 int ret;
465
466 clocks->target = devm_clk_get(dev, prefix);
467 if (IS_ERR(clocks->target))
468 return dev_err_probe(dev, PTR_ERR(clocks->target),
469 "failed to acquire %s\n", prefix);
470
471 clk_name = kasprintf(GFP_KERNEL, "%s-48000", prefix);
472 if (clk_name) {
473 parent = devm_clk_get(dev, clk_name);
474 kfree(clk_name);
475 if (IS_ERR(parent)) {
476 ret = PTR_ERR(parent);
477 if (ret == -EPROBE_DEFER)
478 return ret;
479
480 dev_dbg(dev, "no 48KHz parent for %s: %d\n", prefix, ret);
481 parent = NULL;
482 }
483 clocks->parent[J721E_CLK_PARENT_48000] = parent;
484 } else {
485 return -ENOMEM;
486 }
487
488 clk_name = kasprintf(GFP_KERNEL, "%s-44100", prefix);
489 if (clk_name) {
490 parent = devm_clk_get(dev, clk_name);
491 kfree(clk_name);
492 if (IS_ERR(parent)) {
493 ret = PTR_ERR(parent);
494 if (ret == -EPROBE_DEFER)
495 return ret;
496
497 dev_dbg(dev, "no 44.1KHz parent for %s: %d\n", prefix, ret);
498 parent = NULL;
499 }
500 clocks->parent[J721E_CLK_PARENT_44100] = parent;
501 } else {
502 return -ENOMEM;
503 }
504
505 if (!clocks->parent[J721E_CLK_PARENT_44100] &&
506 !clocks->parent[J721E_CLK_PARENT_48000]) {
507 dev_err(dev, "At least one parent clock is needed for %s\n",
508 prefix);
509 return -EINVAL;
510 }
511
512 return 0;
513 }
514
515 static const struct j721e_audio_match_data j721e_cpb_data = {
516 .board_type = J721E_BOARD_CPB,
517 .num_links = 2, /* CPB pcm3168a */
518 .pll_rates = {
519 [J721E_CLK_PARENT_44100] = 1083801600, /* PLL15 */
520 [J721E_CLK_PARENT_48000] = 1179648000, /* PLL4 */
521 },
522 };
523
524 static const struct j721e_audio_match_data j721e_cpb_ivi_data = {
525 .board_type = J721E_BOARD_CPB_IVI,
526 .num_links = 4, /* CPB pcm3168a + 2x pcm3168a on IVI */
527 .pll_rates = {
528 [J721E_CLK_PARENT_44100] = 1083801600, /* PLL15 */
529 [J721E_CLK_PARENT_48000] = 1179648000, /* PLL4 */
530 },
531 };
532
533 static const struct j721e_audio_match_data j7200_cpb_data = {
534 .board_type = J721E_BOARD_CPB,
535 .num_links = 2, /* CPB pcm3168a */
536 .pll_rates = {
537 [J721E_CLK_PARENT_48000] = 2359296000u, /* PLL4 */
538 },
539 };
540
541 static const struct of_device_id j721e_audio_of_match[] = {
542 {
543 .compatible = "ti,j721e-cpb-audio",
544 .data = &j721e_cpb_data,
545 }, {
546 .compatible = "ti,j721e-cpb-ivi-audio",
547 .data = &j721e_cpb_ivi_data,
548 }, {
549 .compatible = "ti,j7200-cpb-audio",
550 .data = &j7200_cpb_data,
551 },
552 { },
553 };
554 MODULE_DEVICE_TABLE(of, j721e_audio_of_match);
555
j721e_calculate_rate_range(struct j721e_priv * priv)556 static int j721e_calculate_rate_range(struct j721e_priv *priv)
557 {
558 const struct j721e_audio_match_data *match_data = priv->match_data;
559 struct j721e_audio_clocks *domain_clocks;
560 unsigned int min_rate, max_rate, pll_rate;
561 struct clk *pll;
562
563 domain_clocks = &priv->audio_domains[J721E_AUDIO_DOMAIN_CPB].mcasp;
564
565 pll = clk_get_parent(domain_clocks->parent[J721E_CLK_PARENT_44100]);
566 if (IS_ERR_OR_NULL(pll)) {
567 priv->pll_rates[J721E_CLK_PARENT_44100] =
568 match_data->pll_rates[J721E_CLK_PARENT_44100];
569 } else {
570 priv->pll_rates[J721E_CLK_PARENT_44100] = clk_get_rate(pll);
571 clk_put(pll);
572 }
573
574 pll = clk_get_parent(domain_clocks->parent[J721E_CLK_PARENT_48000]);
575 if (IS_ERR_OR_NULL(pll)) {
576 priv->pll_rates[J721E_CLK_PARENT_48000] =
577 match_data->pll_rates[J721E_CLK_PARENT_48000];
578 } else {
579 priv->pll_rates[J721E_CLK_PARENT_48000] = clk_get_rate(pll);
580 clk_put(pll);
581 }
582
583 if (!priv->pll_rates[J721E_CLK_PARENT_44100] &&
584 !priv->pll_rates[J721E_CLK_PARENT_48000]) {
585 dev_err(priv->dev, "At least one PLL is needed\n");
586 return -EINVAL;
587 }
588
589 if (priv->pll_rates[J721E_CLK_PARENT_44100])
590 pll_rate = priv->pll_rates[J721E_CLK_PARENT_44100];
591 else
592 pll_rate = priv->pll_rates[J721E_CLK_PARENT_48000];
593
594 min_rate = pll_rate / J721E_MAX_CLK_HSDIV;
595 min_rate /= ratios_for_pcm3168a[ARRAY_SIZE(ratios_for_pcm3168a) - 1];
596
597 if (priv->pll_rates[J721E_CLK_PARENT_48000])
598 pll_rate = priv->pll_rates[J721E_CLK_PARENT_48000];
599 else
600 pll_rate = priv->pll_rates[J721E_CLK_PARENT_44100];
601
602 if (pll_rate > PCM1368A_MAX_SYSCLK)
603 pll_rate = PCM1368A_MAX_SYSCLK;
604
605 max_rate = pll_rate / ratios_for_pcm3168a[0];
606
607 snd_interval_any(&priv->rate_range);
608 priv->rate_range.min = min_rate;
609 priv->rate_range.max = max_rate;
610
611 return 0;
612 }
613
j721e_soc_probe_cpb(struct j721e_priv * priv,int * link_idx,int * conf_idx)614 static int j721e_soc_probe_cpb(struct j721e_priv *priv, int *link_idx,
615 int *conf_idx)
616 {
617 struct device_node *node = priv->dev->of_node;
618 struct snd_soc_dai_link_component *compnent;
619 struct device_node *dai_node, *codec_node;
620 struct j721e_audio_domain *domain;
621 int comp_count, comp_idx;
622 int ret;
623
624 dai_node = of_parse_phandle(node, "ti,cpb-mcasp", 0);
625 if (!dai_node) {
626 dev_err(priv->dev, "CPB McASP node is not provided\n");
627 return -EINVAL;
628 }
629
630 codec_node = of_parse_phandle(node, "ti,cpb-codec", 0);
631 if (!codec_node) {
632 dev_err(priv->dev, "CPB codec node is not provided\n");
633 ret = -EINVAL;
634 goto put_dai_node;
635 }
636
637 domain = &priv->audio_domains[J721E_AUDIO_DOMAIN_CPB];
638 ret = j721e_get_clocks(priv->dev, &domain->codec, "cpb-codec-scki");
639 if (ret)
640 goto put_codec_node;
641
642 ret = j721e_get_clocks(priv->dev, &domain->mcasp, "cpb-mcasp-auxclk");
643 if (ret)
644 goto put_codec_node;
645
646 /*
647 * Common Processor Board, two links
648 * Link 1: McASP10 -> pcm3168a_1 DAC
649 * Link 2: McASP10 <- pcm3168a_1 ADC
650 */
651 comp_count = 6;
652 compnent = devm_kzalloc(priv->dev, comp_count * sizeof(*compnent),
653 GFP_KERNEL);
654 if (!compnent) {
655 ret = -ENOMEM;
656 goto put_codec_node;
657 }
658
659 comp_idx = 0;
660 priv->dai_links[*link_idx].cpus = &compnent[comp_idx++];
661 priv->dai_links[*link_idx].num_cpus = 1;
662 priv->dai_links[*link_idx].codecs = &compnent[comp_idx++];
663 priv->dai_links[*link_idx].num_codecs = 1;
664 priv->dai_links[*link_idx].platforms = &compnent[comp_idx++];
665 priv->dai_links[*link_idx].num_platforms = 1;
666
667 priv->dai_links[*link_idx].name = "CPB PCM3168A Playback";
668 priv->dai_links[*link_idx].stream_name = "CPB PCM3168A Analog";
669 priv->dai_links[*link_idx].cpus->of_node = dai_node;
670 priv->dai_links[*link_idx].platforms->of_node = dai_node;
671 priv->dai_links[*link_idx].codecs->of_node = codec_node;
672 priv->dai_links[*link_idx].codecs->dai_name = "pcm3168a-dac";
673 priv->dai_links[*link_idx].playback_only = 1;
674 priv->dai_links[*link_idx].id = J721E_AUDIO_DOMAIN_CPB;
675 priv->dai_links[*link_idx].dai_fmt = J721E_DAI_FMT;
676 priv->dai_links[*link_idx].init = j721e_audio_init;
677 priv->dai_links[*link_idx].ops = &j721e_audio_ops;
678 (*link_idx)++;
679
680 priv->dai_links[*link_idx].cpus = &compnent[comp_idx++];
681 priv->dai_links[*link_idx].num_cpus = 1;
682 priv->dai_links[*link_idx].codecs = &compnent[comp_idx++];
683 priv->dai_links[*link_idx].num_codecs = 1;
684 priv->dai_links[*link_idx].platforms = &compnent[comp_idx++];
685 priv->dai_links[*link_idx].num_platforms = 1;
686
687 priv->dai_links[*link_idx].name = "CPB PCM3168A Capture";
688 priv->dai_links[*link_idx].stream_name = "CPB PCM3168A Analog";
689 priv->dai_links[*link_idx].cpus->of_node = dai_node;
690 priv->dai_links[*link_idx].platforms->of_node = dai_node;
691 priv->dai_links[*link_idx].codecs->of_node = codec_node;
692 priv->dai_links[*link_idx].codecs->dai_name = "pcm3168a-adc";
693 priv->dai_links[*link_idx].capture_only = 1;
694 priv->dai_links[*link_idx].id = J721E_AUDIO_DOMAIN_CPB;
695 priv->dai_links[*link_idx].dai_fmt = J721E_DAI_FMT;
696 priv->dai_links[*link_idx].init = j721e_audio_init;
697 priv->dai_links[*link_idx].ops = &j721e_audio_ops;
698 (*link_idx)++;
699
700 priv->codec_conf[*conf_idx].dlc.of_node = codec_node;
701 priv->codec_conf[*conf_idx].name_prefix = "codec-1";
702 (*conf_idx)++;
703 priv->codec_conf[*conf_idx].dlc.of_node = dai_node;
704 priv->codec_conf[*conf_idx].name_prefix = "McASP10";
705 (*conf_idx)++;
706
707 return 0;
708
709 put_codec_node:
710 of_node_put(codec_node);
711 put_dai_node:
712 of_node_put(dai_node);
713 return ret;
714 }
715
j721e_soc_probe_ivi(struct j721e_priv * priv,int * link_idx,int * conf_idx)716 static int j721e_soc_probe_ivi(struct j721e_priv *priv, int *link_idx,
717 int *conf_idx)
718 {
719 struct device_node *node = priv->dev->of_node;
720 struct snd_soc_dai_link_component *compnent;
721 struct device_node *dai_node, *codeca_node, *codecb_node;
722 struct j721e_audio_domain *domain;
723 int comp_count, comp_idx;
724 int ret;
725
726 if (priv->match_data->board_type != J721E_BOARD_CPB_IVI)
727 return 0;
728
729 dai_node = of_parse_phandle(node, "ti,ivi-mcasp", 0);
730 if (!dai_node) {
731 dev_err(priv->dev, "IVI McASP node is not provided\n");
732 return -EINVAL;
733 }
734
735 codeca_node = of_parse_phandle(node, "ti,ivi-codec-a", 0);
736 if (!codeca_node) {
737 dev_err(priv->dev, "IVI codec-a node is not provided\n");
738 ret = -EINVAL;
739 goto put_dai_node;
740 }
741
742 codecb_node = of_parse_phandle(node, "ti,ivi-codec-b", 0);
743 if (!codecb_node) {
744 dev_warn(priv->dev, "IVI codec-b node is not provided\n");
745 ret = 0;
746 goto put_codeca_node;
747 }
748
749 domain = &priv->audio_domains[J721E_AUDIO_DOMAIN_IVI];
750 ret = j721e_get_clocks(priv->dev, &domain->codec, "ivi-codec-scki");
751 if (ret)
752 goto put_codecb_node;
753
754 ret = j721e_get_clocks(priv->dev, &domain->mcasp, "ivi-mcasp-auxclk");
755 if (ret)
756 goto put_codecb_node;
757
758 /*
759 * IVI extension, two links
760 * Link 1: McASP0 -> pcm3168a_a DAC
761 * \> pcm3168a_b DAC
762 * Link 2: McASP0 <- pcm3168a_a ADC
763 * \ pcm3168a_b ADC
764 */
765 comp_count = 8;
766 compnent = devm_kzalloc(priv->dev, comp_count * sizeof(*compnent),
767 GFP_KERNEL);
768 if (!compnent) {
769 ret = -ENOMEM;
770 goto put_codecb_node;
771 }
772
773 comp_idx = 0;
774 priv->dai_links[*link_idx].cpus = &compnent[comp_idx++];
775 priv->dai_links[*link_idx].num_cpus = 1;
776 priv->dai_links[*link_idx].platforms = &compnent[comp_idx++];
777 priv->dai_links[*link_idx].num_platforms = 1;
778 priv->dai_links[*link_idx].codecs = &compnent[comp_idx];
779 priv->dai_links[*link_idx].num_codecs = 2;
780 comp_idx += 2;
781
782 priv->dai_links[*link_idx].name = "IVI 2xPCM3168A Playback";
783 priv->dai_links[*link_idx].stream_name = "IVI 2xPCM3168A Analog";
784 priv->dai_links[*link_idx].cpus->of_node = dai_node;
785 priv->dai_links[*link_idx].platforms->of_node = dai_node;
786 priv->dai_links[*link_idx].codecs[0].of_node = codeca_node;
787 priv->dai_links[*link_idx].codecs[0].dai_name = "pcm3168a-dac";
788 priv->dai_links[*link_idx].codecs[1].of_node = codecb_node;
789 priv->dai_links[*link_idx].codecs[1].dai_name = "pcm3168a-dac";
790 priv->dai_links[*link_idx].playback_only = 1;
791 priv->dai_links[*link_idx].id = J721E_AUDIO_DOMAIN_IVI;
792 priv->dai_links[*link_idx].dai_fmt = J721E_DAI_FMT;
793 priv->dai_links[*link_idx].init = j721e_audio_init_ivi;
794 priv->dai_links[*link_idx].ops = &j721e_audio_ops;
795 (*link_idx)++;
796
797 priv->dai_links[*link_idx].cpus = &compnent[comp_idx++];
798 priv->dai_links[*link_idx].num_cpus = 1;
799 priv->dai_links[*link_idx].platforms = &compnent[comp_idx++];
800 priv->dai_links[*link_idx].num_platforms = 1;
801 priv->dai_links[*link_idx].codecs = &compnent[comp_idx];
802 priv->dai_links[*link_idx].num_codecs = 2;
803
804 priv->dai_links[*link_idx].name = "IVI 2xPCM3168A Capture";
805 priv->dai_links[*link_idx].stream_name = "IVI 2xPCM3168A Analog";
806 priv->dai_links[*link_idx].cpus->of_node = dai_node;
807 priv->dai_links[*link_idx].platforms->of_node = dai_node;
808 priv->dai_links[*link_idx].codecs[0].of_node = codeca_node;
809 priv->dai_links[*link_idx].codecs[0].dai_name = "pcm3168a-adc";
810 priv->dai_links[*link_idx].codecs[1].of_node = codecb_node;
811 priv->dai_links[*link_idx].codecs[1].dai_name = "pcm3168a-adc";
812 priv->dai_links[*link_idx].capture_only = 1;
813 priv->dai_links[*link_idx].id = J721E_AUDIO_DOMAIN_IVI;
814 priv->dai_links[*link_idx].dai_fmt = J721E_DAI_FMT;
815 priv->dai_links[*link_idx].init = j721e_audio_init;
816 priv->dai_links[*link_idx].ops = &j721e_audio_ops;
817 (*link_idx)++;
818
819 priv->codec_conf[*conf_idx].dlc.of_node = codeca_node;
820 priv->codec_conf[*conf_idx].name_prefix = "codec-a";
821 (*conf_idx)++;
822
823 priv->codec_conf[*conf_idx].dlc.of_node = codecb_node;
824 priv->codec_conf[*conf_idx].name_prefix = "codec-b";
825 (*conf_idx)++;
826
827 priv->codec_conf[*conf_idx].dlc.of_node = dai_node;
828 priv->codec_conf[*conf_idx].name_prefix = "McASP0";
829 (*conf_idx)++;
830
831 return 0;
832
833
834 put_codecb_node:
835 of_node_put(codecb_node);
836 put_codeca_node:
837 of_node_put(codeca_node);
838 put_dai_node:
839 of_node_put(dai_node);
840 return ret;
841 }
842
j721e_soc_probe(struct platform_device * pdev)843 static int j721e_soc_probe(struct platform_device *pdev)
844 {
845 struct device_node *node = pdev->dev.of_node;
846 struct snd_soc_card *card;
847 const struct of_device_id *match;
848 struct j721e_priv *priv;
849 int link_cnt, conf_cnt, ret, i;
850
851 if (!node) {
852 dev_err(&pdev->dev, "of node is missing.\n");
853 return -ENODEV;
854 }
855
856 match = of_match_node(j721e_audio_of_match, node);
857 if (!match) {
858 dev_err(&pdev->dev, "No compatible match found\n");
859 return -ENODEV;
860 }
861
862 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
863 if (!priv)
864 return -ENOMEM;
865
866 priv->match_data = match->data;
867
868 priv->dai_links = devm_kcalloc(&pdev->dev, priv->match_data->num_links,
869 sizeof(*priv->dai_links), GFP_KERNEL);
870 if (!priv->dai_links)
871 return -ENOMEM;
872
873 for (i = 0; i < J721E_AUDIO_DOMAIN_LAST; i++)
874 priv->audio_domains[i].parent_clk_id = -1;
875
876 priv->dev = &pdev->dev;
877 card = &priv->card;
878 card->dev = &pdev->dev;
879 card->owner = THIS_MODULE;
880 card->dapm_widgets = j721e_cpb_dapm_widgets;
881 card->num_dapm_widgets = ARRAY_SIZE(j721e_cpb_dapm_widgets);
882 card->dapm_routes = j721e_cpb_dapm_routes;
883 card->num_dapm_routes = ARRAY_SIZE(j721e_cpb_dapm_routes);
884 card->fully_routed = 1;
885
886 if (snd_soc_of_parse_card_name(card, "model")) {
887 dev_err(&pdev->dev, "Card name is not provided\n");
888 return -ENODEV;
889 }
890
891 link_cnt = 0;
892 conf_cnt = 0;
893 ret = j721e_soc_probe_cpb(priv, &link_cnt, &conf_cnt);
894 if (ret)
895 return ret;
896
897 ret = j721e_soc_probe_ivi(priv, &link_cnt, &conf_cnt);
898 if (ret)
899 return ret;
900
901 card->dai_link = priv->dai_links;
902 card->num_links = link_cnt;
903
904 card->codec_conf = priv->codec_conf;
905 card->num_configs = conf_cnt;
906
907 ret = j721e_calculate_rate_range(priv);
908 if (ret)
909 return ret;
910
911 snd_soc_card_set_drvdata(card, priv);
912
913 mutex_init(&priv->mutex);
914 ret = devm_snd_soc_register_card(&pdev->dev, card);
915 if (ret)
916 dev_err(&pdev->dev, "devm_snd_soc_register_card() failed: %d\n",
917 ret);
918
919 return ret;
920 }
921
922 static struct platform_driver j721e_soc_driver = {
923 .driver = {
924 .name = "j721e-audio",
925 .pm = &snd_soc_pm_ops,
926 .of_match_table = j721e_audio_of_match,
927 },
928 .probe = j721e_soc_probe,
929 };
930
931 module_platform_driver(j721e_soc_driver);
932
933 MODULE_AUTHOR("Peter Ujfalusi <peter.ujfalusi@ti.com>");
934 MODULE_DESCRIPTION("ASoC machine driver for j721e Common Processor Board");
935 MODULE_LICENSE("GPL v2");
936