| 1 | // SPDX-License-Identifier: GPL-2.0+ |
| 2 | // Copyright 2017-2021 NXP |
| 3 | |
| 4 | #include <linux/module.h> |
| 5 | #include <linux/init.h> |
| 6 | #include <linux/slab.h> |
| 7 | #include <linux/gpio/consumer.h> |
| 8 | #include <linux/of.h> |
| 9 | #include <linux/i2c.h> |
| 10 | #include <linux/clk.h> |
| 11 | #include <sound/soc.h> |
| 12 | #include <sound/pcm_params.h> |
| 13 | #include <sound/pcm.h> |
| 14 | #include <sound/soc-dapm.h> |
| 15 | #include <sound/simple_card_utils.h> |
| 16 | |
| 17 | #include "fsl_sai.h" |
| 18 | |
| 19 | #define IMX_CARD_MCLK_22P5792MHZ 22579200 |
| 20 | #define IMX_CARD_MCLK_24P576MHZ 24576000 |
| 21 | |
| 22 | enum codec_type { |
| 23 | CODEC_DUMMY = 0, |
| 24 | CODEC_AK5558 = 1, |
| 25 | CODEC_AK4458, |
| 26 | CODEC_AK4497, |
| 27 | CODEC_AK5552, |
| 28 | CODEC_CS42888, |
| 29 | CODEC_WM8524, |
| 30 | }; |
| 31 | |
| 32 | /* |
| 33 | * Mapping LRCK fs and frame width, table 3 & 4 in datasheet |
| 34 | * @rmin: min rate |
| 35 | * @rmax: max rate |
| 36 | * @wmin: min frame ratio |
| 37 | * @wmax: max frame ratio |
| 38 | */ |
| 39 | struct imx_akcodec_fs_mul { |
| 40 | unsigned int rmin; |
| 41 | unsigned int rmax; |
| 42 | unsigned int wmin; |
| 43 | unsigned int wmax; |
| 44 | }; |
| 45 | |
| 46 | /* |
| 47 | * Mapping TDM mode and frame width |
| 48 | */ |
| 49 | struct imx_akcodec_tdm_fs_mul { |
| 50 | unsigned int min; |
| 51 | unsigned int max; |
| 52 | unsigned int mul; |
| 53 | }; |
| 54 | |
| 55 | /* |
| 56 | * struct imx_card_plat_data - specific info for codecs |
| 57 | * |
| 58 | * @fs_mul: ratio of mclk/fs for normal mode |
| 59 | * @tdm_fs_mul: ratio of mclk/fs for tdm mode |
| 60 | * @support_rates: supported sample rate |
| 61 | * @support_tdm_rates: supported sample rate for tdm mode |
| 62 | * @support_channels: supported channels |
| 63 | * @support_tdm_channels: supported channels for tdm mode |
| 64 | * @num_fs_mul: ARRAY_SIZE of fs_mul |
| 65 | * @num_tdm_fs_mul: ARRAY_SIZE of tdm_fs_mul |
| 66 | * @num_rates: ARRAY_SIZE of support_rates |
| 67 | * @num_tdm_rates: ARRAY_SIZE of support_tdm_rates |
| 68 | * @num_channels: ARRAY_SIZE of support_channels |
| 69 | * @num_tdm_channels: ARRAY_SIZE of support_tdm_channels |
| 70 | * @type: codec type |
| 71 | */ |
| 72 | struct imx_card_plat_data { |
| 73 | struct imx_akcodec_fs_mul *fs_mul; |
| 74 | struct imx_akcodec_tdm_fs_mul *tdm_fs_mul; |
| 75 | const u32 *support_rates; |
| 76 | const u32 *support_tdm_rates; |
| 77 | const u32 *support_channels; |
| 78 | const u32 *support_tdm_channels; |
| 79 | unsigned int num_fs_mul; |
| 80 | unsigned int num_tdm_fs_mul; |
| 81 | unsigned int num_rates; |
| 82 | unsigned int num_tdm_rates; |
| 83 | unsigned int num_channels; |
| 84 | unsigned int num_tdm_channels; |
| 85 | unsigned int num_codecs; |
| 86 | enum codec_type type; |
| 87 | }; |
| 88 | |
| 89 | /* |
| 90 | * struct dai_link_data - specific info for dai link |
| 91 | * |
| 92 | * @slots: slot number |
| 93 | * @slot_width: slot width value |
| 94 | * @cpu_sysclk_id: sysclk id for cpu dai |
| 95 | * @one2one_ratio: true if mclk equal to bclk |
| 96 | */ |
| 97 | struct dai_link_data { |
| 98 | unsigned int slots; |
| 99 | unsigned int slot_width; |
| 100 | unsigned int cpu_sysclk_id; |
| 101 | bool one2one_ratio; |
| 102 | }; |
| 103 | |
| 104 | /* |
| 105 | * struct imx_card_data - platform device data |
| 106 | * |
| 107 | * @plat_data: pointer of imx_card_plat_data |
| 108 | * @dapm_routes: pointer of dapm_routes |
| 109 | * @link_data: private data for dai link |
| 110 | * @card: card instance |
| 111 | * @num_dapm_routes: number of dapm_routes |
| 112 | * @asrc_rate: asrc rates |
| 113 | * @asrc_format: asrc format |
| 114 | */ |
| 115 | struct imx_card_data { |
| 116 | struct imx_card_plat_data *plat_data; |
| 117 | struct snd_soc_dapm_route *dapm_routes; |
| 118 | struct dai_link_data *link_data; |
| 119 | struct snd_soc_card card; |
| 120 | int num_dapm_routes; |
| 121 | u32 asrc_rate; |
| 122 | snd_pcm_format_t asrc_format; |
| 123 | }; |
| 124 | |
| 125 | static struct imx_akcodec_fs_mul ak4458_fs_mul[] = { |
| 126 | /* Normal, < 32kHz */ |
| 127 | { .rmin = 8000, .rmax = 24000, .wmin = 256, .wmax = 1024, }, |
| 128 | /* Normal, 32kHz */ |
| 129 | { .rmin = 32000, .rmax = 32000, .wmin = 256, .wmax = 1024, }, |
| 130 | /* Normal */ |
| 131 | { .rmin = 44100, .rmax = 48000, .wmin = 256, .wmax = 768, }, |
| 132 | /* Double */ |
| 133 | { .rmin = 88200, .rmax = 96000, .wmin = 256, .wmax = 512, }, |
| 134 | /* Quad */ |
| 135 | { .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 256, }, |
| 136 | /* Oct */ |
| 137 | { .rmin = 352800, .rmax = 384000, .wmin = 32, .wmax = 128, }, |
| 138 | /* Hex */ |
| 139 | { .rmin = 705600, .rmax = 768000, .wmin = 16, .wmax = 64, }, |
| 140 | }; |
| 141 | |
| 142 | static struct imx_akcodec_tdm_fs_mul ak4458_tdm_fs_mul[] = { |
| 143 | /* |
| 144 | * Table 13 - Audio Interface Format |
| 145 | * For TDM mode, MCLK should is set to |
| 146 | * obtained from 2 * slots * slot_width |
| 147 | */ |
| 148 | { .min = 128, .max = 128, .mul = 256 }, /* TDM128 */ |
| 149 | { .min = 256, .max = 256, .mul = 512 }, /* TDM256 */ |
| 150 | { .min = 512, .max = 512, .mul = 1024 }, /* TDM512 */ |
| 151 | }; |
| 152 | |
| 153 | static struct imx_akcodec_fs_mul ak4497_fs_mul[] = { |
| 154 | /** |
| 155 | * Table 7 - mapping multiplier and speed mode |
| 156 | * Tables 8 & 9 - mapping speed mode and LRCK fs |
| 157 | */ |
| 158 | { .rmin = 8000, .rmax = 32000, .wmin = 256, .wmax = 1024, }, /* Normal, <= 32kHz */ |
| 159 | { .rmin = 44100, .rmax = 48000, .wmin = 256, .wmax = 512, }, /* Normal */ |
| 160 | { .rmin = 88200, .rmax = 96000, .wmin = 256, .wmax = 256, }, /* Double */ |
| 161 | { .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 128, }, /* Quad */ |
| 162 | { .rmin = 352800, .rmax = 384000, .wmin = 128, .wmax = 128, }, /* Oct */ |
| 163 | { .rmin = 705600, .rmax = 768000, .wmin = 64, .wmax = 64, }, /* Hex */ |
| 164 | }; |
| 165 | |
| 166 | /* |
| 167 | * Auto MCLK selection based on LRCK for Normal Mode |
| 168 | * (Table 4 from datasheet) |
| 169 | */ |
| 170 | static struct imx_akcodec_fs_mul ak5558_fs_mul[] = { |
| 171 | { .rmin = 8000, .rmax = 32000, .wmin = 512, .wmax = 1024, }, |
| 172 | { .rmin = 44100, .rmax = 48000, .wmin = 512, .wmax = 512, }, |
| 173 | { .rmin = 88200, .rmax = 96000, .wmin = 256, .wmax = 256, }, |
| 174 | { .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 128, }, |
| 175 | { .rmin = 352800, .rmax = 384000, .wmin = 64, .wmax = 64, }, |
| 176 | { .rmin = 705600, .rmax = 768000, .wmin = 32, .wmax = 32, }, |
| 177 | }; |
| 178 | |
| 179 | /* |
| 180 | * MCLK and BCLK selection based on TDM mode |
| 181 | * because of SAI we also add the restriction: MCLK >= 2 * BCLK |
| 182 | * (Table 9 from datasheet) |
| 183 | */ |
| 184 | static struct imx_akcodec_tdm_fs_mul ak5558_tdm_fs_mul[] = { |
| 185 | { .min = 128, .max = 128, .mul = 256 }, |
| 186 | { .min = 256, .max = 256, .mul = 512 }, |
| 187 | { .min = 512, .max = 512, .mul = 1024 }, |
| 188 | }; |
| 189 | |
| 190 | static struct imx_akcodec_fs_mul cs42888_fs_mul[] = { |
| 191 | { .rmin = 8000, .rmax = 48000, .wmin = 256, .wmax = 1024, }, |
| 192 | { .rmin = 64000, .rmax = 96000, .wmin = 128, .wmax = 512, }, |
| 193 | { .rmin = 176400, .rmax = 192000, .wmin = 64, .wmax = 256, }, |
| 194 | }; |
| 195 | |
| 196 | static struct imx_akcodec_tdm_fs_mul cs42888_tdm_fs_mul[] = { |
| 197 | { .min = 256, .max = 256, .mul = 256 }, |
| 198 | }; |
| 199 | |
| 200 | static struct imx_akcodec_fs_mul wm8524_fs_mul[] = { |
| 201 | { .rmin = 8000, .rmax = 32000, .wmin = 256, .wmax = 1152, }, |
| 202 | { .rmin = 44100, .rmax = 48000, .wmin = 256, .wmax = 768, }, |
| 203 | { .rmin = 88200, .rmax = 96000, .wmin = 128, .wmax = 384, }, |
| 204 | { .rmin = 176400, .rmax = 192000, .wmin = 128, .wmax = 192, }, |
| 205 | }; |
| 206 | |
| 207 | static const u32 akcodec_rates[] = { |
| 208 | 8000, 11025, 16000, 22050, 32000, 44100, 48000, 88200, |
| 209 | 96000, 176400, 192000, 352800, 384000, 705600, 768000, |
| 210 | }; |
| 211 | |
| 212 | static const u32 akcodec_tdm_rates[] = { |
| 213 | 8000, 16000, 32000, 48000, 96000, |
| 214 | }; |
| 215 | |
| 216 | static const u32 ak4458_channels[] = { |
| 217 | 1, 2, 4, 6, 8, 10, 12, 14, 16, |
| 218 | }; |
| 219 | |
| 220 | static const u32 ak4458_tdm_channels[] = { |
| 221 | 1, 2, 3, 4, 5, 6, 7, 8, 16, |
| 222 | }; |
| 223 | |
| 224 | static const u32 ak5558_channels[] = { |
| 225 | 1, 2, 4, 6, 8, |
| 226 | }; |
| 227 | |
| 228 | static const u32 ak5558_tdm_channels[] = { |
| 229 | 1, 2, 3, 4, 5, 6, 7, 8, |
| 230 | }; |
| 231 | |
| 232 | static const u32 cs42888_channels[] = { |
| 233 | 1, 2, 4, 6, 8, |
| 234 | }; |
| 235 | |
| 236 | static const u32 cs42888_tdm_channels[] = { |
| 237 | 1, 2, 3, 4, 5, 6, 7, 8, |
| 238 | }; |
| 239 | |
| 240 | static const u32 wm8524_channels[] = { |
| 241 | 2, |
| 242 | }; |
| 243 | |
| 244 | static bool format_is_dsd(struct snd_pcm_hw_params *params) |
| 245 | { |
| 246 | snd_pcm_format_t format = params_format(p: params); |
| 247 | |
| 248 | switch (format) { |
| 249 | case SNDRV_PCM_FORMAT_DSD_U8: |
| 250 | case SNDRV_PCM_FORMAT_DSD_U16_LE: |
| 251 | case SNDRV_PCM_FORMAT_DSD_U16_BE: |
| 252 | case SNDRV_PCM_FORMAT_DSD_U32_LE: |
| 253 | case SNDRV_PCM_FORMAT_DSD_U32_BE: |
| 254 | return true; |
| 255 | default: |
| 256 | return false; |
| 257 | } |
| 258 | } |
| 259 | |
| 260 | static bool format_is_tdm(struct dai_link_data *link_data) |
| 261 | { |
| 262 | if (link_data->slots > 2) |
| 263 | return true; |
| 264 | else |
| 265 | return false; |
| 266 | } |
| 267 | |
| 268 | static bool codec_is_akcodec(unsigned int type) |
| 269 | { |
| 270 | switch (type) { |
| 271 | case CODEC_AK4458: |
| 272 | case CODEC_AK4497: |
| 273 | case CODEC_AK5558: |
| 274 | case CODEC_AK5552: |
| 275 | case CODEC_CS42888: |
| 276 | case CODEC_WM8524: |
| 277 | return true; |
| 278 | default: |
| 279 | break; |
| 280 | } |
| 281 | return false; |
| 282 | } |
| 283 | |
| 284 | static unsigned long akcodec_get_mclk_rate(struct snd_pcm_substream *substream, |
| 285 | struct snd_pcm_hw_params *params, |
| 286 | int slots, int slot_width) |
| 287 | { |
| 288 | struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); |
| 289 | struct imx_card_data *data = snd_soc_card_get_drvdata(card: rtd->card); |
| 290 | const struct imx_card_plat_data *plat_data = data->plat_data; |
| 291 | struct dai_link_data *link_data = &data->link_data[rtd->id]; |
| 292 | unsigned int width = slots * slot_width; |
| 293 | unsigned int rate = params_rate(p: params); |
| 294 | int i; |
| 295 | |
| 296 | if (format_is_tdm(link_data)) { |
| 297 | for (i = 0; i < plat_data->num_tdm_fs_mul; i++) { |
| 298 | /* min = max = slots * slots_width */ |
| 299 | if (width != plat_data->tdm_fs_mul[i].min) |
| 300 | continue; |
| 301 | return rate * plat_data->tdm_fs_mul[i].mul; |
| 302 | } |
| 303 | } else { |
| 304 | for (i = 0; i < plat_data->num_fs_mul; i++) { |
| 305 | if (rate >= plat_data->fs_mul[i].rmin && |
| 306 | rate <= plat_data->fs_mul[i].rmax) { |
| 307 | width = max(width, plat_data->fs_mul[i].wmin); |
| 308 | width = min(width, plat_data->fs_mul[i].wmax); |
| 309 | |
| 310 | /* Adjust SAI bclk:mclk ratio */ |
| 311 | width *= link_data->one2one_ratio ? 1 : 2; |
| 312 | |
| 313 | return rate * width; |
| 314 | } |
| 315 | } |
| 316 | } |
| 317 | |
| 318 | /* Let DAI manage clk frequency by default */ |
| 319 | return 0; |
| 320 | } |
| 321 | |
| 322 | static int imx_aif_hw_params(struct snd_pcm_substream *substream, |
| 323 | struct snd_pcm_hw_params *params) |
| 324 | { |
| 325 | struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); |
| 326 | struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0); |
| 327 | struct snd_soc_card *card = rtd->card; |
| 328 | struct imx_card_data *data = snd_soc_card_get_drvdata(card); |
| 329 | struct dai_link_data *link_data = &data->link_data[rtd->id]; |
| 330 | struct imx_card_plat_data *plat_data = data->plat_data; |
| 331 | struct device *dev = card->dev; |
| 332 | struct snd_soc_dai *codec_dai; |
| 333 | unsigned long mclk_freq; |
| 334 | unsigned int fmt = rtd->dai_link->dai_fmt; |
| 335 | unsigned int slots, slot_width; |
| 336 | int ret, i; |
| 337 | |
| 338 | slots = link_data->slots; |
| 339 | slot_width = link_data->slot_width; |
| 340 | |
| 341 | if (!format_is_tdm(link_data)) { |
| 342 | if (format_is_dsd(params)) { |
| 343 | slots = 1; |
| 344 | slot_width = params_width(p: params); |
| 345 | fmt = (rtd->dai_link->dai_fmt & ~SND_SOC_DAIFMT_FORMAT_MASK) | |
| 346 | SND_SOC_DAIFMT_PDM; |
| 347 | } else { |
| 348 | slots = 2; |
| 349 | fmt = (rtd->dai_link->dai_fmt & ~SND_SOC_DAIFMT_FORMAT_MASK) | |
| 350 | SND_SOC_DAIFMT_I2S; |
| 351 | } |
| 352 | } |
| 353 | |
| 354 | ret = snd_soc_dai_set_fmt(dai: cpu_dai, fmt: snd_soc_daifmt_clock_provider_flipped(dai_fmt: fmt)); |
| 355 | if (ret && ret != -ENOTSUPP) { |
| 356 | dev_err(dev, "failed to set cpu dai fmt: %d\n" , ret); |
| 357 | return ret; |
| 358 | } |
| 359 | ret = snd_soc_dai_set_tdm_slot(dai: cpu_dai, |
| 360 | BIT(slots) - 1, |
| 361 | BIT(slots) - 1, |
| 362 | slots, slot_width); |
| 363 | if (ret && ret != -ENOTSUPP) { |
| 364 | dev_err(dev, "failed to set cpu dai tdm slot: %d\n" , ret); |
| 365 | return ret; |
| 366 | } |
| 367 | |
| 368 | for_each_rtd_codec_dais(rtd, i, codec_dai) { |
| 369 | ret = snd_soc_dai_set_fmt(dai: codec_dai, fmt); |
| 370 | if (ret && ret != -ENOTSUPP) { |
| 371 | dev_err(dev, "failed to set codec dai[%d] fmt: %d\n" , i, ret); |
| 372 | return ret; |
| 373 | } |
| 374 | |
| 375 | if (format_is_tdm(link_data)) { |
| 376 | ret = snd_soc_dai_set_tdm_slot(dai: codec_dai, |
| 377 | BIT(slots) - 1, |
| 378 | BIT(slots) - 1, |
| 379 | slots, slot_width); |
| 380 | if (ret && ret != -ENOTSUPP) { |
| 381 | dev_err(dev, "failed to set codec dai[%d] tdm slot: %d\n" , i, ret); |
| 382 | return ret; |
| 383 | } |
| 384 | } |
| 385 | } |
| 386 | |
| 387 | /* Set MCLK freq */ |
| 388 | if (codec_is_akcodec(type: plat_data->type)) |
| 389 | mclk_freq = akcodec_get_mclk_rate(substream, params, slots, slot_width); |
| 390 | else |
| 391 | mclk_freq = params_rate(p: params) * slots * slot_width; |
| 392 | |
| 393 | if (format_is_dsd(params)) { |
| 394 | /* Use the maximum freq from DSD512 (512*44100 = 22579200) */ |
| 395 | if (!(params_rate(p: params) % 11025)) |
| 396 | mclk_freq = IMX_CARD_MCLK_22P5792MHZ; |
| 397 | else |
| 398 | mclk_freq = IMX_CARD_MCLK_24P576MHZ; |
| 399 | } |
| 400 | |
| 401 | ret = snd_soc_dai_set_sysclk(dai: cpu_dai, clk_id: link_data->cpu_sysclk_id, freq: mclk_freq, |
| 402 | SND_SOC_CLOCK_OUT); |
| 403 | if (ret && ret != -ENOTSUPP) { |
| 404 | dev_err(dev, "failed to set cpui dai mclk1 rate (%lu): %d\n" , mclk_freq, ret); |
| 405 | return ret; |
| 406 | } |
| 407 | ret = snd_soc_dai_set_sysclk(dai: codec_dai, clk_id: 0, freq: mclk_freq, SND_SOC_CLOCK_IN); |
| 408 | if (ret && ret != -ENOTSUPP) { |
| 409 | dev_err(dev, "failed to set codec dai mclk rate (%lu): %d\n" , mclk_freq, ret); |
| 410 | return ret; |
| 411 | } |
| 412 | |
| 413 | return 0; |
| 414 | } |
| 415 | |
| 416 | static int ak5558_hw_rule_rate(struct snd_pcm_hw_params *p, struct snd_pcm_hw_rule *r) |
| 417 | { |
| 418 | struct dai_link_data *link_data = r->private; |
| 419 | struct snd_interval t = { .min = 8000, .max = 8000, }; |
| 420 | unsigned long mclk_freq; |
| 421 | unsigned int fs; |
| 422 | int i; |
| 423 | |
| 424 | fs = hw_param_interval(params: p, SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min; |
| 425 | fs *= link_data->slots; |
| 426 | |
| 427 | /* Identify maximum supported rate */ |
| 428 | for (i = 0; i < ARRAY_SIZE(akcodec_rates); i++) { |
| 429 | mclk_freq = fs * akcodec_rates[i]; |
| 430 | /* Adjust SAI bclk:mclk ratio */ |
| 431 | mclk_freq *= link_data->one2one_ratio ? 1 : 2; |
| 432 | |
| 433 | /* Skip rates for which MCLK is beyond supported value */ |
| 434 | if (mclk_freq > 36864000) |
| 435 | continue; |
| 436 | |
| 437 | if (t.max < akcodec_rates[i]) |
| 438 | t.max = akcodec_rates[i]; |
| 439 | } |
| 440 | |
| 441 | return snd_interval_refine(i: hw_param_interval(params: p, var: r->var), v: &t); |
| 442 | } |
| 443 | |
| 444 | static int imx_aif_startup(struct snd_pcm_substream *substream) |
| 445 | { |
| 446 | struct snd_pcm_runtime *runtime = substream->runtime; |
| 447 | struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); |
| 448 | struct snd_soc_card *card = rtd->card; |
| 449 | struct imx_card_data *data = snd_soc_card_get_drvdata(card); |
| 450 | struct dai_link_data *link_data = &data->link_data[rtd->id]; |
| 451 | static struct snd_pcm_hw_constraint_list constraint_rates; |
| 452 | static struct snd_pcm_hw_constraint_list constraint_channels; |
| 453 | int ret = 0; |
| 454 | |
| 455 | if (format_is_tdm(link_data)) { |
| 456 | constraint_channels.list = data->plat_data->support_tdm_channels; |
| 457 | constraint_channels.count = data->plat_data->num_tdm_channels; |
| 458 | constraint_rates.list = data->plat_data->support_tdm_rates; |
| 459 | constraint_rates.count = data->plat_data->num_tdm_rates; |
| 460 | } else { |
| 461 | constraint_channels.list = data->plat_data->support_channels; |
| 462 | constraint_channels.count = data->plat_data->num_channels; |
| 463 | constraint_rates.list = data->plat_data->support_rates; |
| 464 | constraint_rates.count = data->plat_data->num_rates; |
| 465 | } |
| 466 | |
| 467 | if (constraint_channels.count) { |
| 468 | ret = snd_pcm_hw_constraint_list(runtime, cond: 0, |
| 469 | SNDRV_PCM_HW_PARAM_CHANNELS, |
| 470 | l: &constraint_channels); |
| 471 | if (ret) |
| 472 | return ret; |
| 473 | } |
| 474 | |
| 475 | if (constraint_rates.count) { |
| 476 | ret = snd_pcm_hw_constraint_list(runtime, cond: 0, |
| 477 | SNDRV_PCM_HW_PARAM_RATE, |
| 478 | l: &constraint_rates); |
| 479 | if (ret) |
| 480 | return ret; |
| 481 | } |
| 482 | |
| 483 | if (data->plat_data->type == CODEC_AK5558) |
| 484 | ret = snd_pcm_hw_rule_add(runtime: substream->runtime, cond: 0, |
| 485 | SNDRV_PCM_HW_PARAM_RATE, |
| 486 | func: ak5558_hw_rule_rate, private: link_data, |
| 487 | SNDRV_PCM_HW_PARAM_SAMPLE_BITS, -1); |
| 488 | |
| 489 | return ret; |
| 490 | } |
| 491 | |
| 492 | static void imx_aif_shutdown(struct snd_pcm_substream *substream) |
| 493 | { |
| 494 | struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); |
| 495 | struct snd_soc_dai *cpu_dai; |
| 496 | struct snd_soc_dai *codec_dai; |
| 497 | int i; |
| 498 | |
| 499 | for_each_rtd_cpu_dais(rtd, i, cpu_dai) |
| 500 | snd_soc_dai_set_sysclk(dai: cpu_dai, clk_id: 0, freq: 0, SND_SOC_CLOCK_OUT); |
| 501 | |
| 502 | for_each_rtd_codec_dais(rtd, i, codec_dai) |
| 503 | snd_soc_dai_set_sysclk(dai: codec_dai, clk_id: 0, freq: 0, SND_SOC_CLOCK_IN); |
| 504 | } |
| 505 | |
| 506 | static const struct snd_soc_ops imx_aif_ops = { |
| 507 | .hw_params = imx_aif_hw_params, |
| 508 | .startup = imx_aif_startup, |
| 509 | .shutdown = imx_aif_shutdown, |
| 510 | }; |
| 511 | |
| 512 | static const struct snd_soc_ops imx_aif_ops_be = { |
| 513 | .hw_params = imx_aif_hw_params, |
| 514 | }; |
| 515 | |
| 516 | static int be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd, |
| 517 | struct snd_pcm_hw_params *params) |
| 518 | { |
| 519 | struct snd_soc_card *card = rtd->card; |
| 520 | struct imx_card_data *data = snd_soc_card_get_drvdata(card); |
| 521 | struct snd_interval *rate; |
| 522 | struct snd_mask *mask; |
| 523 | |
| 524 | rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); |
| 525 | rate->max = data->asrc_rate; |
| 526 | rate->min = data->asrc_rate; |
| 527 | |
| 528 | mask = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT); |
| 529 | snd_mask_none(mask); |
| 530 | snd_mask_set(mask, val: (__force unsigned int)data->asrc_format); |
| 531 | |
| 532 | return 0; |
| 533 | } |
| 534 | |
| 535 | static int imx_card_parse_of(struct imx_card_data *data) |
| 536 | { |
| 537 | struct imx_card_plat_data *plat_data = data->plat_data; |
| 538 | struct snd_soc_card *card = &data->card; |
| 539 | struct snd_soc_dai_link_component *dlc; |
| 540 | struct device_node *platform = NULL; |
| 541 | struct device_node *codec = NULL; |
| 542 | struct device_node *cpu = NULL; |
| 543 | struct device *dev = card->dev; |
| 544 | struct snd_soc_dai_link *link; |
| 545 | struct dai_link_data *link_data; |
| 546 | struct of_phandle_args args; |
| 547 | bool playback_only, capture_only; |
| 548 | int ret, num_links; |
| 549 | u32 asrc_fmt = 0; |
| 550 | u32 width; |
| 551 | |
| 552 | ret = snd_soc_of_parse_card_name(card, propname: "model" ); |
| 553 | if (ret) { |
| 554 | dev_err(dev, "Error parsing card name: %d\n" , ret); |
| 555 | return ret; |
| 556 | } |
| 557 | |
| 558 | /* DAPM routes */ |
| 559 | if (of_property_present(np: dev->of_node, propname: "audio-routing" )) { |
| 560 | ret = snd_soc_of_parse_audio_routing(card, propname: "audio-routing" ); |
| 561 | if (ret) |
| 562 | return ret; |
| 563 | } |
| 564 | |
| 565 | /* Populate links */ |
| 566 | num_links = of_get_child_count(np: dev->of_node); |
| 567 | |
| 568 | /* Allocate the DAI link array */ |
| 569 | card->dai_link = devm_kcalloc(dev, n: num_links, size: sizeof(*link), GFP_KERNEL); |
| 570 | if (!card->dai_link) |
| 571 | return -ENOMEM; |
| 572 | |
| 573 | data->link_data = devm_kcalloc(dev, n: num_links, size: sizeof(*link_data), GFP_KERNEL); |
| 574 | if (!data->link_data) |
| 575 | return -ENOMEM; |
| 576 | |
| 577 | card->num_links = num_links; |
| 578 | link = card->dai_link; |
| 579 | link_data = data->link_data; |
| 580 | |
| 581 | for_each_child_of_node_scoped(dev->of_node, np) { |
| 582 | dlc = devm_kzalloc(dev, size: 2 * sizeof(*dlc), GFP_KERNEL); |
| 583 | if (!dlc) { |
| 584 | return -ENOMEM; |
| 585 | } |
| 586 | |
| 587 | link->cpus = &dlc[0]; |
| 588 | link->platforms = &dlc[1]; |
| 589 | |
| 590 | link->num_cpus = 1; |
| 591 | link->num_platforms = 1; |
| 592 | |
| 593 | ret = of_property_read_string(np, propname: "link-name" , out_string: &link->name); |
| 594 | if (ret) { |
| 595 | return dev_err_probe(dev: card->dev, err: ret, |
| 596 | fmt: "error getting codec dai_link name\n" ); |
| 597 | } |
| 598 | |
| 599 | cpu = of_get_child_by_name(node: np, name: "cpu" ); |
| 600 | if (!cpu) { |
| 601 | dev_err(dev, "%s: Can't find cpu DT node\n" , link->name); |
| 602 | ret = -EINVAL; |
| 603 | goto err; |
| 604 | } |
| 605 | |
| 606 | ret = snd_soc_of_get_dlc(of_node: cpu, args: &args, dlc: link->cpus, index: 0); |
| 607 | if (ret) { |
| 608 | dev_err_probe(dev: card->dev, err: ret, |
| 609 | fmt: "%s: error getting cpu dai info\n" , link->name); |
| 610 | goto err; |
| 611 | } |
| 612 | |
| 613 | if (of_node_name_eq(np: args.np, name: "sai" )) { |
| 614 | /* sai sysclk id */ |
| 615 | link_data->cpu_sysclk_id = FSL_SAI_CLK_MAST1; |
| 616 | |
| 617 | /* sai may support mclk/bclk = 1 */ |
| 618 | if (of_property_read_bool(np, propname: "fsl,mclk-equal-bclk" )) { |
| 619 | link_data->one2one_ratio = true; |
| 620 | } else { |
| 621 | int i; |
| 622 | |
| 623 | /* |
| 624 | * i.MX8MQ don't support one2one ratio, then |
| 625 | * with ak4497 only 16bit case is supported. |
| 626 | */ |
| 627 | for (i = 0; i < ARRAY_SIZE(ak4497_fs_mul); i++) { |
| 628 | if (ak4497_fs_mul[i].rmin == 705600 && |
| 629 | ak4497_fs_mul[i].rmax == 768000) { |
| 630 | ak4497_fs_mul[i].wmin = 32; |
| 631 | ak4497_fs_mul[i].wmax = 32; |
| 632 | } |
| 633 | } |
| 634 | } |
| 635 | } |
| 636 | |
| 637 | link->platforms->of_node = link->cpus->of_node; |
| 638 | link->id = args.args[0]; |
| 639 | |
| 640 | codec = of_get_child_by_name(node: np, name: "codec" ); |
| 641 | if (codec) { |
| 642 | ret = snd_soc_of_get_dai_link_codecs(dev, of_node: codec, dai_link: link); |
| 643 | if (ret < 0) { |
| 644 | dev_err_probe(dev, err: ret, fmt: "%s: codec dai not found\n" , |
| 645 | link->name); |
| 646 | goto err; |
| 647 | } |
| 648 | |
| 649 | plat_data->num_codecs = link->num_codecs; |
| 650 | |
| 651 | /* Check the akcodec type */ |
| 652 | if (!strcmp(link->codecs->dai_name, "ak4458-aif" )) |
| 653 | plat_data->type = CODEC_AK4458; |
| 654 | else if (!strcmp(link->codecs->dai_name, "ak4497-aif" )) |
| 655 | plat_data->type = CODEC_AK4497; |
| 656 | else if (!strcmp(link->codecs->dai_name, "ak5558-aif" )) |
| 657 | plat_data->type = CODEC_AK5558; |
| 658 | else if (!strcmp(link->codecs->dai_name, "ak5552-aif" )) |
| 659 | plat_data->type = CODEC_AK5552; |
| 660 | else if (!strcmp(link->codecs->dai_name, "cs42888" )) |
| 661 | plat_data->type = CODEC_CS42888; |
| 662 | else if (!strcmp(link->codecs->dai_name, "wm8524-hifi" )) |
| 663 | plat_data->type = CODEC_WM8524; |
| 664 | |
| 665 | } else { |
| 666 | link->codecs = &snd_soc_dummy_dlc; |
| 667 | link->num_codecs = 1; |
| 668 | } |
| 669 | |
| 670 | if (!strncmp(link->name, "HiFi-ASRC-FE" , 12)) { |
| 671 | /* DPCM frontend */ |
| 672 | link->dynamic = 1; |
| 673 | link->dpcm_merged_chan = 1; |
| 674 | |
| 675 | ret = of_property_read_u32(np: args.np, propname: "fsl,asrc-rate" , out_value: &data->asrc_rate); |
| 676 | if (ret) { |
| 677 | dev_err(dev, "failed to get output rate\n" ); |
| 678 | ret = -EINVAL; |
| 679 | goto err; |
| 680 | } |
| 681 | |
| 682 | ret = of_property_read_u32(np: args.np, propname: "fsl,asrc-format" , out_value: &asrc_fmt); |
| 683 | data->asrc_format = (__force snd_pcm_format_t)asrc_fmt; |
| 684 | if (ret) { |
| 685 | /* Fallback to old binding; translate to asrc_format */ |
| 686 | ret = of_property_read_u32(np: args.np, propname: "fsl,asrc-width" , out_value: &width); |
| 687 | if (ret) { |
| 688 | dev_err(dev, |
| 689 | "failed to decide output format\n" ); |
| 690 | goto err; |
| 691 | } |
| 692 | |
| 693 | if (width == 24) |
| 694 | data->asrc_format = SNDRV_PCM_FORMAT_S24_LE; |
| 695 | else |
| 696 | data->asrc_format = SNDRV_PCM_FORMAT_S16_LE; |
| 697 | } |
| 698 | } else if (!strncmp(link->name, "HiFi-ASRC-BE" , 12)) { |
| 699 | /* DPCM backend */ |
| 700 | /* |
| 701 | * No need to have link->platforms. alloced dlc[1] will be just wasted, |
| 702 | * but it won't leak. |
| 703 | */ |
| 704 | link->no_pcm = 1; |
| 705 | link->platforms = NULL; |
| 706 | |
| 707 | link->be_hw_params_fixup = be_hw_params_fixup; |
| 708 | link->ops = &imx_aif_ops_be; |
| 709 | } else { |
| 710 | link->ops = &imx_aif_ops; |
| 711 | } |
| 712 | |
| 713 | graph_util_parse_link_direction(np, is_playback_only: &playback_only, is_capture_only: &capture_only); |
| 714 | link->playback_only = playback_only; |
| 715 | link->capture_only = capture_only; |
| 716 | |
| 717 | /* Get dai fmt */ |
| 718 | ret = simple_util_parse_daifmt(dev, node: np, codec, |
| 719 | NULL, retfmt: &link->dai_fmt); |
| 720 | if (ret) |
| 721 | link->dai_fmt = SND_SOC_DAIFMT_NB_NF | |
| 722 | SND_SOC_DAIFMT_CBC_CFC | |
| 723 | SND_SOC_DAIFMT_I2S; |
| 724 | |
| 725 | /* Get tdm slot */ |
| 726 | snd_soc_of_parse_tdm_slot(np, NULL, NULL, |
| 727 | slots: &link_data->slots, |
| 728 | slot_width: &link_data->slot_width); |
| 729 | /* default value */ |
| 730 | if (!link_data->slots) |
| 731 | link_data->slots = 2; |
| 732 | |
| 733 | if (!link_data->slot_width) |
| 734 | link_data->slot_width = 32; |
| 735 | |
| 736 | link->ignore_pmdown_time = 1; |
| 737 | link->stream_name = link->name; |
| 738 | link++; |
| 739 | link_data++; |
| 740 | |
| 741 | of_node_put(node: cpu); |
| 742 | of_node_put(node: codec); |
| 743 | of_node_put(node: platform); |
| 744 | |
| 745 | cpu = NULL; |
| 746 | codec = NULL; |
| 747 | platform = NULL; |
| 748 | } |
| 749 | |
| 750 | return 0; |
| 751 | err: |
| 752 | of_node_put(node: cpu); |
| 753 | of_node_put(node: codec); |
| 754 | of_node_put(node: platform); |
| 755 | |
| 756 | return ret; |
| 757 | } |
| 758 | |
| 759 | static int imx_card_probe(struct platform_device *pdev) |
| 760 | { |
| 761 | struct snd_soc_dai_link *link_be = NULL, *link; |
| 762 | struct imx_card_plat_data *plat_data; |
| 763 | struct imx_card_data *data; |
| 764 | int ret, i; |
| 765 | |
| 766 | data = devm_kzalloc(dev: &pdev->dev, size: sizeof(*data), GFP_KERNEL); |
| 767 | if (!data) |
| 768 | return -ENOMEM; |
| 769 | |
| 770 | plat_data = devm_kzalloc(dev: &pdev->dev, size: sizeof(*plat_data), GFP_KERNEL); |
| 771 | if (!plat_data) |
| 772 | return -ENOMEM; |
| 773 | |
| 774 | data->plat_data = plat_data; |
| 775 | data->card.dev = &pdev->dev; |
| 776 | data->card.owner = THIS_MODULE; |
| 777 | |
| 778 | dev_set_drvdata(dev: &pdev->dev, data: &data->card); |
| 779 | snd_soc_card_set_drvdata(card: &data->card, data); |
| 780 | ret = imx_card_parse_of(data); |
| 781 | if (ret) |
| 782 | return ret; |
| 783 | |
| 784 | data->num_dapm_routes = plat_data->num_codecs + 1; |
| 785 | data->dapm_routes = devm_kcalloc(dev: &pdev->dev, n: data->num_dapm_routes, |
| 786 | size: sizeof(struct snd_soc_dapm_route), |
| 787 | GFP_KERNEL); |
| 788 | if (!data->dapm_routes) |
| 789 | return -ENOMEM; |
| 790 | |
| 791 | /* configure the dapm routes */ |
| 792 | switch (plat_data->type) { |
| 793 | case CODEC_AK4458: |
| 794 | case CODEC_AK4497: |
| 795 | if (plat_data->num_codecs == 1) { |
| 796 | data->dapm_routes[0].sink = "Playback" ; |
| 797 | data->dapm_routes[0].source = "CPU-Playback" ; |
| 798 | i = 1; |
| 799 | } else { |
| 800 | for (i = 0; i < plat_data->num_codecs; i++) { |
| 801 | data->dapm_routes[i].sink = |
| 802 | devm_kasprintf(dev: &pdev->dev, GFP_KERNEL, fmt: "%d %s" , |
| 803 | i + 1, "Playback" ); |
| 804 | if (!data->dapm_routes[i].sink) |
| 805 | return -ENOMEM; |
| 806 | data->dapm_routes[i].source = "CPU-Playback" ; |
| 807 | } |
| 808 | } |
| 809 | data->dapm_routes[i].sink = "CPU-Playback" ; |
| 810 | data->dapm_routes[i].source = "ASRC-Playback" ; |
| 811 | break; |
| 812 | case CODEC_AK5558: |
| 813 | case CODEC_AK5552: |
| 814 | if (plat_data->num_codecs == 1) { |
| 815 | data->dapm_routes[0].sink = "CPU-Capture" ; |
| 816 | data->dapm_routes[0].source = "Capture" ; |
| 817 | i = 1; |
| 818 | } else { |
| 819 | for (i = 0; i < plat_data->num_codecs; i++) { |
| 820 | data->dapm_routes[i].source = |
| 821 | devm_kasprintf(dev: &pdev->dev, GFP_KERNEL, fmt: "%d %s" , |
| 822 | i + 1, "Capture" ); |
| 823 | if (!data->dapm_routes[i].source) |
| 824 | return -ENOMEM; |
| 825 | data->dapm_routes[i].sink = "CPU-Capture" ; |
| 826 | } |
| 827 | } |
| 828 | data->dapm_routes[i].sink = "ASRC-Capture" ; |
| 829 | data->dapm_routes[i].source = "CPU-Capture" ; |
| 830 | break; |
| 831 | case CODEC_CS42888: |
| 832 | data->dapm_routes[0].sink = "Playback" ; |
| 833 | data->dapm_routes[0].source = "CPU-Playback" ; |
| 834 | data->dapm_routes[1].sink = "CPU-Capture" ; |
| 835 | data->dapm_routes[1].source = "Capture" ; |
| 836 | break; |
| 837 | case CODEC_WM8524: |
| 838 | data->dapm_routes[0].sink = "Playback" ; |
| 839 | data->dapm_routes[0].source = "CPU-Playback" ; |
| 840 | break; |
| 841 | default: |
| 842 | break; |
| 843 | } |
| 844 | |
| 845 | /* default platform data for akcodecs */ |
| 846 | if (codec_is_akcodec(type: plat_data->type)) { |
| 847 | plat_data->support_rates = akcodec_rates; |
| 848 | plat_data->num_rates = ARRAY_SIZE(akcodec_rates); |
| 849 | plat_data->support_tdm_rates = akcodec_tdm_rates; |
| 850 | plat_data->num_tdm_rates = ARRAY_SIZE(akcodec_tdm_rates); |
| 851 | |
| 852 | switch (plat_data->type) { |
| 853 | case CODEC_AK4458: |
| 854 | plat_data->fs_mul = ak4458_fs_mul; |
| 855 | plat_data->num_fs_mul = ARRAY_SIZE(ak4458_fs_mul); |
| 856 | plat_data->tdm_fs_mul = ak4458_tdm_fs_mul; |
| 857 | plat_data->num_tdm_fs_mul = ARRAY_SIZE(ak4458_tdm_fs_mul); |
| 858 | plat_data->support_channels = ak4458_channels; |
| 859 | plat_data->num_channels = ARRAY_SIZE(ak4458_channels); |
| 860 | plat_data->support_tdm_channels = ak4458_tdm_channels; |
| 861 | plat_data->num_tdm_channels = ARRAY_SIZE(ak4458_tdm_channels); |
| 862 | break; |
| 863 | case CODEC_AK4497: |
| 864 | plat_data->fs_mul = ak4497_fs_mul; |
| 865 | plat_data->num_fs_mul = ARRAY_SIZE(ak4497_fs_mul); |
| 866 | plat_data->support_channels = ak4458_channels; |
| 867 | plat_data->num_channels = ARRAY_SIZE(ak4458_channels); |
| 868 | break; |
| 869 | case CODEC_AK5558: |
| 870 | case CODEC_AK5552: |
| 871 | plat_data->fs_mul = ak5558_fs_mul; |
| 872 | plat_data->num_fs_mul = ARRAY_SIZE(ak5558_fs_mul); |
| 873 | plat_data->tdm_fs_mul = ak5558_tdm_fs_mul; |
| 874 | plat_data->num_tdm_fs_mul = ARRAY_SIZE(ak5558_tdm_fs_mul); |
| 875 | plat_data->support_channels = ak5558_channels; |
| 876 | plat_data->num_channels = ARRAY_SIZE(ak5558_channels); |
| 877 | plat_data->support_tdm_channels = ak5558_tdm_channels; |
| 878 | plat_data->num_tdm_channels = ARRAY_SIZE(ak5558_tdm_channels); |
| 879 | break; |
| 880 | case CODEC_CS42888: |
| 881 | plat_data->fs_mul = cs42888_fs_mul; |
| 882 | plat_data->num_fs_mul = ARRAY_SIZE(cs42888_fs_mul); |
| 883 | plat_data->tdm_fs_mul = cs42888_tdm_fs_mul; |
| 884 | plat_data->num_tdm_fs_mul = ARRAY_SIZE(cs42888_tdm_fs_mul); |
| 885 | plat_data->support_channels = cs42888_channels; |
| 886 | plat_data->num_channels = ARRAY_SIZE(cs42888_channels); |
| 887 | plat_data->support_tdm_channels = cs42888_tdm_channels; |
| 888 | plat_data->num_tdm_channels = ARRAY_SIZE(cs42888_tdm_channels); |
| 889 | break; |
| 890 | case CODEC_WM8524: |
| 891 | plat_data->fs_mul = wm8524_fs_mul; |
| 892 | plat_data->num_fs_mul = ARRAY_SIZE(wm8524_fs_mul); |
| 893 | plat_data->support_channels = wm8524_channels; |
| 894 | plat_data->num_channels = ARRAY_SIZE(wm8524_channels); |
| 895 | break; |
| 896 | default: |
| 897 | break; |
| 898 | } |
| 899 | } |
| 900 | |
| 901 | /* with asrc as front end */ |
| 902 | if (data->card.num_links == 3) { |
| 903 | data->card.dapm_routes = data->dapm_routes; |
| 904 | data->card.num_dapm_routes = data->num_dapm_routes; |
| 905 | for_each_card_prelinks(&data->card, i, link) { |
| 906 | if (link->no_pcm == 1) |
| 907 | link_be = link; |
| 908 | } |
| 909 | for_each_card_prelinks(&data->card, i, link) { |
| 910 | if (link->dynamic == 1 && link_be) { |
| 911 | link->playback_only = link_be->playback_only; |
| 912 | link->capture_only = link_be->capture_only; |
| 913 | } |
| 914 | } |
| 915 | } |
| 916 | |
| 917 | ret = devm_snd_soc_register_card(dev: &pdev->dev, card: &data->card); |
| 918 | if (ret) |
| 919 | return dev_err_probe(dev: &pdev->dev, err: ret, fmt: "snd_soc_register_card failed\n" ); |
| 920 | |
| 921 | return 0; |
| 922 | } |
| 923 | |
| 924 | static const struct of_device_id imx_card_dt_ids[] = { |
| 925 | { .compatible = "fsl,imx-audio-card" , }, |
| 926 | { }, |
| 927 | }; |
| 928 | MODULE_DEVICE_TABLE(of, imx_card_dt_ids); |
| 929 | |
| 930 | static struct platform_driver imx_card_driver = { |
| 931 | .driver = { |
| 932 | .name = "imx-card" , |
| 933 | .pm = &snd_soc_pm_ops, |
| 934 | .of_match_table = imx_card_dt_ids, |
| 935 | }, |
| 936 | .probe = imx_card_probe, |
| 937 | }; |
| 938 | module_platform_driver(imx_card_driver); |
| 939 | |
| 940 | MODULE_DESCRIPTION("Freescale i.MX ASoC Machine Driver" ); |
| 941 | MODULE_LICENSE("GPL v2" ); |
| 942 | MODULE_ALIAS("platform:imx-card" ); |
| 943 | |