// SPDX-License-Identifier: GPL-2.0-only // Copyright (c) 2018-2020, The Linux Foundation. All rights reserved. #include #include #include #include #include #include #include #include #include #include #include #include #define CDC_TX_CLK_RST_CTRL_MCLK_CONTROL (0x0000) #define CDC_TX_MCLK_EN_MASK BIT(0) #define CDC_TX_MCLK_ENABLE BIT(0) #define CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL (0x0004) #define CDC_TX_FS_CNT_EN_MASK BIT(0) #define CDC_TX_FS_CNT_ENABLE BIT(0) #define CDC_TX_CLK_RST_CTRL_SWR_CONTROL (0x0008) #define CDC_TX_SWR_RESET_MASK BIT(1) #define CDC_TX_SWR_RESET_ENABLE BIT(1) #define CDC_TX_SWR_CLK_EN_MASK BIT(0) #define CDC_TX_SWR_CLK_ENABLE BIT(0) #define CDC_TX_TOP_CSR_TOP_CFG0 (0x0080) #define CDC_TX_TOP_CSR_ANC_CFG (0x0084) #define CDC_TX_TOP_CSR_SWR_CTRL (0x0088) #define CDC_TX_TOP_CSR_FREQ_MCLK (0x0090) #define CDC_TX_TOP_CSR_DEBUG_BUS (0x0094) #define CDC_TX_TOP_CSR_DEBUG_EN (0x0098) #define CDC_TX_TOP_CSR_TX_I2S_CTL (0x00A4) #define CDC_TX_TOP_CSR_I2S_CLK (0x00A8) #define CDC_TX_TOP_CSR_I2S_RESET (0x00AC) #define CDC_TX_TOP_CSR_SWR_DMICn_CTL(n) (0x00C0 + n * 0x4) #define CDC_TX_TOP_CSR_SWR_DMIC0_CTL (0x00C0) #define CDC_TX_SWR_DMIC_CLK_SEL_MASK GENMASK(3, 1) #define CDC_TX_TOP_CSR_SWR_DMIC1_CTL (0x00C4) #define CDC_TX_TOP_CSR_SWR_DMIC2_CTL (0x00C8) #define CDC_TX_TOP_CSR_SWR_DMIC3_CTL (0x00CC) #define CDC_TX_TOP_CSR_SWR_AMIC0_CTL (0x00D0) #define CDC_TX_TOP_CSR_SWR_AMIC1_CTL (0x00D4) #define CDC_TX_INP_MUX_ADC_MUXn_CFG0(n) (0x0100 + 0x8 * n) #define CDC_TX_MACRO_SWR_MIC_MUX_SEL_MASK GENMASK(3, 0) #define CDC_TX_INP_MUX_ADC_MUX0_CFG0 (0x0100) #define CDC_TX_INP_MUX_ADC_MUXn_CFG1(n) (0x0104 + 0x8 * n) #define CDC_TX_INP_MUX_ADC_MUX0_CFG1 (0x0104) #define CDC_TX_INP_MUX_ADC_MUX1_CFG0 (0x0108) #define CDC_TX_INP_MUX_ADC_MUX1_CFG1 (0x010C) #define CDC_TX_INP_MUX_ADC_MUX2_CFG0 (0x0110) #define CDC_TX_INP_MUX_ADC_MUX2_CFG1 (0x0114) #define CDC_TX_INP_MUX_ADC_MUX3_CFG0 (0x0118) #define CDC_TX_INP_MUX_ADC_MUX3_CFG1 (0x011C) #define CDC_TX_INP_MUX_ADC_MUX4_CFG0 (0x0120) #define CDC_TX_INP_MUX_ADC_MUX4_CFG1 (0x0124) #define CDC_TX_INP_MUX_ADC_MUX5_CFG0 (0x0128) #define CDC_TX_INP_MUX_ADC_MUX5_CFG1 (0x012C) #define CDC_TX_INP_MUX_ADC_MUX6_CFG0 (0x0130) #define CDC_TX_INP_MUX_ADC_MUX6_CFG1 (0x0134) #define CDC_TX_INP_MUX_ADC_MUX7_CFG0 (0x0138) #define CDC_TX_INP_MUX_ADC_MUX7_CFG1 (0x013C) #define CDC_TX_ANC0_CLK_RESET_CTL (0x0200) #define CDC_TX_ANC0_MODE_1_CTL (0x0204) #define CDC_TX_ANC0_MODE_2_CTL (0x0208) #define CDC_TX_ANC0_FF_SHIFT (0x020C) #define CDC_TX_ANC0_FB_SHIFT (0x0210) #define CDC_TX_ANC0_LPF_FF_A_CTL (0x0214) #define CDC_TX_ANC0_LPF_FF_B_CTL (0x0218) #define CDC_TX_ANC0_LPF_FB_CTL (0x021C) #define CDC_TX_ANC0_SMLPF_CTL (0x0220) #define CDC_TX_ANC0_DCFLT_SHIFT_CTL (0x0224) #define CDC_TX_ANC0_IIR_ADAPT_CTL (0x0228) #define CDC_TX_ANC0_IIR_COEFF_1_CTL (0x022C) #define CDC_TX_ANC0_IIR_COEFF_2_CTL (0x0230) #define CDC_TX_ANC0_FF_A_GAIN_CTL (0x0234) #define CDC_TX_ANC0_FF_B_GAIN_CTL (0x0238) #define CDC_TX_ANC0_FB_GAIN_CTL (0x023C) #define CDC_TXn_TX_PATH_CTL(n) (0x0400 + 0x80 * n) #define CDC_TXn_PCM_RATE_MASK GENMASK(3, 0) #define CDC_TXn_PGA_MUTE_MASK BIT(4) #define CDC_TXn_CLK_EN_MASK BIT(5) #define CDC_TX0_TX_PATH_CTL (0x0400) #define CDC_TXn_TX_PATH_CFG0(n) (0x0404 + 0x80 * n) #define CDC_TX0_TX_PATH_CFG0 (0x0404) #define CDC_TXn_PH_EN_MASK BIT(0) #define CDC_TXn_ADC_MODE_MASK GENMASK(2, 1) #define CDC_TXn_HPF_CUT_FREQ_MASK GENMASK(6, 5) #define CDC_TXn_ADC_DMIC_SEL_MASK BIT(7) #define CDC_TX0_TX_PATH_CFG1 (0x0408) #define CDC_TXn_TX_VOL_CTL(n) (0x040C + 0x80 * n) #define CDC_TX0_TX_VOL_CTL (0x040C) #define CDC_TX0_TX_PATH_SEC0 (0x0410) #define CDC_TX0_TX_PATH_SEC1 (0x0414) #define CDC_TXn_TX_PATH_SEC2(n) (0x0418 + 0x80 * n) #define CDC_TXn_HPF_F_CHANGE_MASK BIT(1) #define CDC_TXn_HPF_ZERO_GATE_MASK BIT(0) #define CDC_TX0_TX_PATH_SEC2 (0x0418) #define CDC_TX0_TX_PATH_SEC3 (0x041C) #define CDC_TX0_TX_PATH_SEC4 (0x0420) #define CDC_TX0_TX_PATH_SEC5 (0x0424) #define CDC_TX0_TX_PATH_SEC6 (0x0428) #define CDC_TX0_TX_PATH_SEC7 (0x042C) #define CDC_TX0_MBHC_CTL_EN_MASK BIT(6) #define CDC_TX1_TX_PATH_CTL (0x0480) #define CDC_TX1_TX_PATH_CFG0 (0x0484) #define CDC_TX1_TX_PATH_CFG1 (0x0488) #define CDC_TX1_TX_VOL_CTL (0x048C) #define CDC_TX1_TX_PATH_SEC0 (0x0490) #define CDC_TX1_TX_PATH_SEC1 (0x0494) #define CDC_TX1_TX_PATH_SEC2 (0x0498) #define CDC_TX1_TX_PATH_SEC3 (0x049C) #define CDC_TX1_TX_PATH_SEC4 (0x04A0) #define CDC_TX1_TX_PATH_SEC5 (0x04A4) #define CDC_TX1_TX_PATH_SEC6 (0x04A8) #define CDC_TX2_TX_PATH_CTL (0x0500) #define CDC_TX2_TX_PATH_CFG0 (0x0504) #define CDC_TX2_TX_PATH_CFG1 (0x0508) #define CDC_TX2_TX_VOL_CTL (0x050C) #define CDC_TX2_TX_PATH_SEC0 (0x0510) #define CDC_TX2_TX_PATH_SEC1 (0x0514) #define CDC_TX2_TX_PATH_SEC2 (0x0518) #define CDC_TX2_TX_PATH_SEC3 (0x051C) #define CDC_TX2_TX_PATH_SEC4 (0x0520) #define CDC_TX2_TX_PATH_SEC5 (0x0524) #define CDC_TX2_TX_PATH_SEC6 (0x0528) #define CDC_TX3_TX_PATH_CTL (0x0580) #define CDC_TX3_TX_PATH_CFG0 (0x0584) #define CDC_TX3_TX_PATH_CFG1 (0x0588) #define CDC_TX3_TX_VOL_CTL (0x058C) #define CDC_TX3_TX_PATH_SEC0 (0x0590) #define CDC_TX3_TX_PATH_SEC1 (0x0594) #define CDC_TX3_TX_PATH_SEC2 (0x0598) #define CDC_TX3_TX_PATH_SEC3 (0x059C) #define CDC_TX3_TX_PATH_SEC4 (0x05A0) #define CDC_TX3_TX_PATH_SEC5 (0x05A4) #define CDC_TX3_TX_PATH_SEC6 (0x05A8) #define CDC_TX4_TX_PATH_CTL (0x0600) #define CDC_TX4_TX_PATH_CFG0 (0x0604) #define CDC_TX4_TX_PATH_CFG1 (0x0608) #define CDC_TX4_TX_VOL_CTL (0x060C) #define CDC_TX4_TX_PATH_SEC0 (0x0610) #define CDC_TX4_TX_PATH_SEC1 (0x0614) #define CDC_TX4_TX_PATH_SEC2 (0x0618) #define CDC_TX4_TX_PATH_SEC3 (0x061C) #define CDC_TX4_TX_PATH_SEC4 (0x0620) #define CDC_TX4_TX_PATH_SEC5 (0x0624) #define CDC_TX4_TX_PATH_SEC6 (0x0628) #define CDC_TX5_TX_PATH_CTL (0x0680) #define CDC_TX5_TX_PATH_CFG0 (0x0684) #define CDC_TX5_TX_PATH_CFG1 (0x0688) #define CDC_TX5_TX_VOL_CTL (0x068C) #define CDC_TX5_TX_PATH_SEC0 (0x0690) #define CDC_TX5_TX_PATH_SEC1 (0x0694) #define CDC_TX5_TX_PATH_SEC2 (0x0698) #define CDC_TX5_TX_PATH_SEC3 (0x069C) #define CDC_TX5_TX_PATH_SEC4 (0x06A0) #define CDC_TX5_TX_PATH_SEC5 (0x06A4) #define CDC_TX5_TX_PATH_SEC6 (0x06A8) #define CDC_TX6_TX_PATH_CTL (0x0700) #define CDC_TX6_TX_PATH_CFG0 (0x0704) #define CDC_TX6_TX_PATH_CFG1 (0x0708) #define CDC_TX6_TX_VOL_CTL (0x070C) #define CDC_TX6_TX_PATH_SEC0 (0x0710) #define CDC_TX6_TX_PATH_SEC1 (0x0714) #define CDC_TX6_TX_PATH_SEC2 (0x0718) #define CDC_TX6_TX_PATH_SEC3 (0x071C) #define CDC_TX6_TX_PATH_SEC4 (0x0720) #define CDC_TX6_TX_PATH_SEC5 (0x0724) #define CDC_TX6_TX_PATH_SEC6 (0x0728) #define CDC_TX7_TX_PATH_CTL (0x0780) #define CDC_TX7_TX_PATH_CFG0 (0x0784) #define CDC_TX7_TX_PATH_CFG1 (0x0788) #define CDC_TX7_TX_VOL_CTL (0x078C) #define CDC_TX7_TX_PATH_SEC0 (0x0790) #define CDC_TX7_TX_PATH_SEC1 (0x0794) #define CDC_TX7_TX_PATH_SEC2 (0x0798) #define CDC_TX7_TX_PATH_SEC3 (0x079C) #define CDC_TX7_TX_PATH_SEC4 (0x07A0) #define CDC_TX7_TX_PATH_SEC5 (0x07A4) #define CDC_TX7_TX_PATH_SEC6 (0x07A8) #define TX_MAX_OFFSET (0x07A8) #define TX_MACRO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\ SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\ SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000) #define TX_MACRO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\ SNDRV_PCM_FMTBIT_S24_LE |\ SNDRV_PCM_FMTBIT_S24_3LE) #define CF_MIN_3DB_4HZ 0x0 #define CF_MIN_3DB_75HZ 0x1 #define CF_MIN_3DB_150HZ 0x2 #define TX_ADC_MAX 5 #define TX_ADC_TO_DMIC(n) ((n - TX_ADC_MAX)/2) #define NUM_DECIMATORS 8 #define TX_NUM_CLKS_MAX 5 #define TX_MACRO_DMIC_UNMUTE_DELAY_MS 40 #define TX_MACRO_AMIC_UNMUTE_DELAY_MS 100 #define TX_MACRO_DMIC_HPF_DELAY_MS 300 #define TX_MACRO_AMIC_HPF_DELAY_MS 300 #define MCLK_FREQ 19200000 enum { TX_MACRO_AIF_INVALID = 0, TX_MACRO_AIF1_CAP, TX_MACRO_AIF2_CAP, TX_MACRO_AIF3_CAP, TX_MACRO_MAX_DAIS }; enum { TX_MACRO_DEC0, TX_MACRO_DEC1, TX_MACRO_DEC2, TX_MACRO_DEC3, TX_MACRO_DEC4, TX_MACRO_DEC5, TX_MACRO_DEC6, TX_MACRO_DEC7, TX_MACRO_DEC_MAX, }; enum { TX_MACRO_CLK_DIV_2, TX_MACRO_CLK_DIV_3, TX_MACRO_CLK_DIV_4, TX_MACRO_CLK_DIV_6, TX_MACRO_CLK_DIV_8, TX_MACRO_CLK_DIV_16, }; enum { MSM_DMIC, SWR_MIC, ANC_FB_TUNE1 }; struct tx_mute_work { struct tx_macro *tx; u8 decimator; struct delayed_work dwork; }; struct hpf_work { struct tx_macro *tx; u8 decimator; u8 hpf_cut_off_freq; struct delayed_work dwork; }; struct tx_macro { struct device *dev; struct snd_soc_component *component; struct hpf_work tx_hpf_work[NUM_DECIMATORS]; struct tx_mute_work tx_mute_dwork[NUM_DECIMATORS]; unsigned long active_ch_mask[TX_MACRO_MAX_DAIS]; unsigned long active_ch_cnt[TX_MACRO_MAX_DAIS]; unsigned long active_decimator[TX_MACRO_MAX_DAIS]; struct regmap *regmap; struct clk *mclk; struct clk *npl; struct clk *macro; struct clk *dcodec; struct clk *fsgen; struct clk_hw hw; bool dec_active[NUM_DECIMATORS]; bool reset_swr; int tx_mclk_users; u16 dmic_clk_div; bool bcs_enable; int dec_mode[NUM_DECIMATORS]; bool bcs_clk_en; }; #define to_tx_macro(_hw) container_of(_hw, struct tx_macro, hw) static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400); static const struct reg_default tx_defaults[] = { /* TX Macro */ { CDC_TX_CLK_RST_CTRL_MCLK_CONTROL, 0x00 }, { CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL, 0x00 }, { CDC_TX_CLK_RST_CTRL_SWR_CONTROL, 0x00}, { CDC_TX_TOP_CSR_TOP_CFG0, 0x00}, { CDC_TX_TOP_CSR_ANC_CFG, 0x00}, { CDC_TX_TOP_CSR_SWR_CTRL, 0x00}, { CDC_TX_TOP_CSR_FREQ_MCLK, 0x00}, { CDC_TX_TOP_CSR_DEBUG_BUS, 0x00}, { CDC_TX_TOP_CSR_DEBUG_EN, 0x00}, { CDC_TX_TOP_CSR_TX_I2S_CTL, 0x0C}, { CDC_TX_TOP_CSR_I2S_CLK, 0x00}, { CDC_TX_TOP_CSR_I2S_RESET, 0x00}, { CDC_TX_TOP_CSR_SWR_DMIC0_CTL, 0x00}, { CDC_TX_TOP_CSR_SWR_DMIC1_CTL, 0x00}, { CDC_TX_TOP_CSR_SWR_DMIC2_CTL, 0x00}, { CDC_TX_TOP_CSR_SWR_DMIC3_CTL, 0x00}, { CDC_TX_TOP_CSR_SWR_AMIC0_CTL, 0x00}, { CDC_TX_TOP_CSR_SWR_AMIC1_CTL, 0x00}, { CDC_TX_INP_MUX_ADC_MUX0_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX0_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX1_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX1_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX2_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX2_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX3_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX3_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX4_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX4_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX5_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX5_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX6_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX6_CFG1, 0x00}, { CDC_TX_INP_MUX_ADC_MUX7_CFG0, 0x00}, { CDC_TX_INP_MUX_ADC_MUX7_CFG1, 0x00}, { CDC_TX_ANC0_CLK_RESET_CTL, 0x00}, { CDC_TX_ANC0_MODE_1_CTL, 0x00}, { CDC_TX_ANC0_MODE_2_CTL, 0x00}, { CDC_TX_ANC0_FF_SHIFT, 0x00}, { CDC_TX_ANC0_FB_SHIFT, 0x00}, { CDC_TX_ANC0_LPF_FF_A_CTL, 0x00}, { CDC_TX_ANC0_LPF_FF_B_CTL, 0x00}, { CDC_TX_ANC0_LPF_FB_CTL, 0x00}, { CDC_TX_ANC0_SMLPF_CTL, 0x00}, { CDC_TX_ANC0_DCFLT_SHIFT_CTL, 0x00}, { CDC_TX_ANC0_IIR_ADAPT_CTL, 0x00}, { CDC_TX_ANC0_IIR_COEFF_1_CTL, 0x00}, { CDC_TX_ANC0_IIR_COEFF_2_CTL, 0x00}, { CDC_TX_ANC0_FF_A_GAIN_CTL, 0x00}, { CDC_TX_ANC0_FF_B_GAIN_CTL, 0x00}, { CDC_TX_ANC0_FB_GAIN_CTL, 0x00}, { CDC_TX0_TX_PATH_CTL, 0x04}, { CDC_TX0_TX_PATH_CFG0, 0x10}, { CDC_TX0_TX_PATH_CFG1, 0x0B}, { CDC_TX0_TX_VOL_CTL, 0x00}, { CDC_TX0_TX_PATH_SEC0, 0x00}, { CDC_TX0_TX_PATH_SEC1, 0x00}, { CDC_TX0_TX_PATH_SEC2, 0x01}, { CDC_TX0_TX_PATH_SEC3, 0x3C}, { CDC_TX0_TX_PATH_SEC4, 0x20}, { CDC_TX0_TX_PATH_SEC5, 0x00}, { CDC_TX0_TX_PATH_SEC6, 0x00}, { CDC_TX0_TX_PATH_SEC7, 0x25}, { CDC_TX1_TX_PATH_CTL, 0x04}, { CDC_TX1_TX_PATH_CFG0, 0x10}, { CDC_TX1_TX_PATH_CFG1, 0x0B}, { CDC_TX1_TX_VOL_CTL, 0x00}, { CDC_TX1_TX_PATH_SEC0, 0x00}, { CDC_TX1_TX_PATH_SEC1, 0x00}, { CDC_TX1_TX_PATH_SEC2, 0x01}, { CDC_TX1_TX_PATH_SEC3, 0x3C}, { CDC_TX1_TX_PATH_SEC4, 0x20}, { CDC_TX1_TX_PATH_SEC5, 0x00}, { CDC_TX1_TX_PATH_SEC6, 0x00}, { CDC_TX2_TX_PATH_CTL, 0x04}, { CDC_TX2_TX_PATH_CFG0, 0x10}, { CDC_TX2_TX_PATH_CFG1, 0x0B}, { CDC_TX2_TX_VOL_CTL, 0x00}, { CDC_TX2_TX_PATH_SEC0, 0x00}, { CDC_TX2_TX_PATH_SEC1, 0x00}, { CDC_TX2_TX_PATH_SEC2, 0x01}, { CDC_TX2_TX_PATH_SEC3, 0x3C}, { CDC_TX2_TX_PATH_SEC4, 0x20}, { CDC_TX2_TX_PATH_SEC5, 0x00}, { CDC_TX2_TX_PATH_SEC6, 0x00}, { CDC_TX3_TX_PATH_CTL, 0x04}, { CDC_TX3_TX_PATH_CFG0, 0x10}, { CDC_TX3_TX_PATH_CFG1, 0x0B}, { CDC_TX3_TX_VOL_CTL, 0x00}, { CDC_TX3_TX_PATH_SEC0, 0x00}, { CDC_TX3_TX_PATH_SEC1, 0x00}, { CDC_TX3_TX_PATH_SEC2, 0x01}, { CDC_TX3_TX_PATH_SEC3, 0x3C}, { CDC_TX3_TX_PATH_SEC4, 0x20}, { CDC_TX3_TX_PATH_SEC5, 0x00}, { CDC_TX3_TX_PATH_SEC6, 0x00}, { CDC_TX4_TX_PATH_CTL, 0x04}, { CDC_TX4_TX_PATH_CFG0, 0x10}, { CDC_TX4_TX_PATH_CFG1, 0x0B}, { CDC_TX4_TX_VOL_CTL, 0x00}, { CDC_TX4_TX_PATH_SEC0, 0x00}, { CDC_TX4_TX_PATH_SEC1, 0x00}, { CDC_TX4_TX_PATH_SEC2, 0x01}, { CDC_TX4_TX_PATH_SEC3, 0x3C}, { CDC_TX4_TX_PATH_SEC4, 0x20}, { CDC_TX4_TX_PATH_SEC5, 0x00}, { CDC_TX4_TX_PATH_SEC6, 0x00}, { CDC_TX5_TX_PATH_CTL, 0x04}, { CDC_TX5_TX_PATH_CFG0, 0x10}, { CDC_TX5_TX_PATH_CFG1, 0x0B}, { CDC_TX5_TX_VOL_CTL, 0x00}, { CDC_TX5_TX_PATH_SEC0, 0x00}, { CDC_TX5_TX_PATH_SEC1, 0x00}, { CDC_TX5_TX_PATH_SEC2, 0x01}, { CDC_TX5_TX_PATH_SEC3, 0x3C}, { CDC_TX5_TX_PATH_SEC4, 0x20}, { CDC_TX5_TX_PATH_SEC5, 0x00}, { CDC_TX5_TX_PATH_SEC6, 0x00}, { CDC_TX6_TX_PATH_CTL, 0x04}, { CDC_TX6_TX_PATH_CFG0, 0x10}, { CDC_TX6_TX_PATH_CFG1, 0x0B}, { CDC_TX6_TX_VOL_CTL, 0x00}, { CDC_TX6_TX_PATH_SEC0, 0x00}, { CDC_TX6_TX_PATH_SEC1, 0x00}, { CDC_TX6_TX_PATH_SEC2, 0x01}, { CDC_TX6_TX_PATH_SEC3, 0x3C}, { CDC_TX6_TX_PATH_SEC4, 0x20}, { CDC_TX6_TX_PATH_SEC5, 0x00}, { CDC_TX6_TX_PATH_SEC6, 0x00}, { CDC_TX7_TX_PATH_CTL, 0x04}, { CDC_TX7_TX_PATH_CFG0, 0x10}, { CDC_TX7_TX_PATH_CFG1, 0x0B}, { CDC_TX7_TX_VOL_CTL, 0x00}, { CDC_TX7_TX_PATH_SEC0, 0x00}, { CDC_TX7_TX_PATH_SEC1, 0x00}, { CDC_TX7_TX_PATH_SEC2, 0x01}, { CDC_TX7_TX_PATH_SEC3, 0x3C}, { CDC_TX7_TX_PATH_SEC4, 0x20}, { CDC_TX7_TX_PATH_SEC5, 0x00}, { CDC_TX7_TX_PATH_SEC6, 0x00}, }; static bool tx_is_volatile_register(struct device *dev, unsigned int reg) { /* Update volatile list for tx/tx macros */ switch (reg) { case CDC_TX_TOP_CSR_SWR_DMIC0_CTL: case CDC_TX_TOP_CSR_SWR_DMIC1_CTL: case CDC_TX_TOP_CSR_SWR_DMIC2_CTL: case CDC_TX_TOP_CSR_SWR_DMIC3_CTL: return true; } return false; } static bool tx_is_rw_register(struct device *dev, unsigned int reg) { switch (reg) { case CDC_TX_CLK_RST_CTRL_MCLK_CONTROL: case CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL: case CDC_TX_CLK_RST_CTRL_SWR_CONTROL: case CDC_TX_TOP_CSR_TOP_CFG0: case CDC_TX_TOP_CSR_ANC_CFG: case CDC_TX_TOP_CSR_SWR_CTRL: case CDC_TX_TOP_CSR_FREQ_MCLK: case CDC_TX_TOP_CSR_DEBUG_BUS: case CDC_TX_TOP_CSR_DEBUG_EN: case CDC_TX_TOP_CSR_TX_I2S_CTL: case CDC_TX_TOP_CSR_I2S_CLK: case CDC_TX_TOP_CSR_I2S_RESET: case CDC_TX_TOP_CSR_SWR_DMIC0_CTL: case CDC_TX_TOP_CSR_SWR_DMIC1_CTL: case CDC_TX_TOP_CSR_SWR_DMIC2_CTL: case CDC_TX_TOP_CSR_SWR_DMIC3_CTL: case CDC_TX_TOP_CSR_SWR_AMIC0_CTL: case CDC_TX_TOP_CSR_SWR_AMIC1_CTL: case CDC_TX_ANC0_CLK_RESET_CTL: case CDC_TX_ANC0_MODE_1_CTL: case CDC_TX_ANC0_MODE_2_CTL: case CDC_TX_ANC0_FF_SHIFT: case CDC_TX_ANC0_FB_SHIFT: case CDC_TX_ANC0_LPF_FF_A_CTL: case CDC_TX_ANC0_LPF_FF_B_CTL: case CDC_TX_ANC0_LPF_FB_CTL: case CDC_TX_ANC0_SMLPF_CTL: case CDC_TX_ANC0_DCFLT_SHIFT_CTL: case CDC_TX_ANC0_IIR_ADAPT_CTL: case CDC_TX_ANC0_IIR_COEFF_1_CTL: case CDC_TX_ANC0_IIR_COEFF_2_CTL: case CDC_TX_ANC0_FF_A_GAIN_CTL: case CDC_TX_ANC0_FF_B_GAIN_CTL: case CDC_TX_ANC0_FB_GAIN_CTL: case CDC_TX_INP_MUX_ADC_MUX0_CFG0: case CDC_TX_INP_MUX_ADC_MUX0_CFG1: case CDC_TX_INP_MUX_ADC_MUX1_CFG0: case CDC_TX_INP_MUX_ADC_MUX1_CFG1: case CDC_TX_INP_MUX_ADC_MUX2_CFG0: case CDC_TX_INP_MUX_ADC_MUX2_CFG1: case CDC_TX_INP_MUX_ADC_MUX3_CFG0: case CDC_TX_INP_MUX_ADC_MUX3_CFG1: case CDC_TX_INP_MUX_ADC_MUX4_CFG0: case CDC_TX_INP_MUX_ADC_MUX4_CFG1: case CDC_TX_INP_MUX_ADC_MUX5_CFG0: case CDC_TX_INP_MUX_ADC_MUX5_CFG1: case CDC_TX_INP_MUX_ADC_MUX6_CFG0: case CDC_TX_INP_MUX_ADC_MUX6_CFG1: case CDC_TX_INP_MUX_ADC_MUX7_CFG0: case CDC_TX_INP_MUX_ADC_MUX7_CFG1: case CDC_TX0_TX_PATH_CTL: case CDC_TX0_TX_PATH_CFG0: case CDC_TX0_TX_PATH_CFG1: case CDC_TX0_TX_VOL_CTL: case CDC_TX0_TX_PATH_SEC0: case CDC_TX0_TX_PATH_SEC1: case CDC_TX0_TX_PATH_SEC2: case CDC_TX0_TX_PATH_SEC3: case CDC_TX0_TX_PATH_SEC4: case CDC_TX0_TX_PATH_SEC5: case CDC_TX0_TX_PATH_SEC6: case CDC_TX0_TX_PATH_SEC7: case CDC_TX1_TX_PATH_CTL: case CDC_TX1_TX_PATH_CFG0: case CDC_TX1_TX_PATH_CFG1: case CDC_TX1_TX_VOL_CTL: case CDC_TX1_TX_PATH_SEC0: case CDC_TX1_TX_PATH_SEC1: case CDC_TX1_TX_PATH_SEC2: case CDC_TX1_TX_PATH_SEC3: case CDC_TX1_TX_PATH_SEC4: case CDC_TX1_TX_PATH_SEC5: case CDC_TX1_TX_PATH_SEC6: case CDC_TX2_TX_PATH_CTL: case CDC_TX2_TX_PATH_CFG0: case CDC_TX2_TX_PATH_CFG1: case CDC_TX2_TX_VOL_CTL: case CDC_TX2_TX_PATH_SEC0: case CDC_TX2_TX_PATH_SEC1: case CDC_TX2_TX_PATH_SEC2: case CDC_TX2_TX_PATH_SEC3: case CDC_TX2_TX_PATH_SEC4: case CDC_TX2_TX_PATH_SEC5: case CDC_TX2_TX_PATH_SEC6: case CDC_TX3_TX_PATH_CTL: case CDC_TX3_TX_PATH_CFG0: case CDC_TX3_TX_PATH_CFG1: case CDC_TX3_TX_VOL_CTL: case CDC_TX3_TX_PATH_SEC0: case CDC_TX3_TX_PATH_SEC1: case CDC_TX3_TX_PATH_SEC2: case CDC_TX3_TX_PATH_SEC3: case CDC_TX3_TX_PATH_SEC4: case CDC_TX3_TX_PATH_SEC5: case CDC_TX3_TX_PATH_SEC6: case CDC_TX4_TX_PATH_CTL: case CDC_TX4_TX_PATH_CFG0: case CDC_TX4_TX_PATH_CFG1: case CDC_TX4_TX_VOL_CTL: case CDC_TX4_TX_PATH_SEC0: case CDC_TX4_TX_PATH_SEC1: case CDC_TX4_TX_PATH_SEC2: case CDC_TX4_TX_PATH_SEC3: case CDC_TX4_TX_PATH_SEC4: case CDC_TX4_TX_PATH_SEC5: case CDC_TX4_TX_PATH_SEC6: case CDC_TX5_TX_PATH_CTL: case CDC_TX5_TX_PATH_CFG0: case CDC_TX5_TX_PATH_CFG1: case CDC_TX5_TX_VOL_CTL: case CDC_TX5_TX_PATH_SEC0: case CDC_TX5_TX_PATH_SEC1: case CDC_TX5_TX_PATH_SEC2: case CDC_TX5_TX_PATH_SEC3: case CDC_TX5_TX_PATH_SEC4: case CDC_TX5_TX_PATH_SEC5: case CDC_TX5_TX_PATH_SEC6: case CDC_TX6_TX_PATH_CTL: case CDC_TX6_TX_PATH_CFG0: case CDC_TX6_TX_PATH_CFG1: case CDC_TX6_TX_VOL_CTL: case CDC_TX6_TX_PATH_SEC0: case CDC_TX6_TX_PATH_SEC1: case CDC_TX6_TX_PATH_SEC2: case CDC_TX6_TX_PATH_SEC3: case CDC_TX6_TX_PATH_SEC4: case CDC_TX6_TX_PATH_SEC5: case CDC_TX6_TX_PATH_SEC6: case CDC_TX7_TX_PATH_CTL: case CDC_TX7_TX_PATH_CFG0: case CDC_TX7_TX_PATH_CFG1: case CDC_TX7_TX_VOL_CTL: case CDC_TX7_TX_PATH_SEC0: case CDC_TX7_TX_PATH_SEC1: case CDC_TX7_TX_PATH_SEC2: case CDC_TX7_TX_PATH_SEC3: case CDC_TX7_TX_PATH_SEC4: case CDC_TX7_TX_PATH_SEC5: case CDC_TX7_TX_PATH_SEC6: return true; } return false; } static const struct regmap_config tx_regmap_config = { .name = "tx_macro", .reg_bits = 16, .val_bits = 32, .reg_stride = 4, .cache_type = REGCACHE_FLAT, .max_register = TX_MAX_OFFSET, .reg_defaults = tx_defaults, .num_reg_defaults = ARRAY_SIZE(tx_defaults), .writeable_reg = tx_is_rw_register, .volatile_reg = tx_is_volatile_register, .readable_reg = tx_is_rw_register, }; static int tx_macro_mclk_enable(struct tx_macro *tx, bool mclk_enable) { struct regmap *regmap = tx->regmap; if (mclk_enable) { if (tx->tx_mclk_users == 0) { /* 9.6MHz MCLK, set value 0x00 if other frequency */ regmap_update_bits(regmap, CDC_TX_TOP_CSR_FREQ_MCLK, 0x01, 0x01); regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_MCLK_CONTROL, CDC_TX_MCLK_EN_MASK, CDC_TX_MCLK_ENABLE); regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL, CDC_TX_FS_CNT_EN_MASK, CDC_TX_FS_CNT_ENABLE); regcache_mark_dirty(regmap); regcache_sync(regmap); } tx->tx_mclk_users++; } else { if (tx->tx_mclk_users <= 0) { dev_err(tx->dev, "clock already disabled\n"); tx->tx_mclk_users = 0; goto exit; } tx->tx_mclk_users--; if (tx->tx_mclk_users == 0) { regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_FS_CNT_CONTROL, CDC_TX_FS_CNT_EN_MASK, 0x0); regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_MCLK_CONTROL, CDC_TX_MCLK_EN_MASK, 0x0); } } exit: return 0; } static bool is_amic_enabled(struct snd_soc_component *component, u8 decimator) { u16 adc_mux_reg, adc_reg, adc_n; adc_mux_reg = CDC_TX_INP_MUX_ADC_MUXn_CFG1(decimator); if (snd_soc_component_read(component, adc_mux_reg) & SWR_MIC) { adc_reg = CDC_TX_INP_MUX_ADC_MUXn_CFG0(decimator); adc_n = snd_soc_component_read_field(component, adc_reg, CDC_TX_MACRO_SWR_MIC_MUX_SEL_MASK); if (adc_n < TX_ADC_MAX) return true; } return false; } static void tx_macro_tx_hpf_corner_freq_callback(struct work_struct *work) { struct delayed_work *hpf_delayed_work; struct hpf_work *hpf_work; struct tx_macro *tx; struct snd_soc_component *component; u16 dec_cfg_reg, hpf_gate_reg; u8 hpf_cut_off_freq; hpf_delayed_work = to_delayed_work(work); hpf_work = container_of(hpf_delayed_work, struct hpf_work, dwork); tx = hpf_work->tx; component = tx->component; hpf_cut_off_freq = hpf_work->hpf_cut_off_freq; dec_cfg_reg = CDC_TXn_TX_PATH_CFG0(hpf_work->decimator); hpf_gate_reg = CDC_TXn_TX_PATH_SEC2(hpf_work->decimator); if (is_amic_enabled(component, hpf_work->decimator)) { snd_soc_component_write_field(component, dec_cfg_reg, CDC_TXn_HPF_CUT_FREQ_MASK, hpf_cut_off_freq); snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x02); snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x01); } else { snd_soc_component_write_field(component, dec_cfg_reg, CDC_TXn_HPF_CUT_FREQ_MASK, hpf_cut_off_freq); snd_soc_component_write_field(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK, 0x1); /* Minimum 1 clk cycle delay is required as per HW spec */ usleep_range(1000, 1010); snd_soc_component_write_field(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK, 0x0); } } static void tx_macro_mute_update_callback(struct work_struct *work) { struct tx_mute_work *tx_mute_dwork; struct snd_soc_component *component; struct tx_macro *tx; struct delayed_work *delayed_work; u8 decimator; delayed_work = to_delayed_work(work); tx_mute_dwork = container_of(delayed_work, struct tx_mute_work, dwork); tx = tx_mute_dwork->tx; component = tx->component; decimator = tx_mute_dwork->decimator; snd_soc_component_write_field(component, CDC_TXn_TX_PATH_CTL(decimator), CDC_TXn_PGA_MUTE_MASK, 0x0); } static int tx_macro_mclk_event(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); struct tx_macro *tx = snd_soc_component_get_drvdata(component); switch (event) { case SND_SOC_DAPM_PRE_PMU: tx_macro_mclk_enable(tx, true); break; case SND_SOC_DAPM_POST_PMD: tx_macro_mclk_enable(tx, false); break; default: break; } return 0; } static int tx_macro_put_dec_enum(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol); struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm); struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; unsigned int val, dmic; u16 mic_sel_reg; u16 dmic_clk_reg; struct tx_macro *tx = snd_soc_component_get_drvdata(component); val = ucontrol->value.enumerated.item[0]; if (val >= e->items) return -EINVAL; switch (e->reg) { case CDC_TX_INP_MUX_ADC_MUX0_CFG0: mic_sel_reg = CDC_TX0_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX1_CFG0: mic_sel_reg = CDC_TX1_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX2_CFG0: mic_sel_reg = CDC_TX2_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX3_CFG0: mic_sel_reg = CDC_TX3_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX4_CFG0: mic_sel_reg = CDC_TX4_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX5_CFG0: mic_sel_reg = CDC_TX5_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX6_CFG0: mic_sel_reg = CDC_TX6_TX_PATH_CFG0; break; case CDC_TX_INP_MUX_ADC_MUX7_CFG0: mic_sel_reg = CDC_TX7_TX_PATH_CFG0; break; default: dev_err(component->dev, "Error in configuration!!\n"); return -EINVAL; } if (val != 0) { if (val < 5) { snd_soc_component_write_field(component, mic_sel_reg, CDC_TXn_ADC_DMIC_SEL_MASK, 0); } else { snd_soc_component_write_field(component, mic_sel_reg, CDC_TXn_ADC_DMIC_SEL_MASK, 1); dmic = TX_ADC_TO_DMIC(val); dmic_clk_reg = CDC_TX_TOP_CSR_SWR_DMICn_CTL(dmic); snd_soc_component_write_field(component, dmic_clk_reg, CDC_TX_SWR_DMIC_CLK_SEL_MASK, tx->dmic_clk_div); } } return snd_soc_dapm_put_enum_double(kcontrol, ucontrol); } static int tx_macro_tx_mixer_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol); struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm); struct soc_mixer_control *mc = (struct soc_mixer_control *)kcontrol->private_value; u32 dai_id = widget->shift; u32 dec_id = mc->shift; struct tx_macro *tx = snd_soc_component_get_drvdata(component); if (test_bit(dec_id, &tx->active_ch_mask[dai_id])) ucontrol->value.integer.value[0] = 1; else ucontrol->value.integer.value[0] = 0; return 0; } static int tx_macro_tx_mixer_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol); struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm); struct snd_soc_dapm_update *update = NULL; struct soc_mixer_control *mc = (struct soc_mixer_control *)kcontrol->private_value; u32 dai_id = widget->shift; u32 dec_id = mc->shift; u32 enable = ucontrol->value.integer.value[0]; struct tx_macro *tx = snd_soc_component_get_drvdata(component); if (enable) { if (tx->active_decimator[dai_id] == dec_id) return 0; set_bit(dec_id, &tx->active_ch_mask[dai_id]); tx->active_ch_cnt[dai_id]++; tx->active_decimator[dai_id] = dec_id; } else { if (tx->active_decimator[dai_id] == -1) return 0; tx->active_ch_cnt[dai_id]--; clear_bit(dec_id, &tx->active_ch_mask[dai_id]); tx->active_decimator[dai_id] = -1; } snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, update); return 1; } static int tx_macro_enable_dec(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); u8 decimator; u16 tx_vol_ctl_reg, dec_cfg_reg, hpf_gate_reg, tx_gain_ctl_reg; u8 hpf_cut_off_freq; int hpf_delay = TX_MACRO_DMIC_HPF_DELAY_MS; int unmute_delay = TX_MACRO_DMIC_UNMUTE_DELAY_MS; u16 adc_mux_reg, adc_reg, adc_n, dmic; u16 dmic_clk_reg; struct tx_macro *tx = snd_soc_component_get_drvdata(component); decimator = w->shift; tx_vol_ctl_reg = CDC_TXn_TX_PATH_CTL(decimator); hpf_gate_reg = CDC_TXn_TX_PATH_SEC2(decimator); dec_cfg_reg = CDC_TXn_TX_PATH_CFG0(decimator); tx_gain_ctl_reg = CDC_TXn_TX_VOL_CTL(decimator); switch (event) { case SND_SOC_DAPM_PRE_PMU: adc_mux_reg = CDC_TX_INP_MUX_ADC_MUXn_CFG1(decimator); if (snd_soc_component_read(component, adc_mux_reg) & SWR_MIC) { adc_reg = CDC_TX_INP_MUX_ADC_MUXn_CFG0(decimator); adc_n = snd_soc_component_read(component, adc_reg) & CDC_TX_MACRO_SWR_MIC_MUX_SEL_MASK; if (adc_n >= TX_ADC_MAX) { dmic = TX_ADC_TO_DMIC(adc_n); dmic_clk_reg = CDC_TX_TOP_CSR_SWR_DMICn_CTL(dmic); snd_soc_component_write_field(component, dmic_clk_reg, CDC_TX_SWR_DMIC_CLK_SEL_MASK, tx->dmic_clk_div); } } snd_soc_component_write_field(component, dec_cfg_reg, CDC_TXn_ADC_MODE_MASK, tx->dec_mode[decimator]); /* Enable TX PGA Mute */ snd_soc_component_write_field(component, tx_vol_ctl_reg, CDC_TXn_PGA_MUTE_MASK, 0x1); break; case SND_SOC_DAPM_POST_PMU: snd_soc_component_write_field(component, tx_vol_ctl_reg, CDC_TXn_CLK_EN_MASK, 0x1); if (!is_amic_enabled(component, decimator)) { snd_soc_component_update_bits(component, hpf_gate_reg, 0x01, 0x00); /* Minimum 1 clk cycle delay is required as per HW spec */ usleep_range(1000, 1010); } hpf_cut_off_freq = snd_soc_component_read_field(component, dec_cfg_reg, CDC_TXn_HPF_CUT_FREQ_MASK); tx->tx_hpf_work[decimator].hpf_cut_off_freq = hpf_cut_off_freq; if (hpf_cut_off_freq != CF_MIN_3DB_150HZ) snd_soc_component_write_field(component, dec_cfg_reg, CDC_TXn_HPF_CUT_FREQ_MASK, CF_MIN_3DB_150HZ); if (is_amic_enabled(component, decimator)) { hpf_delay = TX_MACRO_AMIC_HPF_DELAY_MS; unmute_delay = TX_MACRO_AMIC_UNMUTE_DELAY_MS; } /* schedule work queue to Remove Mute */ queue_delayed_work(system_freezable_wq, &tx->tx_mute_dwork[decimator].dwork, msecs_to_jiffies(unmute_delay)); if (tx->tx_hpf_work[decimator].hpf_cut_off_freq != CF_MIN_3DB_150HZ) { queue_delayed_work(system_freezable_wq, &tx->tx_hpf_work[decimator].dwork, msecs_to_jiffies(hpf_delay)); snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x02); if (!is_amic_enabled(component, decimator)) snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x00); snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x01); /* * 6ms delay is required as per HW spec */ usleep_range(6000, 6010); } /* apply gain after decimator is enabled */ snd_soc_component_write(component, tx_gain_ctl_reg, snd_soc_component_read(component, tx_gain_ctl_reg)); if (tx->bcs_enable) { snd_soc_component_update_bits(component, dec_cfg_reg, 0x01, 0x01); tx->bcs_clk_en = true; } break; case SND_SOC_DAPM_PRE_PMD: hpf_cut_off_freq = tx->tx_hpf_work[decimator].hpf_cut_off_freq; snd_soc_component_write_field(component, tx_vol_ctl_reg, CDC_TXn_PGA_MUTE_MASK, 0x1); if (cancel_delayed_work_sync( &tx->tx_hpf_work[decimator].dwork)) { if (hpf_cut_off_freq != CF_MIN_3DB_150HZ) { snd_soc_component_write_field( component, dec_cfg_reg, CDC_TXn_HPF_CUT_FREQ_MASK, hpf_cut_off_freq); if (is_amic_enabled(component, decimator)) snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x02); else snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x03); /* * Minimum 1 clk cycle delay is required * as per HW spec */ usleep_range(1000, 1010); snd_soc_component_update_bits(component, hpf_gate_reg, CDC_TXn_HPF_F_CHANGE_MASK | CDC_TXn_HPF_ZERO_GATE_MASK, 0x1); } } cancel_delayed_work_sync(&tx->tx_mute_dwork[decimator].dwork); break; case SND_SOC_DAPM_POST_PMD: snd_soc_component_write_field(component, tx_vol_ctl_reg, CDC_TXn_CLK_EN_MASK, 0x0); snd_soc_component_write_field(component, dec_cfg_reg, CDC_TXn_ADC_MODE_MASK, 0x0); snd_soc_component_write_field(component, tx_vol_ctl_reg, CDC_TXn_PGA_MUTE_MASK, 0x0); if (tx->bcs_enable) { snd_soc_component_write_field(component, dec_cfg_reg, CDC_TXn_PH_EN_MASK, 0x0); snd_soc_component_write_field(component, CDC_TX0_TX_PATH_SEC7, CDC_TX0_MBHC_CTL_EN_MASK, 0x0); tx->bcs_clk_en = false; } break; } return 0; } static int tx_macro_dec_mode_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); struct tx_macro *tx = snd_soc_component_get_drvdata(component); struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; int path = e->shift_l; ucontrol->value.integer.value[0] = tx->dec_mode[path]; return 0; } static int tx_macro_dec_mode_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); int value = ucontrol->value.integer.value[0]; struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; int path = e->shift_l; struct tx_macro *tx = snd_soc_component_get_drvdata(component); if (tx->dec_mode[path] == value) return 0; tx->dec_mode[path] = value; return 1; } static int tx_macro_get_bcs(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); struct tx_macro *tx = snd_soc_component_get_drvdata(component); ucontrol->value.integer.value[0] = tx->bcs_enable; return 0; } static int tx_macro_set_bcs(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); int value = ucontrol->value.integer.value[0]; struct tx_macro *tx = snd_soc_component_get_drvdata(component); tx->bcs_enable = value; return 0; } static int tx_macro_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) { struct snd_soc_component *component = dai->component; u32 sample_rate; u8 decimator; int tx_fs_rate; struct tx_macro *tx = snd_soc_component_get_drvdata(component); sample_rate = params_rate(params); switch (sample_rate) { case 8000: tx_fs_rate = 0; break; case 16000: tx_fs_rate = 1; break; case 32000: tx_fs_rate = 3; break; case 48000: tx_fs_rate = 4; break; case 96000: tx_fs_rate = 5; break; case 192000: tx_fs_rate = 6; break; case 384000: tx_fs_rate = 7; break; default: dev_err(component->dev, "%s: Invalid TX sample rate: %d\n", __func__, params_rate(params)); return -EINVAL; } for_each_set_bit(decimator, &tx->active_ch_mask[dai->id], TX_MACRO_DEC_MAX) snd_soc_component_update_bits(component, CDC_TXn_TX_PATH_CTL(decimator), CDC_TXn_PCM_RATE_MASK, tx_fs_rate); return 0; } static int tx_macro_get_channel_map(struct snd_soc_dai *dai, unsigned int *tx_num, unsigned int *tx_slot, unsigned int *rx_num, unsigned int *rx_slot) { struct snd_soc_component *component = dai->component; struct tx_macro *tx = snd_soc_component_get_drvdata(component); switch (dai->id) { case TX_MACRO_AIF1_CAP: case TX_MACRO_AIF2_CAP: case TX_MACRO_AIF3_CAP: *tx_slot = tx->active_ch_mask[dai->id]; *tx_num = tx->active_ch_cnt[dai->id]; break; default: break; } return 0; } static int tx_macro_digital_mute(struct snd_soc_dai *dai, int mute, int stream) { struct snd_soc_component *component = dai->component; struct tx_macro *tx = snd_soc_component_get_drvdata(component); u8 decimator; decimator = tx->active_decimator[dai->id]; if (mute) snd_soc_component_write_field(component, CDC_TXn_TX_PATH_CTL(decimator), CDC_TXn_PGA_MUTE_MASK, 0x1); else snd_soc_component_update_bits(component, CDC_TXn_TX_PATH_CTL(decimator), CDC_TXn_PGA_MUTE_MASK, 0x0); return 0; } static const struct snd_soc_dai_ops tx_macro_dai_ops = { .hw_params = tx_macro_hw_params, .get_channel_map = tx_macro_get_channel_map, .mute_stream = tx_macro_digital_mute, }; static struct snd_soc_dai_driver tx_macro_dai[] = { { .name = "tx_macro_tx1", .id = TX_MACRO_AIF1_CAP, .capture = { .stream_name = "TX_AIF1 Capture", .rates = TX_MACRO_RATES, .formats = TX_MACRO_FORMATS, .rate_max = 192000, .rate_min = 8000, .channels_min = 1, .channels_max = 8, }, .ops = &tx_macro_dai_ops, }, { .name = "tx_macro_tx2", .id = TX_MACRO_AIF2_CAP, .capture = { .stream_name = "TX_AIF2 Capture", .rates = TX_MACRO_RATES, .formats = TX_MACRO_FORMATS, .rate_max = 192000, .rate_min = 8000, .channels_min = 1, .channels_max = 8, }, .ops = &tx_macro_dai_ops, }, { .name = "tx_macro_tx3", .id = TX_MACRO_AIF3_CAP, .capture = { .stream_name = "TX_AIF3 Capture", .rates = TX_MACRO_RATES, .formats = TX_MACRO_FORMATS, .rate_max = 192000, .rate_min = 8000, .channels_min = 1, .channels_max = 8, }, .ops = &tx_macro_dai_ops, }, }; static const char * const adc_mux_text[] = { "MSM_DMIC", "SWR_MIC", "ANC_FB_TUNE1" }; static SOC_ENUM_SINGLE_DECL(tx_dec0_enum, CDC_TX_INP_MUX_ADC_MUX0_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec1_enum, CDC_TX_INP_MUX_ADC_MUX1_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec2_enum, CDC_TX_INP_MUX_ADC_MUX2_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec3_enum, CDC_TX_INP_MUX_ADC_MUX3_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec4_enum, CDC_TX_INP_MUX_ADC_MUX4_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec5_enum, CDC_TX_INP_MUX_ADC_MUX5_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec6_enum, CDC_TX_INP_MUX_ADC_MUX6_CFG1, 0, adc_mux_text); static SOC_ENUM_SINGLE_DECL(tx_dec7_enum, CDC_TX_INP_MUX_ADC_MUX7_CFG1, 0, adc_mux_text); static const struct snd_kcontrol_new tx_dec0_mux = SOC_DAPM_ENUM("tx_dec0", tx_dec0_enum); static const struct snd_kcontrol_new tx_dec1_mux = SOC_DAPM_ENUM("tx_dec1", tx_dec1_enum); static const struct snd_kcontrol_new tx_dec2_mux = SOC_DAPM_ENUM("tx_dec2", tx_dec2_enum); static const struct snd_kcontrol_new tx_dec3_mux = SOC_DAPM_ENUM("tx_dec3", tx_dec3_enum); static const struct snd_kcontrol_new tx_dec4_mux = SOC_DAPM_ENUM("tx_dec4", tx_dec4_enum); static const struct snd_kcontrol_new tx_dec5_mux = SOC_DAPM_ENUM("tx_dec5", tx_dec5_enum); static const struct snd_kcontrol_new tx_dec6_mux = SOC_DAPM_ENUM("tx_dec6", tx_dec6_enum); static const struct snd_kcontrol_new tx_dec7_mux = SOC_DAPM_ENUM("tx_dec7", tx_dec7_enum); static const char * const smic_mux_text[] = { "ZERO", "ADC0", "ADC1", "ADC2", "ADC3", "SWR_DMIC0", "SWR_DMIC1", "SWR_DMIC2", "SWR_DMIC3", "SWR_DMIC4", "SWR_DMIC5", "SWR_DMIC6", "SWR_DMIC7" }; static SOC_ENUM_SINGLE_DECL(tx_smic0_enum, CDC_TX_INP_MUX_ADC_MUX0_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic1_enum, CDC_TX_INP_MUX_ADC_MUX1_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic2_enum, CDC_TX_INP_MUX_ADC_MUX2_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic3_enum, CDC_TX_INP_MUX_ADC_MUX3_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic4_enum, CDC_TX_INP_MUX_ADC_MUX4_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic5_enum, CDC_TX_INP_MUX_ADC_MUX5_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic6_enum, CDC_TX_INP_MUX_ADC_MUX6_CFG0, 0, smic_mux_text); static SOC_ENUM_SINGLE_DECL(tx_smic7_enum, CDC_TX_INP_MUX_ADC_MUX7_CFG0, 0, smic_mux_text); static const struct snd_kcontrol_new tx_smic0_mux = SOC_DAPM_ENUM_EXT("tx_smic0", tx_smic0_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic1_mux = SOC_DAPM_ENUM_EXT("tx_smic1", tx_smic1_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic2_mux = SOC_DAPM_ENUM_EXT("tx_smic2", tx_smic2_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic3_mux = SOC_DAPM_ENUM_EXT("tx_smic3", tx_smic3_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic4_mux = SOC_DAPM_ENUM_EXT("tx_smic4", tx_smic4_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic5_mux = SOC_DAPM_ENUM_EXT("tx_smic5", tx_smic5_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic6_mux = SOC_DAPM_ENUM_EXT("tx_smic6", tx_smic6_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const struct snd_kcontrol_new tx_smic7_mux = SOC_DAPM_ENUM_EXT("tx_smic7", tx_smic7_enum, snd_soc_dapm_get_enum_double, tx_macro_put_dec_enum); static const char * const dec_mode_mux_text[] = { "ADC_DEFAULT", "ADC_LOW_PWR", "ADC_HIGH_PERF", }; static const struct soc_enum dec_mode_mux_enum[] = { SOC_ENUM_SINGLE(SND_SOC_NOPM, 0, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 1, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 2, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 3, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 4, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 5, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 6, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), SOC_ENUM_SINGLE(SND_SOC_NOPM, 7, ARRAY_SIZE(dec_mode_mux_text), dec_mode_mux_text), }; static const struct snd_kcontrol_new tx_aif1_cap_mixer[] = { SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, TX_MACRO_DEC0, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, TX_MACRO_DEC1, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, TX_MACRO_DEC2, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, TX_MACRO_DEC3, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, TX_MACRO_DEC4, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, TX_MACRO_DEC5, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, TX_MACRO_DEC6, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, TX_MACRO_DEC7, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), }; static const struct snd_kcontrol_new tx_aif2_cap_mixer[] = { SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, TX_MACRO_DEC0, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, TX_MACRO_DEC1, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, TX_MACRO_DEC2, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, TX_MACRO_DEC3, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, TX_MACRO_DEC4, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, TX_MACRO_DEC5, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, TX_MACRO_DEC6, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, TX_MACRO_DEC7, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), }; static const struct snd_kcontrol_new tx_aif3_cap_mixer[] = { SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, TX_MACRO_DEC0, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, TX_MACRO_DEC1, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, TX_MACRO_DEC2, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, TX_MACRO_DEC3, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, TX_MACRO_DEC4, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, TX_MACRO_DEC5, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, TX_MACRO_DEC6, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, TX_MACRO_DEC7, 1, 0, tx_macro_tx_mixer_get, tx_macro_tx_mixer_put), }; static const struct snd_soc_dapm_widget tx_macro_dapm_widgets[] = { SND_SOC_DAPM_AIF_OUT("TX_AIF1 CAP", "TX_AIF1 Capture", 0, SND_SOC_NOPM, TX_MACRO_AIF1_CAP, 0), SND_SOC_DAPM_AIF_OUT("TX_AIF2 CAP", "TX_AIF2 Capture", 0, SND_SOC_NOPM, TX_MACRO_AIF2_CAP, 0), SND_SOC_DAPM_AIF_OUT("TX_AIF3 CAP", "TX_AIF3 Capture", 0, SND_SOC_NOPM, TX_MACRO_AIF3_CAP, 0), SND_SOC_DAPM_MIXER("TX_AIF1_CAP Mixer", SND_SOC_NOPM, TX_MACRO_AIF1_CAP, 0, tx_aif1_cap_mixer, ARRAY_SIZE(tx_aif1_cap_mixer)), SND_SOC_DAPM_MIXER("TX_AIF2_CAP Mixer", SND_SOC_NOPM, TX_MACRO_AIF2_CAP, 0, tx_aif2_cap_mixer, ARRAY_SIZE(tx_aif2_cap_mixer)), SND_SOC_DAPM_MIXER("TX_AIF3_CAP Mixer", SND_SOC_NOPM, TX_MACRO_AIF3_CAP, 0, tx_aif3_cap_mixer, ARRAY_SIZE(tx_aif3_cap_mixer)), SND_SOC_DAPM_MUX("TX SMIC MUX0", SND_SOC_NOPM, 0, 0, &tx_smic0_mux), SND_SOC_DAPM_MUX("TX SMIC MUX1", SND_SOC_NOPM, 0, 0, &tx_smic1_mux), SND_SOC_DAPM_MUX("TX SMIC MUX2", SND_SOC_NOPM, 0, 0, &tx_smic2_mux), SND_SOC_DAPM_MUX("TX SMIC MUX3", SND_SOC_NOPM, 0, 0, &tx_smic3_mux), SND_SOC_DAPM_MUX("TX SMIC MUX4", SND_SOC_NOPM, 0, 0, &tx_smic4_mux), SND_SOC_DAPM_MUX("TX SMIC MUX5", SND_SOC_NOPM, 0, 0, &tx_smic5_mux), SND_SOC_DAPM_MUX("TX SMIC MUX6", SND_SOC_NOPM, 0, 0, &tx_smic6_mux), SND_SOC_DAPM_MUX("TX SMIC MUX7", SND_SOC_NOPM, 0, 0, &tx_smic7_mux), SND_SOC_DAPM_INPUT("TX SWR_ADC0"), SND_SOC_DAPM_INPUT("TX SWR_ADC1"), SND_SOC_DAPM_INPUT("TX SWR_ADC2"), SND_SOC_DAPM_INPUT("TX SWR_ADC3"), SND_SOC_DAPM_INPUT("TX SWR_DMIC0"), SND_SOC_DAPM_INPUT("TX SWR_DMIC1"), SND_SOC_DAPM_INPUT("TX SWR_DMIC2"), SND_SOC_DAPM_INPUT("TX SWR_DMIC3"), SND_SOC_DAPM_INPUT("TX SWR_DMIC4"), SND_SOC_DAPM_INPUT("TX SWR_DMIC5"), SND_SOC_DAPM_INPUT("TX SWR_DMIC6"), SND_SOC_DAPM_INPUT("TX SWR_DMIC7"), SND_SOC_DAPM_MUX_E("TX DEC0 MUX", SND_SOC_NOPM, TX_MACRO_DEC0, 0, &tx_dec0_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC1 MUX", SND_SOC_NOPM, TX_MACRO_DEC1, 0, &tx_dec1_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC2 MUX", SND_SOC_NOPM, TX_MACRO_DEC2, 0, &tx_dec2_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC3 MUX", SND_SOC_NOPM, TX_MACRO_DEC3, 0, &tx_dec3_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC4 MUX", SND_SOC_NOPM, TX_MACRO_DEC4, 0, &tx_dec4_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC5 MUX", SND_SOC_NOPM, TX_MACRO_DEC5, 0, &tx_dec5_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC6 MUX", SND_SOC_NOPM, TX_MACRO_DEC6, 0, &tx_dec6_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_MUX_E("TX DEC7 MUX", SND_SOC_NOPM, TX_MACRO_DEC7, 0, &tx_dec7_mux, tx_macro_enable_dec, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_SUPPLY_S("TX_MCLK", 0, SND_SOC_NOPM, 0, 0, tx_macro_mclk_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_SUPPLY_S("TX_SWR_CLK", 0, SND_SOC_NOPM, 0, 0, NULL, 0), SND_SOC_DAPM_SUPPLY_S("VA_SWR_CLK", 0, SND_SOC_NOPM, 0, 0, NULL, 0), }; static const struct snd_soc_dapm_route tx_audio_map[] = { {"TX_AIF1 CAP", NULL, "TX_MCLK"}, {"TX_AIF2 CAP", NULL, "TX_MCLK"}, {"TX_AIF3 CAP", NULL, "TX_MCLK"}, {"TX_AIF1 CAP", NULL, "TX_AIF1_CAP Mixer"}, {"TX_AIF2 CAP", NULL, "TX_AIF2_CAP Mixer"}, {"TX_AIF3 CAP", NULL, "TX_AIF3_CAP Mixer"}, {"TX_AIF1_CAP Mixer", "DEC0", "TX DEC0 MUX"}, {"TX_AIF1_CAP Mixer", "DEC1", "TX DEC1 MUX"}, {"TX_AIF1_CAP Mixer", "DEC2", "TX DEC2 MUX"}, {"TX_AIF1_CAP Mixer", "DEC3", "TX DEC3 MUX"}, {"TX_AIF1_CAP Mixer", "DEC4", "TX DEC4 MUX"}, {"TX_AIF1_CAP Mixer", "DEC5", "TX DEC5 MUX"}, {"TX_AIF1_CAP Mixer", "DEC6", "TX DEC6 MUX"}, {"TX_AIF1_CAP Mixer", "DEC7", "TX DEC7 MUX"}, {"TX_AIF2_CAP Mixer", "DEC0", "TX DEC0 MUX"}, {"TX_AIF2_CAP Mixer", "DEC1", "TX DEC1 MUX"}, {"TX_AIF2_CAP Mixer", "DEC2", "TX DEC2 MUX"}, {"TX_AIF2_CAP Mixer", "DEC3", "TX DEC3 MUX"}, {"TX_AIF2_CAP Mixer", "DEC4", "TX DEC4 MUX"}, {"TX_AIF2_CAP Mixer", "DEC5", "TX DEC5 MUX"}, {"TX_AIF2_CAP Mixer", "DEC6", "TX DEC6 MUX"}, {"TX_AIF2_CAP Mixer", "DEC7", "TX DEC7 MUX"}, {"TX_AIF3_CAP Mixer", "DEC0", "TX DEC0 MUX"}, {"TX_AIF3_CAP Mixer", "DEC1", "TX DEC1 MUX"}, {"TX_AIF3_CAP Mixer", "DEC2", "TX DEC2 MUX"}, {"TX_AIF3_CAP Mixer", "DEC3", "TX DEC3 MUX"}, {"TX_AIF3_CAP Mixer", "DEC4", "TX DEC4 MUX"}, {"TX_AIF3_CAP Mixer", "DEC5", "TX DEC5 MUX"}, {"TX_AIF3_CAP Mixer", "DEC6", "TX DEC6 MUX"}, {"TX_AIF3_CAP Mixer", "DEC7", "TX DEC7 MUX"}, {"TX DEC0 MUX", NULL, "TX_MCLK"}, {"TX DEC1 MUX", NULL, "TX_MCLK"}, {"TX DEC2 MUX", NULL, "TX_MCLK"}, {"TX DEC3 MUX", NULL, "TX_MCLK"}, {"TX DEC4 MUX", NULL, "TX_MCLK"}, {"TX DEC5 MUX", NULL, "TX_MCLK"}, {"TX DEC6 MUX", NULL, "TX_MCLK"}, {"TX DEC7 MUX", NULL, "TX_MCLK"}, {"TX DEC0 MUX", "SWR_MIC", "TX SMIC MUX0"}, {"TX SMIC MUX0", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX0", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX0", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX0", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX0", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX0", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX0", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX0", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX0", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX0", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX0", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX0", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX0", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC1 MUX", "SWR_MIC", "TX SMIC MUX1"}, {"TX SMIC MUX1", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX1", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX1", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX1", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX1", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX1", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX1", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX1", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX1", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX1", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX1", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX1", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX1", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC2 MUX", "SWR_MIC", "TX SMIC MUX2"}, {"TX SMIC MUX2", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX2", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX2", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX2", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX2", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX2", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX2", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX2", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX2", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX2", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX2", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX2", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX2", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC3 MUX", "SWR_MIC", "TX SMIC MUX3"}, {"TX SMIC MUX3", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX3", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX3", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX3", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX3", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX3", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX3", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX3", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX3", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX3", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX3", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX3", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX3", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC4 MUX", "SWR_MIC", "TX SMIC MUX4"}, {"TX SMIC MUX4", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX4", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX4", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX4", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX4", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX4", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX4", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX4", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX4", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX4", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX4", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX4", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX4", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC5 MUX", "SWR_MIC", "TX SMIC MUX5"}, {"TX SMIC MUX5", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX5", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX5", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX5", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX5", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX5", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX5", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX5", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX5", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX5", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX5", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX5", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX5", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC6 MUX", "SWR_MIC", "TX SMIC MUX6"}, {"TX SMIC MUX6", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX6", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX6", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX6", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX6", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX6", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX6", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX6", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX6", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX6", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX6", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX6", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX6", "SWR_DMIC7", "TX SWR_DMIC7"}, {"TX DEC7 MUX", "SWR_MIC", "TX SMIC MUX7"}, {"TX SMIC MUX7", NULL, "TX_SWR_CLK"}, {"TX SMIC MUX7", "ADC0", "TX SWR_ADC0"}, {"TX SMIC MUX7", "ADC1", "TX SWR_ADC1"}, {"TX SMIC MUX7", "ADC2", "TX SWR_ADC2"}, {"TX SMIC MUX7", "ADC3", "TX SWR_ADC3"}, {"TX SMIC MUX7", "SWR_DMIC0", "TX SWR_DMIC0"}, {"TX SMIC MUX7", "SWR_DMIC1", "TX SWR_DMIC1"}, {"TX SMIC MUX7", "SWR_DMIC2", "TX SWR_DMIC2"}, {"TX SMIC MUX7", "SWR_DMIC3", "TX SWR_DMIC3"}, {"TX SMIC MUX7", "SWR_DMIC4", "TX SWR_DMIC4"}, {"TX SMIC MUX7", "SWR_DMIC5", "TX SWR_DMIC5"}, {"TX SMIC MUX7", "SWR_DMIC6", "TX SWR_DMIC6"}, {"TX SMIC MUX7", "SWR_DMIC7", "TX SWR_DMIC7"}, }; static const struct snd_kcontrol_new tx_macro_snd_controls[] = { SOC_SINGLE_S8_TLV("TX_DEC0 Volume", CDC_TX0_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC1 Volume", CDC_TX1_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC2 Volume", CDC_TX2_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC3 Volume", CDC_TX3_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC4 Volume", CDC_TX4_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC5 Volume", CDC_TX5_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC6 Volume", CDC_TX6_TX_VOL_CTL, -84, 40, digital_gain), SOC_SINGLE_S8_TLV("TX_DEC7 Volume", CDC_TX7_TX_VOL_CTL, -84, 40, digital_gain), SOC_ENUM_EXT("DEC0 MODE", dec_mode_mux_enum[0], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC1 MODE", dec_mode_mux_enum[1], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC2 MODE", dec_mode_mux_enum[2], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC3 MODE", dec_mode_mux_enum[3], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC4 MODE", dec_mode_mux_enum[4], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC5 MODE", dec_mode_mux_enum[5], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC6 MODE", dec_mode_mux_enum[6], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_ENUM_EXT("DEC7 MODE", dec_mode_mux_enum[7], tx_macro_dec_mode_get, tx_macro_dec_mode_put), SOC_SINGLE_EXT("DEC0_BCS Switch", SND_SOC_NOPM, 0, 1, 0, tx_macro_get_bcs, tx_macro_set_bcs), }; static int tx_macro_component_probe(struct snd_soc_component *comp) { struct tx_macro *tx = snd_soc_component_get_drvdata(comp); int i; snd_soc_component_init_regmap(comp, tx->regmap); for (i = 0; i < NUM_DECIMATORS; i++) { tx->tx_hpf_work[i].tx = tx; tx->tx_hpf_work[i].decimator = i; INIT_DELAYED_WORK(&tx->tx_hpf_work[i].dwork, tx_macro_tx_hpf_corner_freq_callback); } for (i = 0; i < NUM_DECIMATORS; i++) { tx->tx_mute_dwork[i].tx = tx; tx->tx_mute_dwork[i].decimator = i; INIT_DELAYED_WORK(&tx->tx_mute_dwork[i].dwork, tx_macro_mute_update_callback); } tx->component = comp; snd_soc_component_update_bits(comp, CDC_TX0_TX_PATH_SEC7, 0x3F, 0x0A); return 0; } static int swclk_gate_enable(struct clk_hw *hw) { struct tx_macro *tx = to_tx_macro(hw); struct regmap *regmap = tx->regmap; tx_macro_mclk_enable(tx, true); if (tx->reset_swr) regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_SWR_CONTROL, CDC_TX_SWR_RESET_MASK, CDC_TX_SWR_RESET_ENABLE); regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_SWR_CONTROL, CDC_TX_SWR_CLK_EN_MASK, CDC_TX_SWR_CLK_ENABLE); if (tx->reset_swr) regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_SWR_CONTROL, CDC_TX_SWR_RESET_MASK, 0x0); tx->reset_swr = false; return 0; } static void swclk_gate_disable(struct clk_hw *hw) { struct tx_macro *tx = to_tx_macro(hw); struct regmap *regmap = tx->regmap; regmap_update_bits(regmap, CDC_TX_CLK_RST_CTRL_SWR_CONTROL, CDC_TX_SWR_CLK_EN_MASK, 0x0); tx_macro_mclk_enable(tx, false); } static int swclk_gate_is_enabled(struct clk_hw *hw) { struct tx_macro *tx = to_tx_macro(hw); int ret, val; regmap_read(tx->regmap, CDC_TX_CLK_RST_CTRL_SWR_CONTROL, &val); ret = val & BIT(0); return ret; } static unsigned long swclk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) { return parent_rate / 2; } static const struct clk_ops swclk_gate_ops = { .prepare = swclk_gate_enable, .unprepare = swclk_gate_disable, .is_enabled = swclk_gate_is_enabled, .recalc_rate = swclk_recalc_rate, }; static int tx_macro_register_mclk_output(struct tx_macro *tx) { struct device *dev = tx->dev; const char *parent_clk_name = NULL; const char *clk_name = "lpass-tx-mclk"; struct clk_hw *hw; struct clk_init_data init; int ret; parent_clk_name = __clk_get_name(tx->mclk); init.name = clk_name; init.ops = &swclk_gate_ops; init.flags = 0; init.parent_names = &parent_clk_name; init.num_parents = 1; tx->hw.init = &init; hw = &tx->hw; ret = devm_clk_hw_register(dev, hw); if (ret) return ret; return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, hw); } static const struct snd_soc_component_driver tx_macro_component_drv = { .name = "RX-MACRO", .probe = tx_macro_component_probe, .controls = tx_macro_snd_controls, .num_controls = ARRAY_SIZE(tx_macro_snd_controls), .dapm_widgets = tx_macro_dapm_widgets, .num_dapm_widgets = ARRAY_SIZE(tx_macro_dapm_widgets), .dapm_routes = tx_audio_map, .num_dapm_routes = ARRAY_SIZE(tx_audio_map), }; static int tx_macro_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; struct tx_macro *tx; void __iomem *base; int ret; tx = devm_kzalloc(dev, sizeof(*tx), GFP_KERNEL); if (!tx) return -ENOMEM; tx->macro = devm_clk_get_optional(dev, "macro"); if (IS_ERR(tx->macro)) return PTR_ERR(tx->macro); tx->dcodec = devm_clk_get_optional(dev, "dcodec"); if (IS_ERR(tx->dcodec)) return PTR_ERR(tx->dcodec); tx->mclk = devm_clk_get(dev, "mclk"); if (IS_ERR(tx->mclk)) return PTR_ERR(tx->mclk); tx->npl = devm_clk_get(dev, "npl"); if (IS_ERR(tx->npl)) return PTR_ERR(tx->npl); tx->fsgen = devm_clk_get(dev, "fsgen"); if (IS_ERR(tx->fsgen)) return PTR_ERR(tx->fsgen); base = devm_platform_ioremap_resource(pdev, 0); if (IS_ERR(base)) return PTR_ERR(base); tx->regmap = devm_regmap_init_mmio(dev, base, &tx_regmap_config); if (IS_ERR(tx->regmap)) return PTR_ERR(tx->regmap); dev_set_drvdata(dev, tx); tx->reset_swr = true; tx->dev = dev; /* set MCLK and NPL rates */ clk_set_rate(tx->mclk, MCLK_FREQ); clk_set_rate(tx->npl, MCLK_FREQ); ret = clk_prepare_enable(tx->macro); if (ret) goto err; ret = clk_prepare_enable(tx->dcodec); if (ret) goto err_dcodec; ret = clk_prepare_enable(tx->mclk); if (ret) goto err_mclk; ret = clk_prepare_enable(tx->npl); if (ret) goto err_npl; ret = clk_prepare_enable(tx->fsgen); if (ret) goto err_fsgen; ret = tx_macro_register_mclk_output(tx); if (ret) goto err_clkout; ret = devm_snd_soc_register_component(dev, &tx_macro_component_drv, tx_macro_dai, ARRAY_SIZE(tx_macro_dai)); if (ret) goto err_clkout; return 0; err_clkout: clk_disable_unprepare(tx->fsgen); err_fsgen: clk_disable_unprepare(tx->npl); err_npl: clk_disable_unprepare(tx->mclk); err_mclk: clk_disable_unprepare(tx->dcodec); err_dcodec: clk_disable_unprepare(tx->macro); err: return ret; } static int tx_macro_remove(struct platform_device *pdev) { struct tx_macro *tx = dev_get_drvdata(&pdev->dev); clk_disable_unprepare(tx->macro); clk_disable_unprepare(tx->dcodec); clk_disable_unprepare(tx->mclk); clk_disable_unprepare(tx->npl); clk_disable_unprepare(tx->fsgen); return 0; } static const struct of_device_id tx_macro_dt_match[] = { { .compatible = "qcom,sm8250-lpass-tx-macro" }, { } }; MODULE_DEVICE_TABLE(of, tx_macro_dt_match); static struct platform_driver tx_macro_driver = { .driver = { .name = "tx_macro", .of_match_table = tx_macro_dt_match, .suppress_bind_attrs = true, }, .probe = tx_macro_probe, .remove = tx_macro_remove, }; module_platform_driver(tx_macro_driver); MODULE_DESCRIPTION("TX macro driver"); MODULE_LICENSE("GPL");