sound/soc/ti/j721e-evm.c

   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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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");