cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

mt8195-dai-adda.c (23317B)


      1// SPDX-License-Identifier: GPL-2.0
      2/*
      3 * MediaTek ALSA SoC Audio DAI ADDA Control
      4 *
      5 * Copyright (c) 2021 MediaTek Inc.
      6 * Author: Bicycle Tsai <bicycle.tsai@mediatek.com>
      7 *         Trevor Wu <trevor.wu@mediatek.com>
      8 */
      9
     10#include <linux/delay.h>
     11#include <linux/regmap.h>
     12#include "mt8195-afe-clk.h"
     13#include "mt8195-afe-common.h"
     14#include "mt8195-reg.h"
     15
     16#define ADDA_DL_GAIN_LOOPBACK 0x1800
     17#define ADDA_HIRES_THRES 48000
     18
     19enum {
     20	SUPPLY_SEQ_CLOCK_SEL,
     21	SUPPLY_SEQ_CLOCK_ON,
     22	SUPPLY_SEQ_ADDA_DL_ON,
     23	SUPPLY_SEQ_ADDA_MTKAIF_CFG,
     24	SUPPLY_SEQ_ADDA_UL_ON,
     25	SUPPLY_SEQ_ADDA_AFE_ON,
     26};
     27
     28enum {
     29	MTK_AFE_ADDA_DL_RATE_8K = 0,
     30	MTK_AFE_ADDA_DL_RATE_11K = 1,
     31	MTK_AFE_ADDA_DL_RATE_12K = 2,
     32	MTK_AFE_ADDA_DL_RATE_16K = 3,
     33	MTK_AFE_ADDA_DL_RATE_22K = 4,
     34	MTK_AFE_ADDA_DL_RATE_24K = 5,
     35	MTK_AFE_ADDA_DL_RATE_32K = 6,
     36	MTK_AFE_ADDA_DL_RATE_44K = 7,
     37	MTK_AFE_ADDA_DL_RATE_48K = 8,
     38	MTK_AFE_ADDA_DL_RATE_96K = 9,
     39	MTK_AFE_ADDA_DL_RATE_192K = 10,
     40};
     41
     42enum {
     43	MTK_AFE_ADDA_UL_RATE_8K = 0,
     44	MTK_AFE_ADDA_UL_RATE_16K = 1,
     45	MTK_AFE_ADDA_UL_RATE_32K = 2,
     46	MTK_AFE_ADDA_UL_RATE_48K = 3,
     47	MTK_AFE_ADDA_UL_RATE_96K = 4,
     48	MTK_AFE_ADDA_UL_RATE_192K = 5,
     49};
     50
     51enum {
     52	DELAY_DATA_MISO1 = 0,
     53	DELAY_DATA_MISO0 = 1,
     54	DELAY_DATA_MISO2 = 1,
     55};
     56
     57enum {
     58	MTK_AFE_ADDA,
     59	MTK_AFE_ADDA6,
     60};
     61
     62struct mtk_dai_adda_priv {
     63	bool hires_required;
     64};
     65
     66static unsigned int afe_adda_dl_rate_transform(struct mtk_base_afe *afe,
     67					       unsigned int rate)
     68{
     69	switch (rate) {
     70	case 8000:
     71		return MTK_AFE_ADDA_DL_RATE_8K;
     72	case 11025:
     73		return MTK_AFE_ADDA_DL_RATE_11K;
     74	case 12000:
     75		return MTK_AFE_ADDA_DL_RATE_12K;
     76	case 16000:
     77		return MTK_AFE_ADDA_DL_RATE_16K;
     78	case 22050:
     79		return MTK_AFE_ADDA_DL_RATE_22K;
     80	case 24000:
     81		return MTK_AFE_ADDA_DL_RATE_24K;
     82	case 32000:
     83		return MTK_AFE_ADDA_DL_RATE_32K;
     84	case 44100:
     85		return MTK_AFE_ADDA_DL_RATE_44K;
     86	case 48000:
     87		return MTK_AFE_ADDA_DL_RATE_48K;
     88	case 96000:
     89		return MTK_AFE_ADDA_DL_RATE_96K;
     90	case 192000:
     91		return MTK_AFE_ADDA_DL_RATE_192K;
     92	default:
     93		dev_info(afe->dev, "%s(), rate %d invalid, use 48kHz!!!\n",
     94			 __func__, rate);
     95		return MTK_AFE_ADDA_DL_RATE_48K;
     96	}
     97}
     98
     99static unsigned int afe_adda_ul_rate_transform(struct mtk_base_afe *afe,
    100					       unsigned int rate)
    101{
    102	switch (rate) {
    103	case 8000:
    104		return MTK_AFE_ADDA_UL_RATE_8K;
    105	case 16000:
    106		return MTK_AFE_ADDA_UL_RATE_16K;
    107	case 32000:
    108		return MTK_AFE_ADDA_UL_RATE_32K;
    109	case 48000:
    110		return MTK_AFE_ADDA_UL_RATE_48K;
    111	case 96000:
    112		return MTK_AFE_ADDA_UL_RATE_96K;
    113	case 192000:
    114		return MTK_AFE_ADDA_UL_RATE_192K;
    115	default:
    116		dev_info(afe->dev, "%s(), rate %d invalid, use 48kHz!!!\n",
    117			 __func__, rate);
    118		return MTK_AFE_ADDA_UL_RATE_48K;
    119	}
    120}
    121
    122static int mt8195_adda_mtkaif_init(struct mtk_base_afe *afe)
    123{
    124	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    125	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    126	int delay_data;
    127	int delay_cycle;
    128	unsigned int mask = 0;
    129	unsigned int val = 0;
    130
    131	/* set rx protocol 2 & mtkaif_rxif_clkinv_adc inverse */
    132	mask = (MTKAIF_RXIF_CLKINV_ADC | MTKAIF_RXIF_PROTOCOL2);
    133	val = (MTKAIF_RXIF_CLKINV_ADC | MTKAIF_RXIF_PROTOCOL2);
    134
    135	regmap_update_bits(afe->regmap, AFE_ADDA_MTKAIF_CFG0, mask, val);
    136	regmap_update_bits(afe->regmap, AFE_ADDA6_MTKAIF_CFG0, mask, val);
    137
    138	mask = RG_RX_PROTOCOL2;
    139	val = RG_RX_PROTOCOL2;
    140	regmap_update_bits(afe->regmap, AFE_AUD_PAD_TOP, mask, val);
    141
    142	if (!param->mtkaif_calibration_ok) {
    143		dev_info(afe->dev, "%s(), calibration fail\n",  __func__);
    144		return 0;
    145	}
    146
    147	/* set delay for ch1, ch2 */
    148	if (param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_0] >=
    149	    param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_1]) {
    150		delay_data = DELAY_DATA_MISO1;
    151		delay_cycle =
    152			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_0] -
    153			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_1];
    154	} else {
    155		delay_data = DELAY_DATA_MISO0;
    156		delay_cycle =
    157			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_1] -
    158			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_0];
    159	}
    160
    161	val = 0;
    162	mask = (MTKAIF_RXIF_DELAY_DATA | MTKAIF_RXIF_DELAY_CYCLE_MASK);
    163	val |= MTKAIF_RXIF_DELAY_CYCLE(delay_cycle) &
    164	       MTKAIF_RXIF_DELAY_CYCLE_MASK;
    165	val |= delay_data << MTKAIF_RXIF_DELAY_DATA_SHIFT;
    166	regmap_update_bits(afe->regmap, AFE_ADDA_MTKAIF_RX_CFG2, mask, val);
    167
    168	/* set delay between ch3 and ch2 */
    169	if (param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_2] >=
    170	    param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_1]) {
    171		delay_data = DELAY_DATA_MISO1;
    172		delay_cycle =
    173			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_2] -
    174			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_1];
    175	} else {
    176		delay_data = DELAY_DATA_MISO2;
    177		delay_cycle =
    178			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_1] -
    179			param->mtkaif_phase_cycle[MT8195_MTKAIF_MISO_2];
    180	}
    181
    182	val = 0;
    183	mask = (MTKAIF_RXIF_DELAY_DATA | MTKAIF_RXIF_DELAY_CYCLE_MASK);
    184	val |= MTKAIF_RXIF_DELAY_CYCLE(delay_cycle) &
    185	       MTKAIF_RXIF_DELAY_CYCLE_MASK;
    186	val |= delay_data << MTKAIF_RXIF_DELAY_DATA_SHIFT;
    187	regmap_update_bits(afe->regmap, AFE_ADDA6_MTKAIF_RX_CFG2, mask, val);
    188
    189	return 0;
    190}
    191
    192static int mtk_adda_mtkaif_cfg_event(struct snd_soc_dapm_widget *w,
    193				     struct snd_kcontrol *kcontrol,
    194				     int event)
    195{
    196	struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm);
    197	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    198
    199	dev_dbg(afe->dev, "%s(), name %s, event 0x%x\n",
    200		__func__, w->name, event);
    201
    202	switch (event) {
    203	case SND_SOC_DAPM_PRE_PMU:
    204		mt8195_adda_mtkaif_init(afe);
    205		break;
    206	default:
    207		break;
    208	}
    209
    210	return 0;
    211}
    212
    213static int mtk_adda_dl_event(struct snd_soc_dapm_widget *w,
    214			     struct snd_kcontrol *kcontrol,
    215			     int event)
    216{
    217	struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm);
    218	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    219
    220	dev_dbg(afe->dev, "%s(), name %s, event 0x%x\n",
    221		__func__, w->name, event);
    222
    223	switch (event) {
    224	case SND_SOC_DAPM_POST_PMD:
    225		/* should delayed 1/fs(smallest is 8k) = 125us before afe off */
    226		usleep_range(125, 135);
    227		break;
    228	default:
    229		break;
    230	}
    231
    232	return 0;
    233}
    234
    235static void mtk_adda_ul_mictype(struct mtk_base_afe *afe, int adda, bool dmic)
    236{
    237	unsigned int reg = 0;
    238	unsigned int mask = 0;
    239	unsigned int val = 0;
    240
    241	switch (adda) {
    242	case MTK_AFE_ADDA:
    243		reg = AFE_ADDA_UL_SRC_CON0;
    244		break;
    245	case MTK_AFE_ADDA6:
    246		reg = AFE_ADDA6_UL_SRC_CON0;
    247		break;
    248	default:
    249		dev_info(afe->dev, "%s(), wrong parameter\n",  __func__);
    250		return;
    251	}
    252
    253	mask = (UL_SDM3_LEVEL_CTL | UL_MODE_3P25M_CH1_CTL |
    254		UL_MODE_3P25M_CH2_CTL);
    255
    256	/* turn on dmic, ch1, ch2 */
    257	if (dmic)
    258		val = mask;
    259
    260	regmap_update_bits(afe->regmap, reg, mask, val);
    261}
    262
    263static int mtk_adda_ul_event(struct snd_soc_dapm_widget *w,
    264			     struct snd_kcontrol *kcontrol,
    265			     int event)
    266{
    267	struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm);
    268	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    269	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    270	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    271
    272	dev_dbg(afe->dev, "%s(), name %s, event 0x%x\n",
    273		__func__, w->name, event);
    274
    275	switch (event) {
    276	case SND_SOC_DAPM_PRE_PMU:
    277		mtk_adda_ul_mictype(afe, MTK_AFE_ADDA, param->mtkaif_dmic_on);
    278		break;
    279	case SND_SOC_DAPM_POST_PMD:
    280		/* should delayed 1/fs(smallest is 8k) = 125us before afe off */
    281		usleep_range(125, 135);
    282		break;
    283	default:
    284		break;
    285	}
    286
    287	return 0;
    288}
    289
    290static int mtk_adda6_ul_event(struct snd_soc_dapm_widget *w,
    291			      struct snd_kcontrol *kcontrol,
    292			      int event)
    293{
    294	struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm);
    295	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    296	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    297	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    298	unsigned int val;
    299
    300	dev_dbg(afe->dev, "%s(), name %s, event 0x%x\n",
    301		__func__, w->name, event);
    302
    303	switch (event) {
    304	case SND_SOC_DAPM_PRE_PMU:
    305		mtk_adda_ul_mictype(afe, MTK_AFE_ADDA6, param->mtkaif_dmic_on);
    306
    307		val = (param->mtkaif_adda6_only ?
    308			ADDA6_MTKAIF_RX_SYNC_WORD2_DISABLE : 0);
    309
    310		regmap_update_bits(afe->regmap,
    311				   AFE_ADDA_MTKAIF_SYNCWORD_CFG,
    312				   ADDA6_MTKAIF_RX_SYNC_WORD2_DISABLE,
    313				   val);
    314		break;
    315	case SND_SOC_DAPM_POST_PMD:
    316		/* should delayed 1/fs(smallest is 8k) = 125us before afe off */
    317		usleep_range(125, 135);
    318		break;
    319	default:
    320		break;
    321	}
    322
    323	return 0;
    324}
    325
    326static int mtk_audio_hires_event(struct snd_soc_dapm_widget *w,
    327				 struct snd_kcontrol *kcontrol,
    328				 int event)
    329{
    330	struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm);
    331	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    332	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    333	struct clk *clk = afe_priv->clk[MT8195_CLK_TOP_AUDIO_H_SEL];
    334	struct clk *clk_parent;
    335
    336	dev_dbg(afe->dev, "%s(), name %s, event 0x%x\n",
    337		__func__, w->name, event);
    338
    339	switch (event) {
    340	case SND_SOC_DAPM_PRE_PMU:
    341		clk_parent = afe_priv->clk[MT8195_CLK_TOP_APLL1];
    342		break;
    343	case SND_SOC_DAPM_POST_PMD:
    344		clk_parent = afe_priv->clk[MT8195_CLK_XTAL_26M];
    345		break;
    346	default:
    347		return 0;
    348	}
    349	mt8195_afe_set_clk_parent(afe, clk, clk_parent);
    350
    351	return 0;
    352}
    353
    354static struct mtk_dai_adda_priv *get_adda_priv_by_name(struct mtk_base_afe *afe,
    355						       const char *name)
    356{
    357	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    358	int dai_id;
    359
    360	if (strstr(name, "aud_adc_hires"))
    361		dai_id = MT8195_AFE_IO_UL_SRC1;
    362	else if (strstr(name, "aud_adda6_adc_hires"))
    363		dai_id = MT8195_AFE_IO_UL_SRC2;
    364	else if (strstr(name, "aud_dac_hires"))
    365		dai_id = MT8195_AFE_IO_DL_SRC;
    366	else
    367		return NULL;
    368
    369	return afe_priv->dai_priv[dai_id];
    370}
    371
    372static int mtk_afe_adda_hires_connect(struct snd_soc_dapm_widget *source,
    373				      struct snd_soc_dapm_widget *sink)
    374{
    375	struct snd_soc_dapm_widget *w = source;
    376	struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm);
    377	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    378	struct mtk_dai_adda_priv *adda_priv;
    379
    380	adda_priv = get_adda_priv_by_name(afe, w->name);
    381
    382	if (!adda_priv) {
    383		dev_info(afe->dev, "adda_priv == NULL");
    384		return 0;
    385	}
    386
    387	return (adda_priv->hires_required) ? 1 : 0;
    388}
    389
    390static const struct snd_kcontrol_new mtk_dai_adda_o176_mix[] = {
    391	SOC_DAPM_SINGLE_AUTODISABLE("I000 Switch", AFE_CONN176, 0, 1, 0),
    392	SOC_DAPM_SINGLE_AUTODISABLE("I002 Switch", AFE_CONN176, 2, 1, 0),
    393	SOC_DAPM_SINGLE_AUTODISABLE("I020 Switch", AFE_CONN176, 20, 1, 0),
    394	SOC_DAPM_SINGLE_AUTODISABLE("I022 Switch", AFE_CONN176, 22, 1, 0),
    395	SOC_DAPM_SINGLE_AUTODISABLE("I070 Switch", AFE_CONN176_2, 6, 1, 0),
    396};
    397
    398static const struct snd_kcontrol_new mtk_dai_adda_o177_mix[] = {
    399	SOC_DAPM_SINGLE_AUTODISABLE("I001 Switch", AFE_CONN177, 1, 1, 0),
    400	SOC_DAPM_SINGLE_AUTODISABLE("I003 Switch", AFE_CONN177, 3, 1, 0),
    401	SOC_DAPM_SINGLE_AUTODISABLE("I021 Switch", AFE_CONN177, 21, 1, 0),
    402	SOC_DAPM_SINGLE_AUTODISABLE("I023 Switch", AFE_CONN177, 23, 1, 0),
    403	SOC_DAPM_SINGLE_AUTODISABLE("I071 Switch", AFE_CONN177_2, 7, 1, 0),
    404};
    405
    406static const char * const adda_dlgain_mux_map[] = {
    407	"Bypass", "Connect",
    408};
    409
    410static SOC_ENUM_SINGLE_DECL(adda_dlgain_mux_map_enum,
    411			    SND_SOC_NOPM, 0,
    412			    adda_dlgain_mux_map);
    413
    414static const struct snd_kcontrol_new adda_dlgain_mux_control =
    415	SOC_DAPM_ENUM("DL_GAIN_MUX", adda_dlgain_mux_map_enum);
    416
    417static const struct snd_soc_dapm_widget mtk_dai_adda_widgets[] = {
    418	SND_SOC_DAPM_MIXER("I168", SND_SOC_NOPM, 0, 0, NULL, 0),
    419	SND_SOC_DAPM_MIXER("I169", SND_SOC_NOPM, 0, 0, NULL, 0),
    420	SND_SOC_DAPM_MIXER("I170", SND_SOC_NOPM, 0, 0, NULL, 0),
    421	SND_SOC_DAPM_MIXER("I171", SND_SOC_NOPM, 0, 0, NULL, 0),
    422
    423	SND_SOC_DAPM_MIXER("O176", SND_SOC_NOPM, 0, 0,
    424			   mtk_dai_adda_o176_mix,
    425			   ARRAY_SIZE(mtk_dai_adda_o176_mix)),
    426	SND_SOC_DAPM_MIXER("O177", SND_SOC_NOPM, 0, 0,
    427			   mtk_dai_adda_o177_mix,
    428			   ARRAY_SIZE(mtk_dai_adda_o177_mix)),
    429
    430	SND_SOC_DAPM_SUPPLY_S("ADDA Enable", SUPPLY_SEQ_ADDA_AFE_ON,
    431			      AFE_ADDA_UL_DL_CON0,
    432			      ADDA_AFE_ON_SHIFT, 0,
    433			      NULL,
    434			      0),
    435
    436	SND_SOC_DAPM_SUPPLY_S("ADDA Playback Enable", SUPPLY_SEQ_ADDA_DL_ON,
    437			      AFE_ADDA_DL_SRC2_CON0,
    438			      DL_2_SRC_ON_TMP_CTRL_PRE_SHIFT, 0,
    439			      mtk_adda_dl_event,
    440			      SND_SOC_DAPM_POST_PMD),
    441
    442	SND_SOC_DAPM_SUPPLY_S("ADDA Capture Enable", SUPPLY_SEQ_ADDA_UL_ON,
    443			      AFE_ADDA_UL_SRC_CON0,
    444			      UL_SRC_ON_TMP_CTL_SHIFT, 0,
    445			      mtk_adda_ul_event,
    446			      SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
    447
    448	SND_SOC_DAPM_SUPPLY_S("ADDA6 Capture Enable", SUPPLY_SEQ_ADDA_UL_ON,
    449			      AFE_ADDA6_UL_SRC_CON0,
    450			      UL_SRC_ON_TMP_CTL_SHIFT, 0,
    451			      mtk_adda6_ul_event,
    452			      SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
    453
    454	SND_SOC_DAPM_SUPPLY_S("AUDIO_HIRES", SUPPLY_SEQ_CLOCK_SEL,
    455			      SND_SOC_NOPM,
    456			      0, 0,
    457			      mtk_audio_hires_event,
    458			      SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
    459
    460	SND_SOC_DAPM_SUPPLY_S("ADDA_MTKAIF_CFG", SUPPLY_SEQ_ADDA_MTKAIF_CFG,
    461			      SND_SOC_NOPM,
    462			      0, 0,
    463			      mtk_adda_mtkaif_cfg_event,
    464			      SND_SOC_DAPM_PRE_PMU),
    465
    466	SND_SOC_DAPM_MUX("DL_GAIN_MUX", SND_SOC_NOPM, 0, 0,
    467			 &adda_dlgain_mux_control),
    468
    469	SND_SOC_DAPM_PGA("DL_GAIN", AFE_ADDA_DL_SRC2_CON0,
    470			 DL_2_GAIN_ON_CTL_PRE_SHIFT, 0, NULL, 0),
    471
    472	SND_SOC_DAPM_INPUT("ADDA_INPUT"),
    473	SND_SOC_DAPM_OUTPUT("ADDA_OUTPUT"),
    474
    475	SND_SOC_DAPM_CLOCK_SUPPLY("aud_dac"),
    476	SND_SOC_DAPM_CLOCK_SUPPLY("aud_adc"),
    477	SND_SOC_DAPM_CLOCK_SUPPLY("aud_adda6_adc"),
    478	SND_SOC_DAPM_CLOCK_SUPPLY("aud_dac_hires"),
    479	SND_SOC_DAPM_CLOCK_SUPPLY("aud_adc_hires"),
    480	SND_SOC_DAPM_CLOCK_SUPPLY("aud_adda6_adc_hires"),
    481};
    482
    483static const struct snd_soc_dapm_route mtk_dai_adda_routes[] = {
    484	{"ADDA Capture", NULL, "ADDA Enable"},
    485	{"ADDA Capture", NULL, "ADDA Capture Enable"},
    486	{"ADDA Capture", NULL, "ADDA_MTKAIF_CFG"},
    487	{"ADDA Capture", NULL, "aud_adc"},
    488	{"ADDA Capture", NULL, "aud_adc_hires", mtk_afe_adda_hires_connect},
    489	{"aud_adc_hires", NULL, "AUDIO_HIRES"},
    490
    491	{"ADDA6 Capture", NULL, "ADDA Enable"},
    492	{"ADDA6 Capture", NULL, "ADDA6 Capture Enable"},
    493	{"ADDA6 Capture", NULL, "ADDA_MTKAIF_CFG"},
    494	{"ADDA6 Capture", NULL, "aud_adda6_adc"},
    495	{"ADDA6 Capture", NULL, "aud_adda6_adc_hires",
    496	mtk_afe_adda_hires_connect},
    497	{"aud_adda6_adc_hires", NULL, "AUDIO_HIRES"},
    498
    499	{"I168", NULL, "ADDA Capture"},
    500	{"I169", NULL, "ADDA Capture"},
    501	{"I170", NULL, "ADDA6 Capture"},
    502	{"I171", NULL, "ADDA6 Capture"},
    503
    504	{"ADDA Playback", NULL, "ADDA Enable"},
    505	{"ADDA Playback", NULL, "ADDA Playback Enable"},
    506	{"ADDA Playback", NULL, "aud_dac"},
    507	{"ADDA Playback", NULL, "aud_dac_hires", mtk_afe_adda_hires_connect},
    508	{"aud_dac_hires", NULL, "AUDIO_HIRES"},
    509
    510	{"DL_GAIN", NULL, "O176"},
    511	{"DL_GAIN", NULL, "O177"},
    512
    513	{"DL_GAIN_MUX", "Bypass", "O176"},
    514	{"DL_GAIN_MUX", "Bypass", "O177"},
    515	{"DL_GAIN_MUX", "Connect", "DL_GAIN"},
    516
    517	{"ADDA Playback", NULL, "DL_GAIN_MUX"},
    518
    519	{"O176", "I000 Switch", "I000"},
    520	{"O177", "I001 Switch", "I001"},
    521
    522	{"O176", "I002 Switch", "I002"},
    523	{"O177", "I003 Switch", "I003"},
    524
    525	{"O176", "I020 Switch", "I020"},
    526	{"O177", "I021 Switch", "I021"},
    527
    528	{"O176", "I022 Switch", "I022"},
    529	{"O177", "I023 Switch", "I023"},
    530
    531	{"O176", "I070 Switch", "I070"},
    532	{"O177", "I071 Switch", "I071"},
    533
    534	{"ADDA Capture", NULL, "ADDA_INPUT"},
    535	{"ADDA6 Capture", NULL, "ADDA_INPUT"},
    536	{"ADDA_OUTPUT", NULL, "ADDA Playback"},
    537};
    538
    539static int mt8195_adda_dl_gain_put(struct snd_kcontrol *kcontrol,
    540				   struct snd_ctl_elem_value *ucontrol)
    541{
    542	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
    543	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
    544	unsigned int reg = AFE_ADDA_DL_SRC2_CON1;
    545	unsigned int mask = DL_2_GAIN_CTL_PRE_MASK;
    546	unsigned int value = (unsigned int)(ucontrol->value.integer.value[0]);
    547
    548	regmap_update_bits(afe->regmap, reg, mask, DL_2_GAIN_CTL_PRE(value));
    549	return 0;
    550}
    551
    552static int mt8195_adda_dl_gain_get(struct snd_kcontrol *kcontrol,
    553				   struct snd_ctl_elem_value *ucontrol)
    554{
    555	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
    556	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(component);
    557	unsigned int reg = AFE_ADDA_DL_SRC2_CON1;
    558	unsigned int mask = DL_2_GAIN_CTL_PRE_MASK;
    559	unsigned int value = 0;
    560
    561	regmap_read(afe->regmap, reg, &value);
    562
    563	ucontrol->value.integer.value[0] = ((value & mask) >>
    564					    DL_2_GAIN_CTL_PRE_SHIFT);
    565	return 0;
    566}
    567
    568static int mt8195_adda6_only_get(struct snd_kcontrol *kcontrol,
    569				 struct snd_ctl_elem_value *ucontrol)
    570{
    571	struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol);
    572	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    573	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    574	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    575
    576	ucontrol->value.integer.value[0] = param->mtkaif_adda6_only;
    577	return 0;
    578}
    579
    580static int mt8195_adda6_only_set(struct snd_kcontrol *kcontrol,
    581				 struct snd_ctl_elem_value *ucontrol)
    582{
    583	struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol);
    584	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    585	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    586	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    587	int mtkaif_adda6_only;
    588
    589	mtkaif_adda6_only = ucontrol->value.integer.value[0];
    590
    591	dev_info(afe->dev, "%s(), kcontrol name %s, mtkaif_adda6_only %d\n",
    592		 __func__, kcontrol->id.name, mtkaif_adda6_only);
    593
    594	param->mtkaif_adda6_only = mtkaif_adda6_only;
    595
    596	return 0;
    597}
    598
    599static int mt8195_adda_dmic_get(struct snd_kcontrol *kcontrol,
    600				struct snd_ctl_elem_value *ucontrol)
    601{
    602	struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol);
    603	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    604	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    605	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    606
    607	ucontrol->value.integer.value[0] = param->mtkaif_dmic_on;
    608	return 0;
    609}
    610
    611static int mt8195_adda_dmic_set(struct snd_kcontrol *kcontrol,
    612				struct snd_ctl_elem_value *ucontrol)
    613{
    614	struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol);
    615	struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt);
    616	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    617	struct mtkaif_param *param = &afe_priv->mtkaif_params;
    618	int dmic_on;
    619
    620	dmic_on = ucontrol->value.integer.value[0];
    621
    622	dev_dbg(afe->dev, "%s(), kcontrol name %s, dmic_on %d\n",
    623		__func__, kcontrol->id.name, dmic_on);
    624
    625	param->mtkaif_dmic_on = dmic_on;
    626	return 0;
    627}
    628
    629static const struct snd_kcontrol_new mtk_dai_adda_controls[] = {
    630	SOC_SINGLE_EXT("ADDA_DL_Gain", SND_SOC_NOPM, 0, 65535, 0,
    631		       mt8195_adda_dl_gain_get, mt8195_adda_dl_gain_put),
    632	SOC_SINGLE_BOOL_EXT("MTKAIF_DMIC", 0,
    633			    mt8195_adda_dmic_get, mt8195_adda_dmic_set),
    634	SOC_SINGLE_BOOL_EXT("MTKAIF_ADDA6_ONLY", 0,
    635			    mt8195_adda6_only_get,
    636			    mt8195_adda6_only_set),
    637};
    638
    639static int mtk_dai_da_configure(struct mtk_base_afe *afe,
    640				unsigned int rate, int id)
    641{
    642	unsigned int val = 0;
    643	unsigned int mask = 0;
    644
    645	/* set sampling rate */
    646	mask |= DL_2_INPUT_MODE_CTL_MASK;
    647	val |= DL_2_INPUT_MODE_CTL(afe_adda_dl_rate_transform(afe, rate));
    648
    649	/* turn off saturation */
    650	mask |= DL_2_CH1_SATURATION_EN_CTL;
    651	mask |= DL_2_CH2_SATURATION_EN_CTL;
    652
    653	/* turn off mute function */
    654	mask |= DL_2_MUTE_CH1_OFF_CTL_PRE;
    655	mask |= DL_2_MUTE_CH2_OFF_CTL_PRE;
    656	val |= DL_2_MUTE_CH1_OFF_CTL_PRE;
    657	val |= DL_2_MUTE_CH2_OFF_CTL_PRE;
    658
    659	/* set voice input data if input sample rate is 8k or 16k */
    660	mask |= DL_2_VOICE_MODE_CTL_PRE;
    661	if (rate == 8000 || rate == 16000)
    662		val |= DL_2_VOICE_MODE_CTL_PRE;
    663
    664	regmap_update_bits(afe->regmap, AFE_ADDA_DL_SRC2_CON0, mask, val);
    665
    666	mask = 0;
    667	val = 0;
    668
    669	/* new 2nd sdm */
    670	mask |= DL_USE_NEW_2ND_SDM;
    671	val |= DL_USE_NEW_2ND_SDM;
    672	regmap_update_bits(afe->regmap, AFE_ADDA_DL_SDM_DCCOMP_CON, mask, val);
    673
    674	return 0;
    675}
    676
    677static int mtk_dai_ad_configure(struct mtk_base_afe *afe,
    678				unsigned int rate, int id)
    679{
    680	unsigned int val = 0;
    681	unsigned int mask = 0;
    682
    683	mask |= UL_VOICE_MODE_CTL_MASK;
    684	val |= UL_VOICE_MODE_CTL(afe_adda_ul_rate_transform(afe, rate));
    685
    686	switch (id) {
    687	case MT8195_AFE_IO_UL_SRC1:
    688		regmap_update_bits(afe->regmap, AFE_ADDA_UL_SRC_CON0,
    689				   mask, val);
    690		break;
    691	case MT8195_AFE_IO_UL_SRC2:
    692		regmap_update_bits(afe->regmap, AFE_ADDA6_UL_SRC_CON0,
    693				   mask, val);
    694		break;
    695	default:
    696		break;
    697	}
    698	return 0;
    699}
    700
    701static int mtk_dai_adda_hw_params(struct snd_pcm_substream *substream,
    702				  struct snd_pcm_hw_params *params,
    703				  struct snd_soc_dai *dai)
    704{
    705	struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai);
    706	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    707	struct mtk_dai_adda_priv *adda_priv = afe_priv->dai_priv[dai->id];
    708	unsigned int rate = params_rate(params);
    709	int id = dai->id;
    710	int ret = 0;
    711
    712	dev_dbg(afe->dev, "%s(), id %d, stream %d, rate %d\n",
    713		__func__, id, substream->stream, rate);
    714
    715	if (rate > ADDA_HIRES_THRES)
    716		adda_priv->hires_required = 1;
    717	else
    718		adda_priv->hires_required = 0;
    719
    720	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
    721		ret = mtk_dai_da_configure(afe, rate, id);
    722	else
    723		ret = mtk_dai_ad_configure(afe, rate, id);
    724
    725	return ret;
    726}
    727
    728static const struct snd_soc_dai_ops mtk_dai_adda_ops = {
    729	.hw_params = mtk_dai_adda_hw_params,
    730};
    731
    732/* dai driver */
    733#define MTK_ADDA_PLAYBACK_RATES (SNDRV_PCM_RATE_8000_48000 |\
    734				 SNDRV_PCM_RATE_96000 |\
    735				 SNDRV_PCM_RATE_192000)
    736
    737#define MTK_ADDA_CAPTURE_RATES (SNDRV_PCM_RATE_8000 |\
    738				SNDRV_PCM_RATE_16000 |\
    739				SNDRV_PCM_RATE_32000 |\
    740				SNDRV_PCM_RATE_48000 |\
    741				SNDRV_PCM_RATE_96000 |\
    742				SNDRV_PCM_RATE_192000)
    743
    744#define MTK_ADDA_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
    745			  SNDRV_PCM_FMTBIT_S24_LE |\
    746			  SNDRV_PCM_FMTBIT_S32_LE)
    747
    748static struct snd_soc_dai_driver mtk_dai_adda_driver[] = {
    749	{
    750		.name = "DL_SRC",
    751		.id = MT8195_AFE_IO_DL_SRC,
    752		.playback = {
    753			.stream_name = "ADDA Playback",
    754			.channels_min = 1,
    755			.channels_max = 2,
    756			.rates = MTK_ADDA_PLAYBACK_RATES,
    757			.formats = MTK_ADDA_FORMATS,
    758		},
    759		.ops = &mtk_dai_adda_ops,
    760	},
    761	{
    762		.name = "UL_SRC1",
    763		.id = MT8195_AFE_IO_UL_SRC1,
    764		.capture = {
    765			.stream_name = "ADDA Capture",
    766			.channels_min = 1,
    767			.channels_max = 2,
    768			.rates = MTK_ADDA_CAPTURE_RATES,
    769			.formats = MTK_ADDA_FORMATS,
    770		},
    771		.ops = &mtk_dai_adda_ops,
    772	},
    773	{
    774		.name = "UL_SRC2",
    775		.id = MT8195_AFE_IO_UL_SRC2,
    776		.capture = {
    777			.stream_name = "ADDA6 Capture",
    778			.channels_min = 1,
    779			.channels_max = 2,
    780			.rates = MTK_ADDA_CAPTURE_RATES,
    781			.formats = MTK_ADDA_FORMATS,
    782		},
    783		.ops = &mtk_dai_adda_ops,
    784	},
    785};
    786
    787static int init_adda_priv_data(struct mtk_base_afe *afe)
    788{
    789	struct mt8195_afe_private *afe_priv = afe->platform_priv;
    790	struct mtk_dai_adda_priv *adda_priv;
    791	static const int adda_dai_list[] = {
    792		MT8195_AFE_IO_DL_SRC,
    793		MT8195_AFE_IO_UL_SRC1,
    794		MT8195_AFE_IO_UL_SRC2
    795	};
    796	int i;
    797
    798	for (i = 0; i < ARRAY_SIZE(adda_dai_list); i++) {
    799		adda_priv = devm_kzalloc(afe->dev,
    800					 sizeof(struct mtk_dai_adda_priv),
    801					 GFP_KERNEL);
    802		if (!adda_priv)
    803			return -ENOMEM;
    804
    805		afe_priv->dai_priv[adda_dai_list[i]] = adda_priv;
    806	}
    807
    808	return 0;
    809}
    810
    811int mt8195_dai_adda_register(struct mtk_base_afe *afe)
    812{
    813	struct mtk_base_afe_dai *dai;
    814
    815	dai = devm_kzalloc(afe->dev, sizeof(*dai), GFP_KERNEL);
    816	if (!dai)
    817		return -ENOMEM;
    818
    819	list_add(&dai->list, &afe->sub_dais);
    820
    821	dai->dai_drivers = mtk_dai_adda_driver;
    822	dai->num_dai_drivers = ARRAY_SIZE(mtk_dai_adda_driver);
    823
    824	dai->dapm_widgets = mtk_dai_adda_widgets;
    825	dai->num_dapm_widgets = ARRAY_SIZE(mtk_dai_adda_widgets);
    826	dai->dapm_routes = mtk_dai_adda_routes;
    827	dai->num_dapm_routes = ARRAY_SIZE(mtk_dai_adda_routes);
    828	dai->controls = mtk_dai_adda_controls;
    829	dai->num_controls = ARRAY_SIZE(mtk_dai_adda_controls);
    830
    831	return init_adda_priv_data(afe);
    832}