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 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 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 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 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 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 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 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 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 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 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 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 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