| 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | // |
| 3 | // MediaTek ALSA SoC Audio DAI TDM Control |
| 4 | // |
| 5 | // Copyright (c) 2022 MediaTek Inc. |
| 6 | // Author: Jiaxin Yu <jiaxin.yu@mediatek.com> |
| 7 | |
| 8 | #include <linux/regmap.h> |
| 9 | #include <sound/pcm_params.h> |
| 10 | |
| 11 | #include "mt8186-afe-clk.h" |
| 12 | #include "mt8186-afe-common.h" |
| 13 | #include "mt8186-afe-gpio.h" |
| 14 | #include "mt8186-interconnection.h" |
| 15 | |
| 16 | #define TDM_HD_EN_W_NAME "TDM_HD_EN" |
| 17 | #define TDM_MCLK_EN_W_NAME "TDM_MCLK_EN" |
| 18 | #define MTK_AFE_TDM_KCONTROL_NAME "TDM_HD_Mux" |
| 19 | |
| 20 | struct mtk_afe_tdm_priv { |
| 21 | unsigned int id; |
| 22 | unsigned int rate; /* for determine which apll to use */ |
| 23 | unsigned int bck_invert; |
| 24 | unsigned int lck_invert; |
| 25 | unsigned int lrck_width; |
| 26 | unsigned int mclk_id; |
| 27 | unsigned int mclk_multiple; /* according to sample rate */ |
| 28 | unsigned int mclk_rate; |
| 29 | unsigned int mclk_apll; |
| 30 | unsigned int tdm_mode; |
| 31 | unsigned int data_mode; |
| 32 | unsigned int slave_mode; |
| 33 | unsigned int low_jitter_en; |
| 34 | }; |
| 35 | |
| 36 | enum { |
| 37 | TDM_IN_I2S = 0, |
| 38 | TDM_IN_LJ = 1, |
| 39 | TDM_IN_RJ = 2, |
| 40 | TDM_IN_DSP_A = 4, |
| 41 | TDM_IN_DSP_B = 5, |
| 42 | }; |
| 43 | |
| 44 | enum { |
| 45 | TDM_DATA_ONE_PIN = 0, |
| 46 | TDM_DATA_MULTI_PIN, |
| 47 | }; |
| 48 | |
| 49 | enum { |
| 50 | TDM_BCK_NON_INV = 0, |
| 51 | TDM_BCK_INV = 1, |
| 52 | }; |
| 53 | |
| 54 | enum { |
| 55 | TDM_LCK_NON_INV = 0, |
| 56 | TDM_LCK_INV = 1, |
| 57 | }; |
| 58 | |
| 59 | static unsigned int get_tdm_lrck_width(snd_pcm_format_t format, |
| 60 | unsigned int mode) |
| 61 | { |
| 62 | if (mode == TDM_IN_DSP_A || mode == TDM_IN_DSP_B) |
| 63 | return 0; |
| 64 | |
| 65 | return snd_pcm_format_physical_width(format) - 1; |
| 66 | } |
| 67 | |
| 68 | static unsigned int get_tdm_ch_fixup(unsigned int channels) |
| 69 | { |
| 70 | if (channels > 4) |
| 71 | return 8; |
| 72 | else if (channels > 2) |
| 73 | return 4; |
| 74 | |
| 75 | return 2; |
| 76 | } |
| 77 | |
| 78 | static unsigned int get_tdm_ch_per_sdata(unsigned int mode, |
| 79 | unsigned int channels) |
| 80 | { |
| 81 | if (mode == TDM_IN_DSP_A || mode == TDM_IN_DSP_B) |
| 82 | return get_tdm_ch_fixup(channels); |
| 83 | |
| 84 | return 2; |
| 85 | } |
| 86 | |
| 87 | enum { |
| 88 | SUPPLY_SEQ_APLL, |
| 89 | SUPPLY_SEQ_TDM_MCK_EN, |
| 90 | SUPPLY_SEQ_TDM_HD_EN, |
| 91 | SUPPLY_SEQ_TDM_EN, |
| 92 | }; |
| 93 | |
| 94 | static int get_tdm_id_by_name(const char *name) |
| 95 | { |
| 96 | return MT8186_DAI_TDM_IN; |
| 97 | } |
| 98 | |
| 99 | static int mtk_tdm_en_event(struct snd_soc_dapm_widget *w, |
| 100 | struct snd_kcontrol *kcontrol, |
| 101 | int event) |
| 102 | { |
| 103 | struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(dapm: w->dapm); |
| 104 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 105 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 106 | int dai_id = get_tdm_id_by_name(name: w->name); |
| 107 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 108 | |
| 109 | dev_dbg(cmpnt->dev, "%s(), name %s, event 0x%x\n" , |
| 110 | __func__, w->name, event); |
| 111 | |
| 112 | switch (event) { |
| 113 | case SND_SOC_DAPM_PRE_PMU: |
| 114 | mt8186_afe_gpio_request(dev: afe->dev, enable: true, dai: tdm_priv->id, uplink: 0); |
| 115 | break; |
| 116 | case SND_SOC_DAPM_POST_PMD: |
| 117 | mt8186_afe_gpio_request(dev: afe->dev, enable: false, dai: tdm_priv->id, uplink: 0); |
| 118 | break; |
| 119 | default: |
| 120 | break; |
| 121 | } |
| 122 | |
| 123 | return 0; |
| 124 | } |
| 125 | |
| 126 | static int mtk_tdm_mck_en_event(struct snd_soc_dapm_widget *w, |
| 127 | struct snd_kcontrol *kcontrol, |
| 128 | int event) |
| 129 | { |
| 130 | struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(dapm: w->dapm); |
| 131 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 132 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 133 | int dai_id = get_tdm_id_by_name(name: w->name); |
| 134 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 135 | |
| 136 | dev_dbg(cmpnt->dev, "%s(), name %s, event 0x%x, dai_id %d\n" , |
| 137 | __func__, w->name, event, dai_id); |
| 138 | |
| 139 | switch (event) { |
| 140 | case SND_SOC_DAPM_PRE_PMU: |
| 141 | mt8186_mck_enable(afe, mck_id: tdm_priv->mclk_id, rate: tdm_priv->mclk_rate); |
| 142 | break; |
| 143 | case SND_SOC_DAPM_POST_PMD: |
| 144 | tdm_priv->mclk_rate = 0; |
| 145 | mt8186_mck_disable(afe, mck_id: tdm_priv->mclk_id); |
| 146 | break; |
| 147 | default: |
| 148 | break; |
| 149 | } |
| 150 | |
| 151 | return 0; |
| 152 | } |
| 153 | |
| 154 | /* dai component */ |
| 155 | /* tdm virtual mux to output widget */ |
| 156 | static const char * const tdm_mux_map[] = { |
| 157 | "Normal" , "Dummy_Widget" , |
| 158 | }; |
| 159 | |
| 160 | static int tdm_mux_map_value[] = { |
| 161 | 0, 1, |
| 162 | }; |
| 163 | |
| 164 | static SOC_VALUE_ENUM_SINGLE_AUTODISABLE_DECL(tdm_mux_map_enum, |
| 165 | SND_SOC_NOPM, |
| 166 | 0, |
| 167 | 1, |
| 168 | tdm_mux_map, |
| 169 | tdm_mux_map_value); |
| 170 | |
| 171 | static const struct snd_kcontrol_new tdm_in_mux_control = |
| 172 | SOC_DAPM_ENUM("TDM In Select" , tdm_mux_map_enum); |
| 173 | |
| 174 | static const struct snd_soc_dapm_widget mtk_dai_tdm_widgets[] = { |
| 175 | SND_SOC_DAPM_CLOCK_SUPPLY("aud_tdm_clk" ), |
| 176 | |
| 177 | SND_SOC_DAPM_SUPPLY_S("TDM_EN" , SUPPLY_SEQ_TDM_EN, |
| 178 | ETDM_IN1_CON0, ETDM_IN1_CON0_REG_ETDM_IN_EN_SFT, |
| 179 | 0, mtk_tdm_en_event, |
| 180 | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| 181 | /* tdm hd en */ |
| 182 | SND_SOC_DAPM_SUPPLY_S(TDM_HD_EN_W_NAME, SUPPLY_SEQ_TDM_HD_EN, |
| 183 | ETDM_IN1_CON2, ETDM_IN1_CON2_REG_CLOCK_SOURCE_SEL_SFT, |
| 184 | 0, NULL, |
| 185 | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| 186 | |
| 187 | SND_SOC_DAPM_SUPPLY_S(TDM_MCLK_EN_W_NAME, SUPPLY_SEQ_TDM_MCK_EN, |
| 188 | SND_SOC_NOPM, 0, 0, |
| 189 | mtk_tdm_mck_en_event, |
| 190 | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| 191 | |
| 192 | SND_SOC_DAPM_INPUT("TDM_DUMMY_IN" ), |
| 193 | |
| 194 | SND_SOC_DAPM_MUX("TDM_In_Mux" , |
| 195 | SND_SOC_NOPM, 0, 0, &tdm_in_mux_control), |
| 196 | }; |
| 197 | |
| 198 | static int mtk_afe_tdm_mclk_connect(struct snd_soc_dapm_widget *source, |
| 199 | struct snd_soc_dapm_widget *sink) |
| 200 | { |
| 201 | struct snd_soc_dapm_widget *w = sink; |
| 202 | struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(dapm: w->dapm); |
| 203 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 204 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 205 | int dai_id = get_tdm_id_by_name(name: w->name); |
| 206 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 207 | |
| 208 | return (tdm_priv->mclk_rate > 0) ? 1 : 0; |
| 209 | } |
| 210 | |
| 211 | static int mtk_afe_tdm_mclk_apll_connect(struct snd_soc_dapm_widget *source, |
| 212 | struct snd_soc_dapm_widget *sink) |
| 213 | { |
| 214 | struct snd_soc_dapm_widget *w = sink; |
| 215 | struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(dapm: w->dapm); |
| 216 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 217 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 218 | int dai_id = get_tdm_id_by_name(name: w->name); |
| 219 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 220 | int cur_apll; |
| 221 | |
| 222 | /* which apll */ |
| 223 | cur_apll = mt8186_get_apll_by_name(afe, name: source->name); |
| 224 | |
| 225 | return (tdm_priv->mclk_apll == cur_apll) ? 1 : 0; |
| 226 | } |
| 227 | |
| 228 | static int mtk_afe_tdm_hd_connect(struct snd_soc_dapm_widget *source, |
| 229 | struct snd_soc_dapm_widget *sink) |
| 230 | { |
| 231 | struct snd_soc_dapm_widget *w = sink; |
| 232 | struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(dapm: w->dapm); |
| 233 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 234 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 235 | int dai_id = get_tdm_id_by_name(name: w->name); |
| 236 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 237 | |
| 238 | return tdm_priv->low_jitter_en; |
| 239 | } |
| 240 | |
| 241 | static int mtk_afe_tdm_apll_connect(struct snd_soc_dapm_widget *source, |
| 242 | struct snd_soc_dapm_widget *sink) |
| 243 | { |
| 244 | struct snd_soc_dapm_widget *w = sink; |
| 245 | struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(dapm: w->dapm); |
| 246 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 247 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 248 | int dai_id = get_tdm_id_by_name(name: w->name); |
| 249 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 250 | int cur_apll; |
| 251 | int tdm_need_apll; |
| 252 | |
| 253 | /* which apll */ |
| 254 | cur_apll = mt8186_get_apll_by_name(afe, name: source->name); |
| 255 | |
| 256 | /* choose APLL from tdm rate */ |
| 257 | tdm_need_apll = mt8186_get_apll_by_rate(afe, rate: tdm_priv->rate); |
| 258 | |
| 259 | return (tdm_need_apll == cur_apll) ? 1 : 0; |
| 260 | } |
| 261 | |
| 262 | /* low jitter control */ |
| 263 | static const char * const mt8186_tdm_hd_str[] = { |
| 264 | "Normal" , "Low_Jitter" |
| 265 | }; |
| 266 | |
| 267 | static const struct soc_enum mt8186_tdm_enum[] = { |
| 268 | SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(mt8186_tdm_hd_str), |
| 269 | mt8186_tdm_hd_str), |
| 270 | }; |
| 271 | |
| 272 | static int mt8186_tdm_hd_get(struct snd_kcontrol *kcontrol, |
| 273 | struct snd_ctl_elem_value *ucontrol) |
| 274 | { |
| 275 | struct snd_soc_component *cmpnt = snd_kcontrol_chip(kcontrol); |
| 276 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 277 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 278 | int dai_id = get_tdm_id_by_name(name: kcontrol->id.name); |
| 279 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 280 | |
| 281 | ucontrol->value.integer.value[0] = tdm_priv->low_jitter_en; |
| 282 | |
| 283 | return 0; |
| 284 | } |
| 285 | |
| 286 | static int mt8186_tdm_hd_set(struct snd_kcontrol *kcontrol, |
| 287 | struct snd_ctl_elem_value *ucontrol) |
| 288 | { |
| 289 | struct snd_soc_component *cmpnt = snd_kcontrol_chip(kcontrol); |
| 290 | struct mtk_base_afe *afe = snd_soc_component_get_drvdata(c: cmpnt); |
| 291 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 292 | int dai_id = get_tdm_id_by_name(name: kcontrol->id.name); |
| 293 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai_id]; |
| 294 | struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| 295 | int hd_en; |
| 296 | |
| 297 | if (ucontrol->value.enumerated.item[0] >= e->items) |
| 298 | return -EINVAL; |
| 299 | |
| 300 | hd_en = ucontrol->value.integer.value[0]; |
| 301 | |
| 302 | dev_dbg(afe->dev, "%s(), kcontrol name %s, hd_en %d\n" , |
| 303 | __func__, kcontrol->id.name, hd_en); |
| 304 | |
| 305 | if (tdm_priv->low_jitter_en == hd_en) |
| 306 | return 0; |
| 307 | |
| 308 | tdm_priv->low_jitter_en = hd_en; |
| 309 | |
| 310 | return 1; |
| 311 | } |
| 312 | |
| 313 | static const struct snd_kcontrol_new mtk_dai_tdm_controls[] = { |
| 314 | SOC_ENUM_EXT(MTK_AFE_TDM_KCONTROL_NAME, mt8186_tdm_enum[0], |
| 315 | mt8186_tdm_hd_get, mt8186_tdm_hd_set), |
| 316 | }; |
| 317 | |
| 318 | static const struct snd_soc_dapm_route mtk_dai_tdm_routes[] = { |
| 319 | {"TDM IN" , NULL, "aud_tdm_clk" }, |
| 320 | {"TDM IN" , NULL, "TDM_EN" }, |
| 321 | {"TDM IN" , NULL, TDM_HD_EN_W_NAME, mtk_afe_tdm_hd_connect}, |
| 322 | {TDM_HD_EN_W_NAME, NULL, APLL1_W_NAME, mtk_afe_tdm_apll_connect}, |
| 323 | {TDM_HD_EN_W_NAME, NULL, APLL2_W_NAME, mtk_afe_tdm_apll_connect}, |
| 324 | |
| 325 | {"TDM IN" , NULL, TDM_MCLK_EN_W_NAME, mtk_afe_tdm_mclk_connect}, |
| 326 | {TDM_MCLK_EN_W_NAME, NULL, APLL1_W_NAME, mtk_afe_tdm_mclk_apll_connect}, |
| 327 | {TDM_MCLK_EN_W_NAME, NULL, APLL2_W_NAME, mtk_afe_tdm_mclk_apll_connect}, |
| 328 | |
| 329 | /* allow tdm on without codec on */ |
| 330 | {"TDM IN" , NULL, "TDM_In_Mux" }, |
| 331 | {"TDM_In_Mux" , "Dummy_Widget" , "TDM_DUMMY_IN" }, |
| 332 | }; |
| 333 | |
| 334 | /* dai ops */ |
| 335 | static int mtk_dai_tdm_cal_mclk(struct mtk_base_afe *afe, |
| 336 | struct mtk_afe_tdm_priv *tdm_priv, |
| 337 | int freq) |
| 338 | { |
| 339 | int apll; |
| 340 | int apll_rate; |
| 341 | |
| 342 | apll = mt8186_get_apll_by_rate(afe, rate: freq); |
| 343 | apll_rate = mt8186_get_apll_rate(afe, apll); |
| 344 | |
| 345 | if (!freq || freq > apll_rate) { |
| 346 | dev_err(afe->dev, |
| 347 | "%s(), freq(%d Hz) invalid\n" , __func__, freq); |
| 348 | return -EINVAL; |
| 349 | } |
| 350 | |
| 351 | if (apll_rate % freq != 0) { |
| 352 | dev_err(afe->dev, |
| 353 | "%s(), APLL cannot generate %d Hz" , __func__, freq); |
| 354 | return -EINVAL; |
| 355 | } |
| 356 | |
| 357 | tdm_priv->mclk_rate = freq; |
| 358 | tdm_priv->mclk_apll = apll; |
| 359 | |
| 360 | return 0; |
| 361 | } |
| 362 | |
| 363 | static int mtk_dai_tdm_hw_params(struct snd_pcm_substream *substream, |
| 364 | struct snd_pcm_hw_params *params, |
| 365 | struct snd_soc_dai *dai) |
| 366 | { |
| 367 | struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); |
| 368 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 369 | int tdm_id = dai->id; |
| 370 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[tdm_id]; |
| 371 | unsigned int tdm_mode = tdm_priv->tdm_mode; |
| 372 | unsigned int data_mode = tdm_priv->data_mode; |
| 373 | unsigned int rate = params_rate(p: params); |
| 374 | unsigned int channels = params_channels(p: params); |
| 375 | snd_pcm_format_t format = params_format(p: params); |
| 376 | unsigned int bit_width = |
| 377 | snd_pcm_format_physical_width(format); |
| 378 | unsigned int tdm_channels = (data_mode == TDM_DATA_ONE_PIN) ? |
| 379 | get_tdm_ch_per_sdata(mode: tdm_mode, channels) : 2; |
| 380 | unsigned int lrck_width = |
| 381 | get_tdm_lrck_width(format, mode: tdm_mode); |
| 382 | unsigned int tdm_con = 0; |
| 383 | bool slave_mode = tdm_priv->slave_mode; |
| 384 | bool lrck_inv = tdm_priv->lck_invert; |
| 385 | bool bck_inv = tdm_priv->bck_invert; |
| 386 | unsigned int tran_rate; |
| 387 | unsigned int tran_relatch_rate; |
| 388 | |
| 389 | tdm_priv->rate = rate; |
| 390 | tran_rate = mt8186_rate_transform(dev: afe->dev, rate, aud_blk: dai->id); |
| 391 | tran_relatch_rate = mt8186_tdm_relatch_rate_transform(dev: afe->dev, rate); |
| 392 | |
| 393 | /* calculate mclk_rate, if not set explicitly */ |
| 394 | if (!tdm_priv->mclk_rate) { |
| 395 | tdm_priv->mclk_rate = rate * tdm_priv->mclk_multiple; |
| 396 | mtk_dai_tdm_cal_mclk(afe, tdm_priv, freq: tdm_priv->mclk_rate); |
| 397 | } |
| 398 | |
| 399 | /* ETDM_IN1_CON0 */ |
| 400 | tdm_con |= slave_mode << ETDM_IN1_CON0_REG_SLAVE_MODE_SFT; |
| 401 | tdm_con |= tdm_mode << ETDM_IN1_CON0_REG_FMT_SFT; |
| 402 | tdm_con |= (bit_width - 1) << ETDM_IN1_CON0_REG_BIT_LENGTH_SFT; |
| 403 | tdm_con |= (bit_width - 1) << ETDM_IN1_CON0_REG_WORD_LENGTH_SFT; |
| 404 | tdm_con |= (tdm_channels - 1) << ETDM_IN1_CON0_REG_CH_NUM_SFT; |
| 405 | /* need to disable sync mode otherwise this may cause latch data error */ |
| 406 | tdm_con |= 0 << ETDM_IN1_CON0_REG_SYNC_MODE_SFT; |
| 407 | /* relatch 1x en clock fix to h26m */ |
| 408 | tdm_con |= 0 << ETDM_IN1_CON0_REG_RELATCH_1X_EN_SEL_DOMAIN_SFT; |
| 409 | regmap_update_bits(map: afe->regmap, ETDM_IN1_CON0, ETDM_IN_CON0_CTRL_MASK, val: tdm_con); |
| 410 | |
| 411 | /* ETDM_IN1_CON1 */ |
| 412 | tdm_con = 0; |
| 413 | tdm_con |= 0 << ETDM_IN1_CON1_REG_LRCK_AUTO_MODE_SFT; |
| 414 | tdm_con |= 1 << ETDM_IN1_CON1_PINMUX_MCLK_CTRL_OE_SFT; |
| 415 | tdm_con |= (lrck_width - 1) << ETDM_IN1_CON1_REG_LRCK_WIDTH_SFT; |
| 416 | regmap_update_bits(map: afe->regmap, ETDM_IN1_CON1, ETDM_IN_CON1_CTRL_MASK, val: tdm_con); |
| 417 | |
| 418 | /* ETDM_IN1_CON3 */ |
| 419 | tdm_con = ETDM_IN_CON3_FS(tran_rate); |
| 420 | regmap_update_bits(map: afe->regmap, ETDM_IN1_CON3, ETDM_IN_CON3_CTRL_MASK, val: tdm_con); |
| 421 | |
| 422 | /* ETDM_IN1_CON4 */ |
| 423 | tdm_con = ETDM_IN_CON4_FS(tran_relatch_rate); |
| 424 | if (slave_mode) { |
| 425 | if (lrck_inv) |
| 426 | tdm_con |= ETDM_IN_CON4_CON0_SLAVE_LRCK_INV; |
| 427 | if (bck_inv) |
| 428 | tdm_con |= ETDM_IN_CON4_CON0_SLAVE_BCK_INV; |
| 429 | } else { |
| 430 | if (lrck_inv) |
| 431 | tdm_con |= ETDM_IN_CON4_CON0_MASTER_LRCK_INV; |
| 432 | if (bck_inv) |
| 433 | tdm_con |= ETDM_IN_CON4_CON0_MASTER_BCK_INV; |
| 434 | } |
| 435 | regmap_update_bits(map: afe->regmap, ETDM_IN1_CON4, ETDM_IN_CON4_CTRL_MASK, val: tdm_con); |
| 436 | |
| 437 | /* ETDM_IN1_CON2 */ |
| 438 | tdm_con = 0; |
| 439 | if (data_mode == TDM_DATA_MULTI_PIN) { |
| 440 | tdm_con |= ETDM_IN_CON2_MULTI_IP_2CH_MODE; |
| 441 | tdm_con |= ETDM_IN_CON2_MULTI_IP_CH(channels); |
| 442 | } |
| 443 | regmap_update_bits(map: afe->regmap, ETDM_IN1_CON2, ETDM_IN_CON2_CTRL_MASK, val: tdm_con); |
| 444 | |
| 445 | /* ETDM_IN1_CON8 */ |
| 446 | tdm_con = 0; |
| 447 | if (slave_mode) { |
| 448 | tdm_con |= 1 << ETDM_IN1_CON8_REG_ETDM_USE_AFIFO_SFT; |
| 449 | tdm_con |= 0 << ETDM_IN1_CON8_REG_AFIFO_CLOCK_DOMAIN_SEL_SFT; |
| 450 | tdm_con |= ETDM_IN_CON8_FS(tran_relatch_rate); |
| 451 | } else { |
| 452 | tdm_con |= 0 << ETDM_IN1_CON8_REG_ETDM_USE_AFIFO_SFT; |
| 453 | } |
| 454 | regmap_update_bits(map: afe->regmap, ETDM_IN1_CON8, ETDM_IN_CON8_CTRL_MASK, val: tdm_con); |
| 455 | |
| 456 | return 0; |
| 457 | } |
| 458 | |
| 459 | static int mtk_dai_tdm_set_sysclk(struct snd_soc_dai *dai, |
| 460 | int clk_id, unsigned int freq, int dir) |
| 461 | { |
| 462 | struct mtk_base_afe *afe = dev_get_drvdata(dev: dai->dev); |
| 463 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 464 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai->id]; |
| 465 | |
| 466 | if (dir != SND_SOC_CLOCK_IN) { |
| 467 | dev_err(afe->dev, "%s(), dir != SND_SOC_CLOCK_OUT" , __func__); |
| 468 | return -EINVAL; |
| 469 | } |
| 470 | |
| 471 | dev_dbg(afe->dev, "%s(), freq %d\n" , __func__, freq); |
| 472 | |
| 473 | return mtk_dai_tdm_cal_mclk(afe, tdm_priv, freq); |
| 474 | } |
| 475 | |
| 476 | static int mtk_dai_tdm_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) |
| 477 | { |
| 478 | struct mtk_base_afe *afe = dev_get_drvdata(dev: dai->dev); |
| 479 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 480 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai->id]; |
| 481 | |
| 482 | /* DAI mode*/ |
| 483 | switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { |
| 484 | case SND_SOC_DAIFMT_I2S: |
| 485 | tdm_priv->tdm_mode = TDM_IN_I2S; |
| 486 | tdm_priv->data_mode = TDM_DATA_MULTI_PIN; |
| 487 | break; |
| 488 | case SND_SOC_DAIFMT_LEFT_J: |
| 489 | tdm_priv->tdm_mode = TDM_IN_LJ; |
| 490 | tdm_priv->data_mode = TDM_DATA_MULTI_PIN; |
| 491 | break; |
| 492 | case SND_SOC_DAIFMT_RIGHT_J: |
| 493 | tdm_priv->tdm_mode = TDM_IN_RJ; |
| 494 | tdm_priv->data_mode = TDM_DATA_MULTI_PIN; |
| 495 | break; |
| 496 | case SND_SOC_DAIFMT_DSP_A: |
| 497 | tdm_priv->tdm_mode = TDM_IN_DSP_A; |
| 498 | tdm_priv->data_mode = TDM_DATA_ONE_PIN; |
| 499 | break; |
| 500 | case SND_SOC_DAIFMT_DSP_B: |
| 501 | tdm_priv->tdm_mode = TDM_IN_DSP_B; |
| 502 | tdm_priv->data_mode = TDM_DATA_ONE_PIN; |
| 503 | break; |
| 504 | default: |
| 505 | dev_err(afe->dev, "%s(), invalid DAIFMT_FORMAT_MASK" , __func__); |
| 506 | return -EINVAL; |
| 507 | } |
| 508 | |
| 509 | /* DAI clock inversion*/ |
| 510 | switch (fmt & SND_SOC_DAIFMT_INV_MASK) { |
| 511 | case SND_SOC_DAIFMT_NB_NF: |
| 512 | tdm_priv->bck_invert = TDM_BCK_NON_INV; |
| 513 | tdm_priv->lck_invert = TDM_LCK_NON_INV; |
| 514 | break; |
| 515 | case SND_SOC_DAIFMT_NB_IF: |
| 516 | tdm_priv->bck_invert = TDM_BCK_NON_INV; |
| 517 | tdm_priv->lck_invert = TDM_LCK_INV; |
| 518 | break; |
| 519 | case SND_SOC_DAIFMT_IB_NF: |
| 520 | tdm_priv->bck_invert = TDM_BCK_INV; |
| 521 | tdm_priv->lck_invert = TDM_LCK_NON_INV; |
| 522 | break; |
| 523 | case SND_SOC_DAIFMT_IB_IF: |
| 524 | tdm_priv->bck_invert = TDM_BCK_INV; |
| 525 | tdm_priv->lck_invert = TDM_LCK_INV; |
| 526 | break; |
| 527 | default: |
| 528 | dev_err(afe->dev, "%s(), invalid DAIFMT_INV_MASK" , __func__); |
| 529 | return -EINVAL; |
| 530 | } |
| 531 | |
| 532 | switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { |
| 533 | case SND_SOC_DAIFMT_BP_FP: |
| 534 | tdm_priv->slave_mode = false; |
| 535 | break; |
| 536 | case SND_SOC_DAIFMT_BC_FC: |
| 537 | tdm_priv->slave_mode = true; |
| 538 | break; |
| 539 | default: |
| 540 | dev_err(afe->dev, "%s(), invalid DAIFMT_CLOCK_PROVIDER_MASK" , |
| 541 | __func__); |
| 542 | return -EINVAL; |
| 543 | } |
| 544 | |
| 545 | return 0; |
| 546 | } |
| 547 | |
| 548 | static int mtk_dai_tdm_set_tdm_slot(struct snd_soc_dai *dai, |
| 549 | unsigned int tx_mask, |
| 550 | unsigned int rx_mask, |
| 551 | int slots, |
| 552 | int slot_width) |
| 553 | { |
| 554 | struct mtk_base_afe *afe = dev_get_drvdata(dev: dai->dev); |
| 555 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 556 | struct mtk_afe_tdm_priv *tdm_priv = afe_priv->dai_priv[dai->id]; |
| 557 | |
| 558 | dev_dbg(dai->dev, "%s %d slot_width %d\n" , __func__, dai->id, slot_width); |
| 559 | |
| 560 | tdm_priv->lrck_width = slot_width; |
| 561 | |
| 562 | return 0; |
| 563 | } |
| 564 | |
| 565 | static const struct snd_soc_dai_ops mtk_dai_tdm_ops = { |
| 566 | .hw_params = mtk_dai_tdm_hw_params, |
| 567 | .set_sysclk = mtk_dai_tdm_set_sysclk, |
| 568 | .set_fmt = mtk_dai_tdm_set_fmt, |
| 569 | .set_tdm_slot = mtk_dai_tdm_set_tdm_slot, |
| 570 | }; |
| 571 | |
| 572 | /* dai driver */ |
| 573 | #define MTK_TDM_RATES (SNDRV_PCM_RATE_8000_48000 |\ |
| 574 | SNDRV_PCM_RATE_88200 |\ |
| 575 | SNDRV_PCM_RATE_96000 |\ |
| 576 | SNDRV_PCM_RATE_176400 |\ |
| 577 | SNDRV_PCM_RATE_192000) |
| 578 | |
| 579 | #define MTK_TDM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\ |
| 580 | SNDRV_PCM_FMTBIT_S24_LE |\ |
| 581 | SNDRV_PCM_FMTBIT_S32_LE) |
| 582 | |
| 583 | static struct snd_soc_dai_driver mtk_dai_tdm_driver[] = { |
| 584 | { |
| 585 | .name = "TDM IN" , |
| 586 | .id = MT8186_DAI_TDM_IN, |
| 587 | .capture = { |
| 588 | .stream_name = "TDM IN" , |
| 589 | .channels_min = 2, |
| 590 | .channels_max = 8, |
| 591 | .rates = MTK_TDM_RATES, |
| 592 | .formats = MTK_TDM_FORMATS, |
| 593 | }, |
| 594 | .ops = &mtk_dai_tdm_ops, |
| 595 | }, |
| 596 | }; |
| 597 | |
| 598 | static struct mtk_afe_tdm_priv *init_tdm_priv_data(struct mtk_base_afe *afe) |
| 599 | { |
| 600 | struct mtk_afe_tdm_priv *tdm_priv; |
| 601 | |
| 602 | tdm_priv = devm_kzalloc(dev: afe->dev, size: sizeof(struct mtk_afe_tdm_priv), |
| 603 | GFP_KERNEL); |
| 604 | if (!tdm_priv) |
| 605 | return NULL; |
| 606 | |
| 607 | tdm_priv->mclk_multiple = 512; |
| 608 | tdm_priv->mclk_id = MT8186_TDM_MCK; |
| 609 | tdm_priv->id = MT8186_DAI_TDM_IN; |
| 610 | |
| 611 | return tdm_priv; |
| 612 | } |
| 613 | |
| 614 | int mt8186_dai_tdm_register(struct mtk_base_afe *afe) |
| 615 | { |
| 616 | struct mt8186_afe_private *afe_priv = afe->platform_priv; |
| 617 | struct mtk_afe_tdm_priv *tdm_priv; |
| 618 | struct mtk_base_afe_dai *dai; |
| 619 | |
| 620 | dai = devm_kzalloc(dev: afe->dev, size: sizeof(*dai), GFP_KERNEL); |
| 621 | if (!dai) |
| 622 | return -ENOMEM; |
| 623 | |
| 624 | list_add(new: &dai->list, head: &afe->sub_dais); |
| 625 | |
| 626 | dai->dai_drivers = mtk_dai_tdm_driver; |
| 627 | dai->num_dai_drivers = ARRAY_SIZE(mtk_dai_tdm_driver); |
| 628 | |
| 629 | dai->controls = mtk_dai_tdm_controls; |
| 630 | dai->num_controls = ARRAY_SIZE(mtk_dai_tdm_controls); |
| 631 | dai->dapm_widgets = mtk_dai_tdm_widgets; |
| 632 | dai->num_dapm_widgets = ARRAY_SIZE(mtk_dai_tdm_widgets); |
| 633 | dai->dapm_routes = mtk_dai_tdm_routes; |
| 634 | dai->num_dapm_routes = ARRAY_SIZE(mtk_dai_tdm_routes); |
| 635 | |
| 636 | tdm_priv = init_tdm_priv_data(afe); |
| 637 | if (!tdm_priv) |
| 638 | return -ENOMEM; |
| 639 | |
| 640 | afe_priv->dai_priv[MT8186_DAI_TDM_IN] = tdm_priv; |
| 641 | |
| 642 | return 0; |
| 643 | } |
| 644 | |