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