1 // SPDX-License-Identifier: GPL-2.0-only 2 // Copyright (c) 2018-2020, The Linux Foundation. All rights reserved. 3 4 #include <linux/module.h> 5 #include <linux/init.h> 6 #include <linux/io.h> 7 #include <linux/of.h> 8 #include <linux/platform_device.h> 9 #include <linux/clk.h> 10 #include <linux/of_clk.h> 11 #include <linux/clk-provider.h> 12 #include <sound/soc.h> 13 #include <sound/soc-dapm.h> 14 #include <linux/pm_runtime.h> 15 #include <linux/of_platform.h> 16 #include <sound/tlv.h> 17 #include "lpass-wsa-macro.h" 18 19 #define CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL (0x0000) 20 #define CDC_WSA_MCLK_EN_MASK BIT(0) 21 #define CDC_WSA_MCLK_ENABLE BIT(0) 22 #define CDC_WSA_MCLK_DISABLE 0 23 #define CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL (0x0004) 24 #define CDC_WSA_FS_CNT_EN_MASK BIT(0) 25 #define CDC_WSA_FS_CNT_ENABLE BIT(0) 26 #define CDC_WSA_FS_CNT_DISABLE 0 27 #define CDC_WSA_CLK_RST_CTRL_SWR_CONTROL (0x0008) 28 #define CDC_WSA_SWR_CLK_EN_MASK BIT(0) 29 #define CDC_WSA_SWR_CLK_ENABLE BIT(0) 30 #define CDC_WSA_SWR_RST_EN_MASK BIT(1) 31 #define CDC_WSA_SWR_RST_ENABLE BIT(1) 32 #define CDC_WSA_SWR_RST_DISABLE 0 33 #define CDC_WSA_TOP_TOP_CFG0 (0x0080) 34 #define CDC_WSA_TOP_TOP_CFG1 (0x0084) 35 #define CDC_WSA_TOP_FREQ_MCLK (0x0088) 36 #define CDC_WSA_TOP_DEBUG_BUS_SEL (0x008C) 37 #define CDC_WSA_TOP_DEBUG_EN0 (0x0090) 38 #define CDC_WSA_TOP_DEBUG_EN1 (0x0094) 39 #define CDC_WSA_TOP_DEBUG_DSM_LB (0x0098) 40 #define CDC_WSA_TOP_RX_I2S_CTL (0x009C) 41 #define CDC_WSA_TOP_TX_I2S_CTL (0x00A0) 42 #define CDC_WSA_TOP_I2S_CLK (0x00A4) 43 #define CDC_WSA_TOP_I2S_RESET (0x00A8) 44 #define CDC_WSA_RX_INP_MUX_RX_INT0_CFG0 (0x0100) 45 #define CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK GENMASK(2, 0) 46 #define CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK GENMASK(5, 3) 47 #define CDC_WSA_RX_INP_MUX_RX_INT0_CFG1 (0x0104) 48 #define CDC_WSA_RX_INTX_2_SEL_MASK GENMASK(2, 0) 49 #define CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK GENMASK(5, 3) 50 #define CDC_WSA_RX_INP_MUX_RX_INT1_CFG0 (0x0108) 51 #define CDC_WSA_RX_INP_MUX_RX_INT1_CFG1 (0x010C) 52 #define CDC_WSA_RX_INP_MUX_RX_MIX_CFG0 (0x0110) 53 #define CDC_WSA_RX_MIX_TX1_SEL_MASK GENMASK(5, 3) 54 #define CDC_WSA_RX_MIX_TX1_SEL_SHFT 3 55 #define CDC_WSA_RX_MIX_TX0_SEL_MASK GENMASK(2, 0) 56 #define CDC_WSA_RX_INP_MUX_RX_EC_CFG0 (0x0114) 57 #define CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0 (0x0118) 58 #define CDC_WSA_TX0_SPKR_PROT_PATH_CTL (0x0244) 59 #define CDC_WSA_TX_SPKR_PROT_RESET_MASK BIT(5) 60 #define CDC_WSA_TX_SPKR_PROT_RESET BIT(5) 61 #define CDC_WSA_TX_SPKR_PROT_NO_RESET 0 62 #define CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK BIT(4) 63 #define CDC_WSA_TX_SPKR_PROT_CLK_ENABLE BIT(4) 64 #define CDC_WSA_TX_SPKR_PROT_CLK_DISABLE 0 65 #define CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK GENMASK(3, 0) 66 #define CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K 0 67 #define CDC_WSA_TX0_SPKR_PROT_PATH_CFG0 (0x0248) 68 #define CDC_WSA_TX1_SPKR_PROT_PATH_CTL (0x0264) 69 #define CDC_WSA_TX1_SPKR_PROT_PATH_CFG0 (0x0268) 70 #define CDC_WSA_TX2_SPKR_PROT_PATH_CTL (0x0284) 71 #define CDC_WSA_TX2_SPKR_PROT_PATH_CFG0 (0x0288) 72 #define CDC_WSA_TX3_SPKR_PROT_PATH_CTL (0x02A4) 73 #define CDC_WSA_TX3_SPKR_PROT_PATH_CFG0 (0x02A8) 74 #define CDC_WSA_INTR_CTRL_CFG (0x0340) 75 #define CDC_WSA_INTR_CTRL_CLR_COMMIT (0x0344) 76 #define CDC_WSA_INTR_CTRL_PIN1_MASK0 (0x0360) 77 #define CDC_WSA_INTR_CTRL_PIN1_STATUS0 (0x0368) 78 #define CDC_WSA_INTR_CTRL_PIN1_CLEAR0 (0x0370) 79 #define CDC_WSA_INTR_CTRL_PIN2_MASK0 (0x0380) 80 #define CDC_WSA_INTR_CTRL_PIN2_STATUS0 (0x0388) 81 #define CDC_WSA_INTR_CTRL_PIN2_CLEAR0 (0x0390) 82 #define CDC_WSA_INTR_CTRL_LEVEL0 (0x03C0) 83 #define CDC_WSA_INTR_CTRL_BYPASS0 (0x03C8) 84 #define CDC_WSA_INTR_CTRL_SET0 (0x03D0) 85 #define CDC_WSA_RX0_RX_PATH_CTL (0x0400) 86 #define CDC_WSA_RX_PATH_CLK_EN_MASK BIT(5) 87 #define CDC_WSA_RX_PATH_CLK_ENABLE BIT(5) 88 #define CDC_WSA_RX_PATH_CLK_DISABLE 0 89 #define CDC_WSA_RX_PATH_PGA_MUTE_EN_MASK BIT(4) 90 #define CDC_WSA_RX_PATH_PGA_MUTE_ENABLE BIT(4) 91 #define CDC_WSA_RX_PATH_PGA_MUTE_DISABLE 0 92 #define CDC_WSA_RX0_RX_PATH_CFG0 (0x0404) 93 #define CDC_WSA_RX_PATH_COMP_EN_MASK BIT(1) 94 #define CDC_WSA_RX_PATH_COMP_ENABLE BIT(1) 95 #define CDC_WSA_RX_PATH_HD2_EN_MASK BIT(2) 96 #define CDC_WSA_RX_PATH_HD2_ENABLE BIT(2) 97 #define CDC_WSA_RX_PATH_SPKR_RATE_MASK BIT(3) 98 #define CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072 BIT(3) 99 #define CDC_WSA_RX0_RX_PATH_CFG1 (0x0408) 100 #define CDC_WSA_RX_PATH_SMART_BST_EN_MASK BIT(0) 101 #define CDC_WSA_RX_PATH_SMART_BST_ENABLE BIT(0) 102 #define CDC_WSA_RX_PATH_SMART_BST_DISABLE 0 103 #define CDC_WSA_RX0_RX_PATH_CFG2 (0x040C) 104 #define CDC_WSA_RX0_RX_PATH_CFG3 (0x0410) 105 #define CDC_WSA_RX_DC_DCOEFF_MASK GENMASK(1, 0) 106 #define CDC_WSA_RX0_RX_VOL_CTL (0x0414) 107 #define CDC_WSA_RX0_RX_PATH_MIX_CTL (0x0418) 108 #define CDC_WSA_RX_PATH_MIX_CLK_EN_MASK BIT(5) 109 #define CDC_WSA_RX_PATH_MIX_CLK_ENABLE BIT(5) 110 #define CDC_WSA_RX_PATH_MIX_CLK_DISABLE 0 111 #define CDC_WSA_RX0_RX_PATH_MIX_CFG (0x041C) 112 #define CDC_WSA_RX0_RX_VOL_MIX_CTL (0x0420) 113 #define CDC_WSA_RX0_RX_PATH_SEC0 (0x0424) 114 #define CDC_WSA_RX0_RX_PATH_SEC1 (0x0428) 115 #define CDC_WSA_RX_PGA_HALF_DB_MASK BIT(0) 116 #define CDC_WSA_RX_PGA_HALF_DB_ENABLE BIT(0) 117 #define CDC_WSA_RX_PGA_HALF_DB_DISABLE 0 118 #define CDC_WSA_RX0_RX_PATH_SEC2 (0x042C) 119 #define CDC_WSA_RX0_RX_PATH_SEC3 (0x0430) 120 #define CDC_WSA_RX_PATH_HD2_SCALE_MASK GENMASK(1, 0) 121 #define CDC_WSA_RX_PATH_HD2_ALPHA_MASK GENMASK(5, 2) 122 #define CDC_WSA_RX0_RX_PATH_SEC5 (0x0438) 123 #define CDC_WSA_RX0_RX_PATH_SEC6 (0x043C) 124 #define CDC_WSA_RX0_RX_PATH_SEC7 (0x0440) 125 #define CDC_WSA_RX0_RX_PATH_MIX_SEC0 (0x0444) 126 #define CDC_WSA_RX0_RX_PATH_MIX_SEC1 (0x0448) 127 #define CDC_WSA_RX0_RX_PATH_DSMDEM_CTL (0x044C) 128 #define CDC_WSA_RX_DSMDEM_CLK_EN_MASK BIT(0) 129 #define CDC_WSA_RX_DSMDEM_CLK_ENABLE BIT(0) 130 #define CDC_WSA_RX1_RX_PATH_CTL (0x0480) 131 #define CDC_WSA_RX1_RX_PATH_CFG0 (0x0484) 132 #define CDC_WSA_RX1_RX_PATH_CFG1 (0x0488) 133 #define CDC_WSA_RX1_RX_PATH_CFG2 (0x048C) 134 #define CDC_WSA_RX1_RX_PATH_CFG3 (0x0490) 135 #define CDC_WSA_RX1_RX_VOL_CTL (0x0494) 136 #define CDC_WSA_RX1_RX_PATH_MIX_CTL (0x0498) 137 #define CDC_WSA_RX1_RX_PATH_MIX_CFG (0x049C) 138 #define CDC_WSA_RX1_RX_VOL_MIX_CTL (0x04A0) 139 #define CDC_WSA_RX1_RX_PATH_SEC0 (0x04A4) 140 #define CDC_WSA_RX1_RX_PATH_SEC1 (0x04A8) 141 #define CDC_WSA_RX1_RX_PATH_SEC2 (0x04AC) 142 #define CDC_WSA_RX1_RX_PATH_SEC3 (0x04B0) 143 #define CDC_WSA_RX1_RX_PATH_SEC5 (0x04B8) 144 #define CDC_WSA_RX1_RX_PATH_SEC6 (0x04BC) 145 #define CDC_WSA_RX1_RX_PATH_SEC7 (0x04C0) 146 #define CDC_WSA_RX1_RX_PATH_MIX_SEC0 (0x04C4) 147 #define CDC_WSA_RX1_RX_PATH_MIX_SEC1 (0x04C8) 148 #define CDC_WSA_RX1_RX_PATH_DSMDEM_CTL (0x04CC) 149 #define CDC_WSA_BOOST0_BOOST_PATH_CTL (0x0500) 150 #define CDC_WSA_BOOST_PATH_CLK_EN_MASK BIT(4) 151 #define CDC_WSA_BOOST_PATH_CLK_ENABLE BIT(4) 152 #define CDC_WSA_BOOST_PATH_CLK_DISABLE 0 153 #define CDC_WSA_BOOST0_BOOST_CTL (0x0504) 154 #define CDC_WSA_BOOST0_BOOST_CFG1 (0x0508) 155 #define CDC_WSA_BOOST0_BOOST_CFG2 (0x050C) 156 #define CDC_WSA_BOOST1_BOOST_PATH_CTL (0x0540) 157 #define CDC_WSA_BOOST1_BOOST_CTL (0x0544) 158 #define CDC_WSA_BOOST1_BOOST_CFG1 (0x0548) 159 #define CDC_WSA_BOOST1_BOOST_CFG2 (0x054C) 160 #define CDC_WSA_COMPANDER0_CTL0 (0x0580) 161 #define CDC_WSA_COMPANDER_CLK_EN_MASK BIT(0) 162 #define CDC_WSA_COMPANDER_CLK_ENABLE BIT(0) 163 #define CDC_WSA_COMPANDER_SOFT_RST_MASK BIT(1) 164 #define CDC_WSA_COMPANDER_SOFT_RST_ENABLE BIT(1) 165 #define CDC_WSA_COMPANDER_HALT_MASK BIT(2) 166 #define CDC_WSA_COMPANDER_HALT BIT(2) 167 #define CDC_WSA_COMPANDER0_CTL1 (0x0584) 168 #define CDC_WSA_COMPANDER0_CTL2 (0x0588) 169 #define CDC_WSA_COMPANDER0_CTL3 (0x058C) 170 #define CDC_WSA_COMPANDER0_CTL4 (0x0590) 171 #define CDC_WSA_COMPANDER0_CTL5 (0x0594) 172 #define CDC_WSA_COMPANDER0_CTL6 (0x0598) 173 #define CDC_WSA_COMPANDER0_CTL7 (0x059C) 174 #define CDC_WSA_COMPANDER1_CTL0 (0x05C0) 175 #define CDC_WSA_COMPANDER1_CTL1 (0x05C4) 176 #define CDC_WSA_COMPANDER1_CTL2 (0x05C8) 177 #define CDC_WSA_COMPANDER1_CTL3 (0x05CC) 178 #define CDC_WSA_COMPANDER1_CTL4 (0x05D0) 179 #define CDC_WSA_COMPANDER1_CTL5 (0x05D4) 180 #define CDC_WSA_COMPANDER1_CTL6 (0x05D8) 181 #define CDC_WSA_COMPANDER1_CTL7 (0x05DC) 182 #define CDC_WSA_SOFTCLIP0_CRC (0x0600) 183 #define CDC_WSA_SOFTCLIP_CLK_EN_MASK BIT(0) 184 #define CDC_WSA_SOFTCLIP_CLK_ENABLE BIT(0) 185 #define CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL (0x0604) 186 #define CDC_WSA_SOFTCLIP_EN_MASK BIT(0) 187 #define CDC_WSA_SOFTCLIP_ENABLE BIT(0) 188 #define CDC_WSA_SOFTCLIP1_CRC (0x0640) 189 #define CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL (0x0644) 190 #define CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL (0x0680) 191 #define CDC_WSA_EC_HQ_EC_CLK_EN_MASK BIT(0) 192 #define CDC_WSA_EC_HQ_EC_CLK_ENABLE BIT(0) 193 #define CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0 (0x0684) 194 #define CDC_WSA_EC_HQ_EC_REF_PCM_RATE_MASK GENMASK(4, 1) 195 #define CDC_WSA_EC_HQ_EC_REF_PCM_RATE_48K BIT(3) 196 #define CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL (0x06C0) 197 #define CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0 (0x06C4) 198 #define CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL (0x0700) 199 #define CDC_WSA_SPLINE_ASRC0_CTL0 (0x0704) 200 #define CDC_WSA_SPLINE_ASRC0_CTL1 (0x0708) 201 #define CDC_WSA_SPLINE_ASRC0_FIFO_CTL (0x070C) 202 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB (0x0710) 203 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB (0x0714) 204 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB (0x0718) 205 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB (0x071C) 206 #define CDC_WSA_SPLINE_ASRC0_STATUS_FIFO (0x0720) 207 #define CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL (0x0740) 208 #define CDC_WSA_SPLINE_ASRC1_CTL0 (0x0744) 209 #define CDC_WSA_SPLINE_ASRC1_CTL1 (0x0748) 210 #define CDC_WSA_SPLINE_ASRC1_FIFO_CTL (0x074C) 211 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB (0x0750) 212 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB (0x0754) 213 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB (0x0758) 214 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB (0x075C) 215 #define CDC_WSA_SPLINE_ASRC1_STATUS_FIFO (0x0760) 216 #define WSA_MAX_OFFSET (0x0760) 217 218 #define WSA_MACRO_RX_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\ 219 SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\ 220 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000) 221 #define WSA_MACRO_RX_MIX_RATES (SNDRV_PCM_RATE_48000 |\ 222 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000) 223 #define WSA_MACRO_RX_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\ 224 SNDRV_PCM_FMTBIT_S24_LE |\ 225 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE) 226 227 #define WSA_MACRO_ECHO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\ 228 SNDRV_PCM_RATE_48000) 229 #define WSA_MACRO_ECHO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\ 230 SNDRV_PCM_FMTBIT_S24_LE |\ 231 SNDRV_PCM_FMTBIT_S24_3LE) 232 233 #define NUM_INTERPOLATORS 2 234 #define WSA_NUM_CLKS_MAX 5 235 #define WSA_MACRO_MCLK_FREQ 19200000 236 #define WSA_MACRO_MUX_INP_MASK2 0x38 237 #define WSA_MACRO_MUX_CFG_OFFSET 0x8 238 #define WSA_MACRO_MUX_CFG1_OFFSET 0x4 239 #define WSA_MACRO_RX_COMP_OFFSET 0x40 240 #define WSA_MACRO_RX_SOFTCLIP_OFFSET 0x40 241 #define WSA_MACRO_RX_PATH_OFFSET 0x80 242 #define WSA_MACRO_RX_PATH_CFG3_OFFSET 0x10 243 #define WSA_MACRO_RX_PATH_DSMDEM_OFFSET 0x4C 244 #define WSA_MACRO_FS_RATE_MASK 0x0F 245 #define WSA_MACRO_EC_MIX_TX0_MASK 0x03 246 #define WSA_MACRO_EC_MIX_TX1_MASK 0x18 247 #define WSA_MACRO_MAX_DMA_CH_PER_PORT 0x2 248 249 enum { 250 WSA_MACRO_GAIN_OFFSET_M1P5_DB, 251 WSA_MACRO_GAIN_OFFSET_0_DB, 252 }; 253 enum { 254 WSA_MACRO_RX0 = 0, 255 WSA_MACRO_RX1, 256 WSA_MACRO_RX_MIX, 257 WSA_MACRO_RX_MIX0 = WSA_MACRO_RX_MIX, 258 WSA_MACRO_RX_MIX1, 259 WSA_MACRO_RX_MAX, 260 }; 261 262 enum { 263 WSA_MACRO_TX0 = 0, 264 WSA_MACRO_TX1, 265 WSA_MACRO_TX_MAX, 266 }; 267 268 enum { 269 WSA_MACRO_EC0_MUX = 0, 270 WSA_MACRO_EC1_MUX, 271 WSA_MACRO_EC_MUX_MAX, 272 }; 273 274 enum { 275 WSA_MACRO_COMP1, /* SPK_L */ 276 WSA_MACRO_COMP2, /* SPK_R */ 277 WSA_MACRO_COMP_MAX 278 }; 279 280 enum { 281 WSA_MACRO_SOFTCLIP0, /* RX0 */ 282 WSA_MACRO_SOFTCLIP1, /* RX1 */ 283 WSA_MACRO_SOFTCLIP_MAX 284 }; 285 286 enum { 287 INTn_1_INP_SEL_ZERO = 0, 288 INTn_1_INP_SEL_RX0, 289 INTn_1_INP_SEL_RX1, 290 INTn_1_INP_SEL_RX2, 291 INTn_1_INP_SEL_RX3, 292 INTn_1_INP_SEL_DEC0, 293 INTn_1_INP_SEL_DEC1, 294 }; 295 296 enum { 297 INTn_2_INP_SEL_ZERO = 0, 298 INTn_2_INP_SEL_RX0, 299 INTn_2_INP_SEL_RX1, 300 INTn_2_INP_SEL_RX2, 301 INTn_2_INP_SEL_RX3, 302 }; 303 304 struct interp_sample_rate { 305 int sample_rate; 306 int rate_val; 307 }; 308 309 static struct interp_sample_rate int_prim_sample_rate_val[] = { 310 {8000, 0x0}, /* 8K */ 311 {16000, 0x1}, /* 16K */ 312 {24000, -EINVAL},/* 24K */ 313 {32000, 0x3}, /* 32K */ 314 {48000, 0x4}, /* 48K */ 315 {96000, 0x5}, /* 96K */ 316 {192000, 0x6}, /* 192K */ 317 {384000, 0x7}, /* 384K */ 318 {44100, 0x8}, /* 44.1K */ 319 }; 320 321 static struct interp_sample_rate int_mix_sample_rate_val[] = { 322 {48000, 0x4}, /* 48K */ 323 {96000, 0x5}, /* 96K */ 324 {192000, 0x6}, /* 192K */ 325 }; 326 327 enum { 328 WSA_MACRO_AIF_INVALID = 0, 329 WSA_MACRO_AIF1_PB, 330 WSA_MACRO_AIF_MIX1_PB, 331 WSA_MACRO_AIF_VI, 332 WSA_MACRO_AIF_ECHO, 333 WSA_MACRO_MAX_DAIS, 334 }; 335 336 struct wsa_macro { 337 struct device *dev; 338 int comp_enabled[WSA_MACRO_COMP_MAX]; 339 int ec_hq[WSA_MACRO_RX1 + 1]; 340 u16 prim_int_users[WSA_MACRO_RX1 + 1]; 341 u16 wsa_mclk_users; 342 unsigned long active_ch_mask[WSA_MACRO_MAX_DAIS]; 343 unsigned long active_ch_cnt[WSA_MACRO_MAX_DAIS]; 344 int rx_port_value[WSA_MACRO_RX_MAX]; 345 int ear_spkr_gain; 346 int spkr_gain_offset; 347 int spkr_mode; 348 int is_softclip_on[WSA_MACRO_SOFTCLIP_MAX]; 349 int softclip_clk_users[WSA_MACRO_SOFTCLIP_MAX]; 350 struct regmap *regmap; 351 struct clk *mclk; 352 struct clk *npl; 353 struct clk *macro; 354 struct clk *dcodec; 355 struct clk *fsgen; 356 struct clk_hw hw; 357 }; 358 #define to_wsa_macro(_hw) container_of(_hw, struct wsa_macro, hw) 359 360 static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400); 361 362 static const char *const rx_text[] = { 363 "ZERO", "RX0", "RX1", "RX_MIX0", "RX_MIX1", "DEC0", "DEC1" 364 }; 365 366 static const char *const rx_mix_text[] = { 367 "ZERO", "RX0", "RX1", "RX_MIX0", "RX_MIX1" 368 }; 369 370 static const char *const rx_mix_ec_text[] = { 371 "ZERO", "RX_MIX_TX0", "RX_MIX_TX1" 372 }; 373 374 static const char *const rx_mux_text[] = { 375 "ZERO", "AIF1_PB", "AIF_MIX1_PB" 376 }; 377 378 static const char *const rx_sidetone_mix_text[] = { 379 "ZERO", "SRC0" 380 }; 381 382 static const char * const wsa_macro_ear_spkr_pa_gain_text[] = { 383 "G_DEFAULT", "G_0_DB", "G_1_DB", "G_2_DB", "G_3_DB", 384 "G_4_DB", "G_5_DB", "G_6_DB" 385 }; 386 387 static SOC_ENUM_SINGLE_EXT_DECL(wsa_macro_ear_spkr_pa_gain_enum, 388 wsa_macro_ear_spkr_pa_gain_text); 389 390 /* RX INT0 */ 391 static const struct soc_enum rx0_prim_inp0_chain_enum = 392 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG0, 393 0, 7, rx_text); 394 395 static const struct soc_enum rx0_prim_inp1_chain_enum = 396 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG0, 397 3, 7, rx_text); 398 399 static const struct soc_enum rx0_prim_inp2_chain_enum = 400 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG1, 401 3, 7, rx_text); 402 403 static const struct soc_enum rx0_mix_chain_enum = 404 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG1, 405 0, 5, rx_mix_text); 406 407 static const struct soc_enum rx0_sidetone_mix_enum = 408 SOC_ENUM_SINGLE(SND_SOC_NOPM, 0, 2, rx_sidetone_mix_text); 409 410 static const struct snd_kcontrol_new rx0_prim_inp0_mux = 411 SOC_DAPM_ENUM("WSA_RX0 INP0 Mux", rx0_prim_inp0_chain_enum); 412 413 static const struct snd_kcontrol_new rx0_prim_inp1_mux = 414 SOC_DAPM_ENUM("WSA_RX0 INP1 Mux", rx0_prim_inp1_chain_enum); 415 416 static const struct snd_kcontrol_new rx0_prim_inp2_mux = 417 SOC_DAPM_ENUM("WSA_RX0 INP2 Mux", rx0_prim_inp2_chain_enum); 418 419 static const struct snd_kcontrol_new rx0_mix_mux = 420 SOC_DAPM_ENUM("WSA_RX0 MIX Mux", rx0_mix_chain_enum); 421 422 static const struct snd_kcontrol_new rx0_sidetone_mix_mux = 423 SOC_DAPM_ENUM("WSA_RX0 SIDETONE MIX Mux", rx0_sidetone_mix_enum); 424 425 /* RX INT1 */ 426 static const struct soc_enum rx1_prim_inp0_chain_enum = 427 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG0, 428 0, 7, rx_text); 429 430 static const struct soc_enum rx1_prim_inp1_chain_enum = 431 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG0, 432 3, 7, rx_text); 433 434 static const struct soc_enum rx1_prim_inp2_chain_enum = 435 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG1, 436 3, 7, rx_text); 437 438 static const struct soc_enum rx1_mix_chain_enum = 439 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG1, 440 0, 5, rx_mix_text); 441 442 static const struct snd_kcontrol_new rx1_prim_inp0_mux = 443 SOC_DAPM_ENUM("WSA_RX1 INP0 Mux", rx1_prim_inp0_chain_enum); 444 445 static const struct snd_kcontrol_new rx1_prim_inp1_mux = 446 SOC_DAPM_ENUM("WSA_RX1 INP1 Mux", rx1_prim_inp1_chain_enum); 447 448 static const struct snd_kcontrol_new rx1_prim_inp2_mux = 449 SOC_DAPM_ENUM("WSA_RX1 INP2 Mux", rx1_prim_inp2_chain_enum); 450 451 static const struct snd_kcontrol_new rx1_mix_mux = 452 SOC_DAPM_ENUM("WSA_RX1 MIX Mux", rx1_mix_chain_enum); 453 454 static const struct soc_enum rx_mix_ec0_enum = 455 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_MIX_CFG0, 456 0, 3, rx_mix_ec_text); 457 458 static const struct soc_enum rx_mix_ec1_enum = 459 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_MIX_CFG0, 460 3, 3, rx_mix_ec_text); 461 462 static const struct snd_kcontrol_new rx_mix_ec0_mux = 463 SOC_DAPM_ENUM("WSA RX_MIX EC0_Mux", rx_mix_ec0_enum); 464 465 static const struct snd_kcontrol_new rx_mix_ec1_mux = 466 SOC_DAPM_ENUM("WSA RX_MIX EC1_Mux", rx_mix_ec1_enum); 467 468 static const struct reg_default wsa_defaults[] = { 469 /* WSA Macro */ 470 { CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL, 0x00}, 471 { CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL, 0x00}, 472 { CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 0x00}, 473 { CDC_WSA_TOP_TOP_CFG0, 0x00}, 474 { CDC_WSA_TOP_TOP_CFG1, 0x00}, 475 { CDC_WSA_TOP_FREQ_MCLK, 0x00}, 476 { CDC_WSA_TOP_DEBUG_BUS_SEL, 0x00}, 477 { CDC_WSA_TOP_DEBUG_EN0, 0x00}, 478 { CDC_WSA_TOP_DEBUG_EN1, 0x00}, 479 { CDC_WSA_TOP_DEBUG_DSM_LB, 0x88}, 480 { CDC_WSA_TOP_RX_I2S_CTL, 0x0C}, 481 { CDC_WSA_TOP_TX_I2S_CTL, 0x0C}, 482 { CDC_WSA_TOP_I2S_CLK, 0x02}, 483 { CDC_WSA_TOP_I2S_RESET, 0x00}, 484 { CDC_WSA_RX_INP_MUX_RX_INT0_CFG0, 0x00}, 485 { CDC_WSA_RX_INP_MUX_RX_INT0_CFG1, 0x00}, 486 { CDC_WSA_RX_INP_MUX_RX_INT1_CFG0, 0x00}, 487 { CDC_WSA_RX_INP_MUX_RX_INT1_CFG1, 0x00}, 488 { CDC_WSA_RX_INP_MUX_RX_MIX_CFG0, 0x00}, 489 { CDC_WSA_RX_INP_MUX_RX_EC_CFG0, 0x00}, 490 { CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0, 0x00}, 491 { CDC_WSA_TX0_SPKR_PROT_PATH_CTL, 0x02}, 492 { CDC_WSA_TX0_SPKR_PROT_PATH_CFG0, 0x00}, 493 { CDC_WSA_TX1_SPKR_PROT_PATH_CTL, 0x02}, 494 { CDC_WSA_TX1_SPKR_PROT_PATH_CFG0, 0x00}, 495 { CDC_WSA_TX2_SPKR_PROT_PATH_CTL, 0x02}, 496 { CDC_WSA_TX2_SPKR_PROT_PATH_CFG0, 0x00}, 497 { CDC_WSA_TX3_SPKR_PROT_PATH_CTL, 0x02}, 498 { CDC_WSA_TX3_SPKR_PROT_PATH_CFG0, 0x00}, 499 { CDC_WSA_INTR_CTRL_CFG, 0x00}, 500 { CDC_WSA_INTR_CTRL_CLR_COMMIT, 0x00}, 501 { CDC_WSA_INTR_CTRL_PIN1_MASK0, 0xFF}, 502 { CDC_WSA_INTR_CTRL_PIN1_STATUS0, 0x00}, 503 { CDC_WSA_INTR_CTRL_PIN1_CLEAR0, 0x00}, 504 { CDC_WSA_INTR_CTRL_PIN2_MASK0, 0xFF}, 505 { CDC_WSA_INTR_CTRL_PIN2_STATUS0, 0x00}, 506 { CDC_WSA_INTR_CTRL_PIN2_CLEAR0, 0x00}, 507 { CDC_WSA_INTR_CTRL_LEVEL0, 0x00}, 508 { CDC_WSA_INTR_CTRL_BYPASS0, 0x00}, 509 { CDC_WSA_INTR_CTRL_SET0, 0x00}, 510 { CDC_WSA_RX0_RX_PATH_CTL, 0x04}, 511 { CDC_WSA_RX0_RX_PATH_CFG0, 0x00}, 512 { CDC_WSA_RX0_RX_PATH_CFG1, 0x64}, 513 { CDC_WSA_RX0_RX_PATH_CFG2, 0x8F}, 514 { CDC_WSA_RX0_RX_PATH_CFG3, 0x00}, 515 { CDC_WSA_RX0_RX_VOL_CTL, 0x00}, 516 { CDC_WSA_RX0_RX_PATH_MIX_CTL, 0x04}, 517 { CDC_WSA_RX0_RX_PATH_MIX_CFG, 0x7E}, 518 { CDC_WSA_RX0_RX_VOL_MIX_CTL, 0x00}, 519 { CDC_WSA_RX0_RX_PATH_SEC0, 0x04}, 520 { CDC_WSA_RX0_RX_PATH_SEC1, 0x08}, 521 { CDC_WSA_RX0_RX_PATH_SEC2, 0x00}, 522 { CDC_WSA_RX0_RX_PATH_SEC3, 0x00}, 523 { CDC_WSA_RX0_RX_PATH_SEC5, 0x00}, 524 { CDC_WSA_RX0_RX_PATH_SEC6, 0x00}, 525 { CDC_WSA_RX0_RX_PATH_SEC7, 0x00}, 526 { CDC_WSA_RX0_RX_PATH_MIX_SEC0, 0x08}, 527 { CDC_WSA_RX0_RX_PATH_MIX_SEC1, 0x00}, 528 { CDC_WSA_RX0_RX_PATH_DSMDEM_CTL, 0x00}, 529 { CDC_WSA_RX1_RX_PATH_CFG0, 0x00}, 530 { CDC_WSA_RX1_RX_PATH_CFG1, 0x64}, 531 { CDC_WSA_RX1_RX_PATH_CFG2, 0x8F}, 532 { CDC_WSA_RX1_RX_PATH_CFG3, 0x00}, 533 { CDC_WSA_RX1_RX_VOL_CTL, 0x00}, 534 { CDC_WSA_RX1_RX_PATH_MIX_CTL, 0x04}, 535 { CDC_WSA_RX1_RX_PATH_MIX_CFG, 0x7E}, 536 { CDC_WSA_RX1_RX_VOL_MIX_CTL, 0x00}, 537 { CDC_WSA_RX1_RX_PATH_SEC0, 0x04}, 538 { CDC_WSA_RX1_RX_PATH_SEC1, 0x08}, 539 { CDC_WSA_RX1_RX_PATH_SEC2, 0x00}, 540 { CDC_WSA_RX1_RX_PATH_SEC3, 0x00}, 541 { CDC_WSA_RX1_RX_PATH_SEC5, 0x00}, 542 { CDC_WSA_RX1_RX_PATH_SEC6, 0x00}, 543 { CDC_WSA_RX1_RX_PATH_SEC7, 0x00}, 544 { CDC_WSA_RX1_RX_PATH_MIX_SEC0, 0x08}, 545 { CDC_WSA_RX1_RX_PATH_MIX_SEC1, 0x00}, 546 { CDC_WSA_RX1_RX_PATH_DSMDEM_CTL, 0x00}, 547 { CDC_WSA_BOOST0_BOOST_PATH_CTL, 0x00}, 548 { CDC_WSA_BOOST0_BOOST_CTL, 0xD0}, 549 { CDC_WSA_BOOST0_BOOST_CFG1, 0x89}, 550 { CDC_WSA_BOOST0_BOOST_CFG2, 0x04}, 551 { CDC_WSA_BOOST1_BOOST_PATH_CTL, 0x00}, 552 { CDC_WSA_BOOST1_BOOST_CTL, 0xD0}, 553 { CDC_WSA_BOOST1_BOOST_CFG1, 0x89}, 554 { CDC_WSA_BOOST1_BOOST_CFG2, 0x04}, 555 { CDC_WSA_COMPANDER0_CTL0, 0x60}, 556 { CDC_WSA_COMPANDER0_CTL1, 0xDB}, 557 { CDC_WSA_COMPANDER0_CTL2, 0xFF}, 558 { CDC_WSA_COMPANDER0_CTL3, 0x35}, 559 { CDC_WSA_COMPANDER0_CTL4, 0xFF}, 560 { CDC_WSA_COMPANDER0_CTL5, 0x00}, 561 { CDC_WSA_COMPANDER0_CTL6, 0x01}, 562 { CDC_WSA_COMPANDER0_CTL7, 0x28}, 563 { CDC_WSA_COMPANDER1_CTL0, 0x60}, 564 { CDC_WSA_COMPANDER1_CTL1, 0xDB}, 565 { CDC_WSA_COMPANDER1_CTL2, 0xFF}, 566 { CDC_WSA_COMPANDER1_CTL3, 0x35}, 567 { CDC_WSA_COMPANDER1_CTL4, 0xFF}, 568 { CDC_WSA_COMPANDER1_CTL5, 0x00}, 569 { CDC_WSA_COMPANDER1_CTL6, 0x01}, 570 { CDC_WSA_COMPANDER1_CTL7, 0x28}, 571 { CDC_WSA_SOFTCLIP0_CRC, 0x00}, 572 { CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL, 0x38}, 573 { CDC_WSA_SOFTCLIP1_CRC, 0x00}, 574 { CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL, 0x38}, 575 { CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL, 0x00}, 576 { CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0, 0x01}, 577 { CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL, 0x00}, 578 { CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0, 0x01}, 579 { CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL, 0x00}, 580 { CDC_WSA_SPLINE_ASRC0_CTL0, 0x00}, 581 { CDC_WSA_SPLINE_ASRC0_CTL1, 0x00}, 582 { CDC_WSA_SPLINE_ASRC0_FIFO_CTL, 0xA8}, 583 { CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB, 0x00}, 584 { CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB, 0x00}, 585 { CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB, 0x00}, 586 { CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB, 0x00}, 587 { CDC_WSA_SPLINE_ASRC0_STATUS_FIFO, 0x00}, 588 { CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL, 0x00}, 589 { CDC_WSA_SPLINE_ASRC1_CTL0, 0x00}, 590 { CDC_WSA_SPLINE_ASRC1_CTL1, 0x00}, 591 { CDC_WSA_SPLINE_ASRC1_FIFO_CTL, 0xA8}, 592 { CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB, 0x00}, 593 { CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB, 0x00}, 594 { CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB, 0x00}, 595 { CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB, 0x00}, 596 { CDC_WSA_SPLINE_ASRC1_STATUS_FIFO, 0x00}, 597 }; 598 599 static bool wsa_is_wronly_register(struct device *dev, 600 unsigned int reg) 601 { 602 switch (reg) { 603 case CDC_WSA_INTR_CTRL_CLR_COMMIT: 604 case CDC_WSA_INTR_CTRL_PIN1_CLEAR0: 605 case CDC_WSA_INTR_CTRL_PIN2_CLEAR0: 606 return true; 607 } 608 609 return false; 610 } 611 612 static bool wsa_is_rw_register(struct device *dev, unsigned int reg) 613 { 614 switch (reg) { 615 case CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL: 616 case CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL: 617 case CDC_WSA_CLK_RST_CTRL_SWR_CONTROL: 618 case CDC_WSA_TOP_TOP_CFG0: 619 case CDC_WSA_TOP_TOP_CFG1: 620 case CDC_WSA_TOP_FREQ_MCLK: 621 case CDC_WSA_TOP_DEBUG_BUS_SEL: 622 case CDC_WSA_TOP_DEBUG_EN0: 623 case CDC_WSA_TOP_DEBUG_EN1: 624 case CDC_WSA_TOP_DEBUG_DSM_LB: 625 case CDC_WSA_TOP_RX_I2S_CTL: 626 case CDC_WSA_TOP_TX_I2S_CTL: 627 case CDC_WSA_TOP_I2S_CLK: 628 case CDC_WSA_TOP_I2S_RESET: 629 case CDC_WSA_RX_INP_MUX_RX_INT0_CFG0: 630 case CDC_WSA_RX_INP_MUX_RX_INT0_CFG1: 631 case CDC_WSA_RX_INP_MUX_RX_INT1_CFG0: 632 case CDC_WSA_RX_INP_MUX_RX_INT1_CFG1: 633 case CDC_WSA_RX_INP_MUX_RX_MIX_CFG0: 634 case CDC_WSA_RX_INP_MUX_RX_EC_CFG0: 635 case CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0: 636 case CDC_WSA_TX0_SPKR_PROT_PATH_CTL: 637 case CDC_WSA_TX0_SPKR_PROT_PATH_CFG0: 638 case CDC_WSA_TX1_SPKR_PROT_PATH_CTL: 639 case CDC_WSA_TX1_SPKR_PROT_PATH_CFG0: 640 case CDC_WSA_TX2_SPKR_PROT_PATH_CTL: 641 case CDC_WSA_TX2_SPKR_PROT_PATH_CFG0: 642 case CDC_WSA_TX3_SPKR_PROT_PATH_CTL: 643 case CDC_WSA_TX3_SPKR_PROT_PATH_CFG0: 644 case CDC_WSA_INTR_CTRL_CFG: 645 case CDC_WSA_INTR_CTRL_PIN1_MASK0: 646 case CDC_WSA_INTR_CTRL_PIN2_MASK0: 647 case CDC_WSA_INTR_CTRL_LEVEL0: 648 case CDC_WSA_INTR_CTRL_BYPASS0: 649 case CDC_WSA_INTR_CTRL_SET0: 650 case CDC_WSA_RX0_RX_PATH_CTL: 651 case CDC_WSA_RX0_RX_PATH_CFG0: 652 case CDC_WSA_RX0_RX_PATH_CFG1: 653 case CDC_WSA_RX0_RX_PATH_CFG2: 654 case CDC_WSA_RX0_RX_PATH_CFG3: 655 case CDC_WSA_RX0_RX_VOL_CTL: 656 case CDC_WSA_RX0_RX_PATH_MIX_CTL: 657 case CDC_WSA_RX0_RX_PATH_MIX_CFG: 658 case CDC_WSA_RX0_RX_VOL_MIX_CTL: 659 case CDC_WSA_RX0_RX_PATH_SEC0: 660 case CDC_WSA_RX0_RX_PATH_SEC1: 661 case CDC_WSA_RX0_RX_PATH_SEC2: 662 case CDC_WSA_RX0_RX_PATH_SEC3: 663 case CDC_WSA_RX0_RX_PATH_SEC5: 664 case CDC_WSA_RX0_RX_PATH_SEC6: 665 case CDC_WSA_RX0_RX_PATH_SEC7: 666 case CDC_WSA_RX0_RX_PATH_MIX_SEC0: 667 case CDC_WSA_RX0_RX_PATH_MIX_SEC1: 668 case CDC_WSA_RX0_RX_PATH_DSMDEM_CTL: 669 case CDC_WSA_RX1_RX_PATH_CTL: 670 case CDC_WSA_RX1_RX_PATH_CFG0: 671 case CDC_WSA_RX1_RX_PATH_CFG1: 672 case CDC_WSA_RX1_RX_PATH_CFG2: 673 case CDC_WSA_RX1_RX_PATH_CFG3: 674 case CDC_WSA_RX1_RX_VOL_CTL: 675 case CDC_WSA_RX1_RX_PATH_MIX_CTL: 676 case CDC_WSA_RX1_RX_PATH_MIX_CFG: 677 case CDC_WSA_RX1_RX_VOL_MIX_CTL: 678 case CDC_WSA_RX1_RX_PATH_SEC0: 679 case CDC_WSA_RX1_RX_PATH_SEC1: 680 case CDC_WSA_RX1_RX_PATH_SEC2: 681 case CDC_WSA_RX1_RX_PATH_SEC3: 682 case CDC_WSA_RX1_RX_PATH_SEC5: 683 case CDC_WSA_RX1_RX_PATH_SEC6: 684 case CDC_WSA_RX1_RX_PATH_SEC7: 685 case CDC_WSA_RX1_RX_PATH_MIX_SEC0: 686 case CDC_WSA_RX1_RX_PATH_MIX_SEC1: 687 case CDC_WSA_RX1_RX_PATH_DSMDEM_CTL: 688 case CDC_WSA_BOOST0_BOOST_PATH_CTL: 689 case CDC_WSA_BOOST0_BOOST_CTL: 690 case CDC_WSA_BOOST0_BOOST_CFG1: 691 case CDC_WSA_BOOST0_BOOST_CFG2: 692 case CDC_WSA_BOOST1_BOOST_PATH_CTL: 693 case CDC_WSA_BOOST1_BOOST_CTL: 694 case CDC_WSA_BOOST1_BOOST_CFG1: 695 case CDC_WSA_BOOST1_BOOST_CFG2: 696 case CDC_WSA_COMPANDER0_CTL0: 697 case CDC_WSA_COMPANDER0_CTL1: 698 case CDC_WSA_COMPANDER0_CTL2: 699 case CDC_WSA_COMPANDER0_CTL3: 700 case CDC_WSA_COMPANDER0_CTL4: 701 case CDC_WSA_COMPANDER0_CTL5: 702 case CDC_WSA_COMPANDER0_CTL7: 703 case CDC_WSA_COMPANDER1_CTL0: 704 case CDC_WSA_COMPANDER1_CTL1: 705 case CDC_WSA_COMPANDER1_CTL2: 706 case CDC_WSA_COMPANDER1_CTL3: 707 case CDC_WSA_COMPANDER1_CTL4: 708 case CDC_WSA_COMPANDER1_CTL5: 709 case CDC_WSA_COMPANDER1_CTL7: 710 case CDC_WSA_SOFTCLIP0_CRC: 711 case CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL: 712 case CDC_WSA_SOFTCLIP1_CRC: 713 case CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL: 714 case CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL: 715 case CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0: 716 case CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL: 717 case CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0: 718 case CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL: 719 case CDC_WSA_SPLINE_ASRC0_CTL0: 720 case CDC_WSA_SPLINE_ASRC0_CTL1: 721 case CDC_WSA_SPLINE_ASRC0_FIFO_CTL: 722 case CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL: 723 case CDC_WSA_SPLINE_ASRC1_CTL0: 724 case CDC_WSA_SPLINE_ASRC1_CTL1: 725 case CDC_WSA_SPLINE_ASRC1_FIFO_CTL: 726 return true; 727 } 728 729 return false; 730 } 731 732 static bool wsa_is_writeable_register(struct device *dev, unsigned int reg) 733 { 734 bool ret; 735 736 ret = wsa_is_rw_register(dev, reg); 737 if (!ret) 738 return wsa_is_wronly_register(dev, reg); 739 740 return ret; 741 } 742 743 static bool wsa_is_readable_register(struct device *dev, unsigned int reg) 744 { 745 switch (reg) { 746 case CDC_WSA_INTR_CTRL_CLR_COMMIT: 747 case CDC_WSA_INTR_CTRL_PIN1_CLEAR0: 748 case CDC_WSA_INTR_CTRL_PIN2_CLEAR0: 749 case CDC_WSA_INTR_CTRL_PIN1_STATUS0: 750 case CDC_WSA_INTR_CTRL_PIN2_STATUS0: 751 case CDC_WSA_COMPANDER0_CTL6: 752 case CDC_WSA_COMPANDER1_CTL6: 753 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB: 754 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB: 755 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB: 756 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB: 757 case CDC_WSA_SPLINE_ASRC0_STATUS_FIFO: 758 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB: 759 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB: 760 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB: 761 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB: 762 case CDC_WSA_SPLINE_ASRC1_STATUS_FIFO: 763 return true; 764 } 765 766 return wsa_is_rw_register(dev, reg); 767 } 768 769 static bool wsa_is_volatile_register(struct device *dev, unsigned int reg) 770 { 771 /* Update volatile list for rx/tx macros */ 772 switch (reg) { 773 case CDC_WSA_INTR_CTRL_PIN1_STATUS0: 774 case CDC_WSA_INTR_CTRL_PIN2_STATUS0: 775 case CDC_WSA_COMPANDER0_CTL6: 776 case CDC_WSA_COMPANDER1_CTL6: 777 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB: 778 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB: 779 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB: 780 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB: 781 case CDC_WSA_SPLINE_ASRC0_STATUS_FIFO: 782 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB: 783 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB: 784 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB: 785 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB: 786 case CDC_WSA_SPLINE_ASRC1_STATUS_FIFO: 787 return true; 788 } 789 return false; 790 } 791 792 static const struct regmap_config wsa_regmap_config = { 793 .name = "wsa_macro", 794 .reg_bits = 16, 795 .val_bits = 32, /* 8 but with 32 bit read/write */ 796 .reg_stride = 4, 797 .cache_type = REGCACHE_FLAT, 798 .reg_defaults = wsa_defaults, 799 .num_reg_defaults = ARRAY_SIZE(wsa_defaults), 800 .max_register = WSA_MAX_OFFSET, 801 .writeable_reg = wsa_is_writeable_register, 802 .volatile_reg = wsa_is_volatile_register, 803 .readable_reg = wsa_is_readable_register, 804 }; 805 806 /** 807 * wsa_macro_set_spkr_mode - Configures speaker compander and smartboost 808 * settings based on speaker mode. 809 * 810 * @component: codec instance 811 * @mode: Indicates speaker configuration mode. 812 * 813 * Returns 0 on success or -EINVAL on error. 814 */ 815 int wsa_macro_set_spkr_mode(struct snd_soc_component *component, int mode) 816 { 817 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 818 819 wsa->spkr_mode = mode; 820 821 switch (mode) { 822 case WSA_MACRO_SPKR_MODE_1: 823 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL3, 0x80, 0x00); 824 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL3, 0x80, 0x00); 825 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL7, 0x01, 0x00); 826 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL7, 0x01, 0x00); 827 snd_soc_component_update_bits(component, CDC_WSA_BOOST0_BOOST_CTL, 0x7C, 0x44); 828 snd_soc_component_update_bits(component, CDC_WSA_BOOST1_BOOST_CTL, 0x7C, 0x44); 829 break; 830 default: 831 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL3, 0x80, 0x80); 832 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL3, 0x80, 0x80); 833 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL7, 0x01, 0x01); 834 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL7, 0x01, 0x01); 835 snd_soc_component_update_bits(component, CDC_WSA_BOOST0_BOOST_CTL, 0x7C, 0x58); 836 snd_soc_component_update_bits(component, CDC_WSA_BOOST1_BOOST_CTL, 0x7C, 0x58); 837 break; 838 } 839 return 0; 840 } 841 EXPORT_SYMBOL(wsa_macro_set_spkr_mode); 842 843 static int wsa_macro_set_prim_interpolator_rate(struct snd_soc_dai *dai, 844 u8 int_prim_fs_rate_reg_val, 845 u32 sample_rate) 846 { 847 u8 int_1_mix1_inp; 848 u32 j, port; 849 u16 int_mux_cfg0, int_mux_cfg1; 850 u16 int_fs_reg; 851 u8 inp0_sel, inp1_sel, inp2_sel; 852 struct snd_soc_component *component = dai->component; 853 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 854 855 for_each_set_bit(port, &wsa->active_ch_mask[dai->id], WSA_MACRO_RX_MAX) { 856 int_1_mix1_inp = port; 857 if ((int_1_mix1_inp < WSA_MACRO_RX0) || (int_1_mix1_inp > WSA_MACRO_RX_MIX1)) { 858 dev_err(component->dev, "%s: Invalid RX port, Dai ID is %d\n", 859 __func__, dai->id); 860 return -EINVAL; 861 } 862 863 int_mux_cfg0 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG0; 864 865 /* 866 * Loop through all interpolator MUX inputs and find out 867 * to which interpolator input, the cdc_dma rx port 868 * is connected 869 */ 870 for (j = 0; j < NUM_INTERPOLATORS; j++) { 871 int_mux_cfg1 = int_mux_cfg0 + WSA_MACRO_MUX_CFG1_OFFSET; 872 inp0_sel = snd_soc_component_read_field(component, int_mux_cfg0, 873 CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK); 874 inp1_sel = snd_soc_component_read_field(component, int_mux_cfg0, 875 CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK); 876 inp2_sel = snd_soc_component_read_field(component, int_mux_cfg1, 877 CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK); 878 879 if ((inp0_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0) || 880 (inp1_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0) || 881 (inp2_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0)) { 882 int_fs_reg = CDC_WSA_RX0_RX_PATH_CTL + 883 WSA_MACRO_RX_PATH_OFFSET * j; 884 /* sample_rate is in Hz */ 885 snd_soc_component_update_bits(component, int_fs_reg, 886 WSA_MACRO_FS_RATE_MASK, 887 int_prim_fs_rate_reg_val); 888 } 889 int_mux_cfg0 += WSA_MACRO_MUX_CFG_OFFSET; 890 } 891 } 892 893 return 0; 894 } 895 896 static int wsa_macro_set_mix_interpolator_rate(struct snd_soc_dai *dai, 897 u8 int_mix_fs_rate_reg_val, 898 u32 sample_rate) 899 { 900 u8 int_2_inp; 901 u32 j, port; 902 u16 int_mux_cfg1, int_fs_reg; 903 u8 int_mux_cfg1_val; 904 struct snd_soc_component *component = dai->component; 905 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 906 907 for_each_set_bit(port, &wsa->active_ch_mask[dai->id], WSA_MACRO_RX_MAX) { 908 int_2_inp = port; 909 if ((int_2_inp < WSA_MACRO_RX0) || (int_2_inp > WSA_MACRO_RX_MIX1)) { 910 dev_err(component->dev, "%s: Invalid RX port, Dai ID is %d\n", 911 __func__, dai->id); 912 return -EINVAL; 913 } 914 915 int_mux_cfg1 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG1; 916 for (j = 0; j < NUM_INTERPOLATORS; j++) { 917 int_mux_cfg1_val = snd_soc_component_read_field(component, int_mux_cfg1, 918 CDC_WSA_RX_INTX_2_SEL_MASK); 919 920 if (int_mux_cfg1_val == int_2_inp + INTn_2_INP_SEL_RX0) { 921 int_fs_reg = CDC_WSA_RX0_RX_PATH_MIX_CTL + 922 WSA_MACRO_RX_PATH_OFFSET * j; 923 924 snd_soc_component_update_bits(component, 925 int_fs_reg, 926 WSA_MACRO_FS_RATE_MASK, 927 int_mix_fs_rate_reg_val); 928 } 929 int_mux_cfg1 += WSA_MACRO_MUX_CFG_OFFSET; 930 } 931 } 932 return 0; 933 } 934 935 static int wsa_macro_set_interpolator_rate(struct snd_soc_dai *dai, 936 u32 sample_rate) 937 { 938 int rate_val = 0; 939 int i, ret; 940 941 /* set mixing path rate */ 942 for (i = 0; i < ARRAY_SIZE(int_mix_sample_rate_val); i++) { 943 if (sample_rate == int_mix_sample_rate_val[i].sample_rate) { 944 rate_val = int_mix_sample_rate_val[i].rate_val; 945 break; 946 } 947 } 948 if ((i == ARRAY_SIZE(int_mix_sample_rate_val)) || (rate_val < 0)) 949 goto prim_rate; 950 951 ret = wsa_macro_set_mix_interpolator_rate(dai, (u8) rate_val, sample_rate); 952 if (ret < 0) 953 return ret; 954 prim_rate: 955 /* set primary path sample rate */ 956 for (i = 0; i < ARRAY_SIZE(int_prim_sample_rate_val); i++) { 957 if (sample_rate == int_prim_sample_rate_val[i].sample_rate) { 958 rate_val = int_prim_sample_rate_val[i].rate_val; 959 break; 960 } 961 } 962 if ((i == ARRAY_SIZE(int_prim_sample_rate_val)) || (rate_val < 0)) 963 return -EINVAL; 964 965 ret = wsa_macro_set_prim_interpolator_rate(dai, (u8) rate_val, sample_rate); 966 967 return ret; 968 } 969 970 static int wsa_macro_hw_params(struct snd_pcm_substream *substream, 971 struct snd_pcm_hw_params *params, 972 struct snd_soc_dai *dai) 973 { 974 struct snd_soc_component *component = dai->component; 975 int ret; 976 977 switch (substream->stream) { 978 case SNDRV_PCM_STREAM_PLAYBACK: 979 ret = wsa_macro_set_interpolator_rate(dai, params_rate(params)); 980 if (ret) { 981 dev_err(component->dev, 982 "%s: cannot set sample rate: %u\n", 983 __func__, params_rate(params)); 984 return ret; 985 } 986 break; 987 default: 988 break; 989 } 990 return 0; 991 } 992 993 static int wsa_macro_get_channel_map(struct snd_soc_dai *dai, 994 unsigned int *tx_num, unsigned int *tx_slot, 995 unsigned int *rx_num, unsigned int *rx_slot) 996 { 997 struct snd_soc_component *component = dai->component; 998 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 999 u16 val, mask = 0, cnt = 0, temp; 1000 1001 switch (dai->id) { 1002 case WSA_MACRO_AIF_VI: 1003 *tx_slot = wsa->active_ch_mask[dai->id]; 1004 *tx_num = wsa->active_ch_cnt[dai->id]; 1005 break; 1006 case WSA_MACRO_AIF1_PB: 1007 case WSA_MACRO_AIF_MIX1_PB: 1008 for_each_set_bit(temp, &wsa->active_ch_mask[dai->id], 1009 WSA_MACRO_RX_MAX) { 1010 mask |= (1 << temp); 1011 if (++cnt == WSA_MACRO_MAX_DMA_CH_PER_PORT) 1012 break; 1013 } 1014 if (mask & 0x0C) 1015 mask = mask >> 0x2; 1016 *rx_slot = mask; 1017 *rx_num = cnt; 1018 break; 1019 case WSA_MACRO_AIF_ECHO: 1020 val = snd_soc_component_read(component, CDC_WSA_RX_INP_MUX_RX_MIX_CFG0); 1021 if (val & WSA_MACRO_EC_MIX_TX1_MASK) { 1022 mask |= 0x2; 1023 cnt++; 1024 } 1025 if (val & WSA_MACRO_EC_MIX_TX0_MASK) { 1026 mask |= 0x1; 1027 cnt++; 1028 } 1029 *tx_slot = mask; 1030 *tx_num = cnt; 1031 break; 1032 default: 1033 dev_err(component->dev, "%s: Invalid AIF\n", __func__); 1034 break; 1035 } 1036 return 0; 1037 } 1038 1039 static const struct snd_soc_dai_ops wsa_macro_dai_ops = { 1040 .hw_params = wsa_macro_hw_params, 1041 .get_channel_map = wsa_macro_get_channel_map, 1042 }; 1043 1044 static struct snd_soc_dai_driver wsa_macro_dai[] = { 1045 { 1046 .name = "wsa_macro_rx1", 1047 .id = WSA_MACRO_AIF1_PB, 1048 .playback = { 1049 .stream_name = "WSA_AIF1 Playback", 1050 .rates = WSA_MACRO_RX_RATES, 1051 .formats = WSA_MACRO_RX_FORMATS, 1052 .rate_max = 384000, 1053 .rate_min = 8000, 1054 .channels_min = 1, 1055 .channels_max = 2, 1056 }, 1057 .ops = &wsa_macro_dai_ops, 1058 }, 1059 { 1060 .name = "wsa_macro_rx_mix", 1061 .id = WSA_MACRO_AIF_MIX1_PB, 1062 .playback = { 1063 .stream_name = "WSA_AIF_MIX1 Playback", 1064 .rates = WSA_MACRO_RX_MIX_RATES, 1065 .formats = WSA_MACRO_RX_FORMATS, 1066 .rate_max = 192000, 1067 .rate_min = 48000, 1068 .channels_min = 1, 1069 .channels_max = 2, 1070 }, 1071 .ops = &wsa_macro_dai_ops, 1072 }, 1073 { 1074 .name = "wsa_macro_vifeedback", 1075 .id = WSA_MACRO_AIF_VI, 1076 .capture = { 1077 .stream_name = "WSA_AIF_VI Capture", 1078 .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_48000, 1079 .formats = WSA_MACRO_RX_FORMATS, 1080 .rate_max = 48000, 1081 .rate_min = 8000, 1082 .channels_min = 1, 1083 .channels_max = 4, 1084 }, 1085 .ops = &wsa_macro_dai_ops, 1086 }, 1087 { 1088 .name = "wsa_macro_echo", 1089 .id = WSA_MACRO_AIF_ECHO, 1090 .capture = { 1091 .stream_name = "WSA_AIF_ECHO Capture", 1092 .rates = WSA_MACRO_ECHO_RATES, 1093 .formats = WSA_MACRO_ECHO_FORMATS, 1094 .rate_max = 48000, 1095 .rate_min = 8000, 1096 .channels_min = 1, 1097 .channels_max = 2, 1098 }, 1099 .ops = &wsa_macro_dai_ops, 1100 }, 1101 }; 1102 1103 static void wsa_macro_mclk_enable(struct wsa_macro *wsa, bool mclk_enable) 1104 { 1105 struct regmap *regmap = wsa->regmap; 1106 1107 if (mclk_enable) { 1108 if (wsa->wsa_mclk_users == 0) { 1109 regcache_mark_dirty(regmap); 1110 regcache_sync(regmap); 1111 /* 9.6MHz MCLK, set value 0x00 if other frequency */ 1112 regmap_update_bits(regmap, CDC_WSA_TOP_FREQ_MCLK, 0x01, 0x01); 1113 regmap_update_bits(regmap, 1114 CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL, 1115 CDC_WSA_MCLK_EN_MASK, 1116 CDC_WSA_MCLK_ENABLE); 1117 regmap_update_bits(regmap, 1118 CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL, 1119 CDC_WSA_FS_CNT_EN_MASK, 1120 CDC_WSA_FS_CNT_ENABLE); 1121 } 1122 wsa->wsa_mclk_users++; 1123 } else { 1124 if (wsa->wsa_mclk_users <= 0) { 1125 dev_err(wsa->dev, "clock already disabled\n"); 1126 wsa->wsa_mclk_users = 0; 1127 return; 1128 } 1129 wsa->wsa_mclk_users--; 1130 if (wsa->wsa_mclk_users == 0) { 1131 regmap_update_bits(regmap, 1132 CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL, 1133 CDC_WSA_FS_CNT_EN_MASK, 1134 CDC_WSA_FS_CNT_DISABLE); 1135 regmap_update_bits(regmap, 1136 CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL, 1137 CDC_WSA_MCLK_EN_MASK, 1138 CDC_WSA_MCLK_DISABLE); 1139 } 1140 } 1141 } 1142 1143 static int wsa_macro_mclk_event(struct snd_soc_dapm_widget *w, 1144 struct snd_kcontrol *kcontrol, int event) 1145 { 1146 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1147 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1148 1149 wsa_macro_mclk_enable(wsa, event == SND_SOC_DAPM_PRE_PMU); 1150 return 0; 1151 } 1152 1153 static int wsa_macro_enable_vi_feedback(struct snd_soc_dapm_widget *w, 1154 struct snd_kcontrol *kcontrol, 1155 int event) 1156 { 1157 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1158 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1159 u32 tx_reg0, tx_reg1; 1160 1161 if (test_bit(WSA_MACRO_TX0, &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) { 1162 tx_reg0 = CDC_WSA_TX0_SPKR_PROT_PATH_CTL; 1163 tx_reg1 = CDC_WSA_TX1_SPKR_PROT_PATH_CTL; 1164 } else if (test_bit(WSA_MACRO_TX1, &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) { 1165 tx_reg0 = CDC_WSA_TX2_SPKR_PROT_PATH_CTL; 1166 tx_reg1 = CDC_WSA_TX3_SPKR_PROT_PATH_CTL; 1167 } 1168 1169 switch (event) { 1170 case SND_SOC_DAPM_POST_PMU: 1171 /* Enable V&I sensing */ 1172 snd_soc_component_update_bits(component, tx_reg0, 1173 CDC_WSA_TX_SPKR_PROT_RESET_MASK, 1174 CDC_WSA_TX_SPKR_PROT_RESET); 1175 snd_soc_component_update_bits(component, tx_reg1, 1176 CDC_WSA_TX_SPKR_PROT_RESET_MASK, 1177 CDC_WSA_TX_SPKR_PROT_RESET); 1178 snd_soc_component_update_bits(component, tx_reg0, 1179 CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK, 1180 CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K); 1181 snd_soc_component_update_bits(component, tx_reg1, 1182 CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK, 1183 CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K); 1184 snd_soc_component_update_bits(component, tx_reg0, 1185 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK, 1186 CDC_WSA_TX_SPKR_PROT_CLK_ENABLE); 1187 snd_soc_component_update_bits(component, tx_reg1, 1188 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK, 1189 CDC_WSA_TX_SPKR_PROT_CLK_ENABLE); 1190 snd_soc_component_update_bits(component, tx_reg0, 1191 CDC_WSA_TX_SPKR_PROT_RESET_MASK, 1192 CDC_WSA_TX_SPKR_PROT_NO_RESET); 1193 snd_soc_component_update_bits(component, tx_reg1, 1194 CDC_WSA_TX_SPKR_PROT_RESET_MASK, 1195 CDC_WSA_TX_SPKR_PROT_NO_RESET); 1196 break; 1197 case SND_SOC_DAPM_POST_PMD: 1198 /* Disable V&I sensing */ 1199 snd_soc_component_update_bits(component, tx_reg0, 1200 CDC_WSA_TX_SPKR_PROT_RESET_MASK, 1201 CDC_WSA_TX_SPKR_PROT_RESET); 1202 snd_soc_component_update_bits(component, tx_reg1, 1203 CDC_WSA_TX_SPKR_PROT_RESET_MASK, 1204 CDC_WSA_TX_SPKR_PROT_RESET); 1205 snd_soc_component_update_bits(component, tx_reg0, 1206 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK, 1207 CDC_WSA_TX_SPKR_PROT_CLK_DISABLE); 1208 snd_soc_component_update_bits(component, tx_reg1, 1209 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK, 1210 CDC_WSA_TX_SPKR_PROT_CLK_DISABLE); 1211 break; 1212 } 1213 1214 return 0; 1215 } 1216 1217 static int wsa_macro_enable_mix_path(struct snd_soc_dapm_widget *w, 1218 struct snd_kcontrol *kcontrol, int event) 1219 { 1220 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1221 u16 path_reg, gain_reg; 1222 int val; 1223 1224 switch (w->shift) { 1225 case WSA_MACRO_RX_MIX0: 1226 path_reg = CDC_WSA_RX0_RX_PATH_MIX_CTL; 1227 gain_reg = CDC_WSA_RX0_RX_VOL_MIX_CTL; 1228 break; 1229 case WSA_MACRO_RX_MIX1: 1230 path_reg = CDC_WSA_RX1_RX_PATH_MIX_CTL; 1231 gain_reg = CDC_WSA_RX1_RX_VOL_MIX_CTL; 1232 break; 1233 default: 1234 return 0; 1235 } 1236 1237 switch (event) { 1238 case SND_SOC_DAPM_POST_PMU: 1239 val = snd_soc_component_read(component, gain_reg); 1240 snd_soc_component_write(component, gain_reg, val); 1241 break; 1242 case SND_SOC_DAPM_POST_PMD: 1243 snd_soc_component_update_bits(component, path_reg, 1244 CDC_WSA_RX_PATH_MIX_CLK_EN_MASK, 1245 CDC_WSA_RX_PATH_MIX_CLK_DISABLE); 1246 break; 1247 } 1248 1249 return 0; 1250 } 1251 1252 static void wsa_macro_hd2_control(struct snd_soc_component *component, 1253 u16 reg, int event) 1254 { 1255 u16 hd2_scale_reg; 1256 u16 hd2_enable_reg; 1257 1258 if (reg == CDC_WSA_RX0_RX_PATH_CTL) { 1259 hd2_scale_reg = CDC_WSA_RX0_RX_PATH_SEC3; 1260 hd2_enable_reg = CDC_WSA_RX0_RX_PATH_CFG0; 1261 } 1262 if (reg == CDC_WSA_RX1_RX_PATH_CTL) { 1263 hd2_scale_reg = CDC_WSA_RX1_RX_PATH_SEC3; 1264 hd2_enable_reg = CDC_WSA_RX1_RX_PATH_CFG0; 1265 } 1266 1267 if (hd2_enable_reg && SND_SOC_DAPM_EVENT_ON(event)) { 1268 snd_soc_component_update_bits(component, hd2_scale_reg, 1269 CDC_WSA_RX_PATH_HD2_ALPHA_MASK, 1270 0x10); 1271 snd_soc_component_update_bits(component, hd2_scale_reg, 1272 CDC_WSA_RX_PATH_HD2_SCALE_MASK, 1273 0x1); 1274 snd_soc_component_update_bits(component, hd2_enable_reg, 1275 CDC_WSA_RX_PATH_HD2_EN_MASK, 1276 CDC_WSA_RX_PATH_HD2_ENABLE); 1277 } 1278 1279 if (hd2_enable_reg && SND_SOC_DAPM_EVENT_OFF(event)) { 1280 snd_soc_component_update_bits(component, hd2_enable_reg, 1281 CDC_WSA_RX_PATH_HD2_EN_MASK, 0); 1282 snd_soc_component_update_bits(component, hd2_scale_reg, 1283 CDC_WSA_RX_PATH_HD2_SCALE_MASK, 1284 0); 1285 snd_soc_component_update_bits(component, hd2_scale_reg, 1286 CDC_WSA_RX_PATH_HD2_ALPHA_MASK, 1287 0); 1288 } 1289 } 1290 1291 static int wsa_macro_config_compander(struct snd_soc_component *component, 1292 int comp, int event) 1293 { 1294 u16 comp_ctl0_reg, rx_path_cfg0_reg; 1295 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1296 1297 if (!wsa->comp_enabled[comp]) 1298 return 0; 1299 1300 comp_ctl0_reg = CDC_WSA_COMPANDER0_CTL0 + 1301 (comp * WSA_MACRO_RX_COMP_OFFSET); 1302 rx_path_cfg0_reg = CDC_WSA_RX0_RX_PATH_CFG0 + 1303 (comp * WSA_MACRO_RX_PATH_OFFSET); 1304 1305 if (SND_SOC_DAPM_EVENT_ON(event)) { 1306 /* Enable Compander Clock */ 1307 snd_soc_component_update_bits(component, comp_ctl0_reg, 1308 CDC_WSA_COMPANDER_CLK_EN_MASK, 1309 CDC_WSA_COMPANDER_CLK_ENABLE); 1310 snd_soc_component_update_bits(component, comp_ctl0_reg, 1311 CDC_WSA_COMPANDER_SOFT_RST_MASK, 1312 CDC_WSA_COMPANDER_SOFT_RST_ENABLE); 1313 snd_soc_component_update_bits(component, comp_ctl0_reg, 1314 CDC_WSA_COMPANDER_SOFT_RST_MASK, 1315 0); 1316 snd_soc_component_update_bits(component, rx_path_cfg0_reg, 1317 CDC_WSA_RX_PATH_COMP_EN_MASK, 1318 CDC_WSA_RX_PATH_COMP_ENABLE); 1319 } 1320 1321 if (SND_SOC_DAPM_EVENT_OFF(event)) { 1322 snd_soc_component_update_bits(component, comp_ctl0_reg, 1323 CDC_WSA_COMPANDER_HALT_MASK, 1324 CDC_WSA_COMPANDER_HALT); 1325 snd_soc_component_update_bits(component, rx_path_cfg0_reg, 1326 CDC_WSA_RX_PATH_COMP_EN_MASK, 0); 1327 snd_soc_component_update_bits(component, comp_ctl0_reg, 1328 CDC_WSA_COMPANDER_SOFT_RST_MASK, 1329 CDC_WSA_COMPANDER_SOFT_RST_ENABLE); 1330 snd_soc_component_update_bits(component, comp_ctl0_reg, 1331 CDC_WSA_COMPANDER_SOFT_RST_MASK, 1332 0); 1333 snd_soc_component_update_bits(component, comp_ctl0_reg, 1334 CDC_WSA_COMPANDER_CLK_EN_MASK, 0); 1335 snd_soc_component_update_bits(component, comp_ctl0_reg, 1336 CDC_WSA_COMPANDER_HALT_MASK, 0); 1337 } 1338 1339 return 0; 1340 } 1341 1342 static void wsa_macro_enable_softclip_clk(struct snd_soc_component *component, 1343 struct wsa_macro *wsa, 1344 int path, 1345 bool enable) 1346 { 1347 u16 softclip_clk_reg = CDC_WSA_SOFTCLIP0_CRC + 1348 (path * WSA_MACRO_RX_SOFTCLIP_OFFSET); 1349 u8 softclip_mux_mask = (1 << path); 1350 u8 softclip_mux_value = (1 << path); 1351 1352 if (enable) { 1353 if (wsa->softclip_clk_users[path] == 0) { 1354 snd_soc_component_update_bits(component, 1355 softclip_clk_reg, 1356 CDC_WSA_SOFTCLIP_CLK_EN_MASK, 1357 CDC_WSA_SOFTCLIP_CLK_ENABLE); 1358 snd_soc_component_update_bits(component, 1359 CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0, 1360 softclip_mux_mask, softclip_mux_value); 1361 } 1362 wsa->softclip_clk_users[path]++; 1363 } else { 1364 wsa->softclip_clk_users[path]--; 1365 if (wsa->softclip_clk_users[path] == 0) { 1366 snd_soc_component_update_bits(component, 1367 softclip_clk_reg, 1368 CDC_WSA_SOFTCLIP_CLK_EN_MASK, 1369 0); 1370 snd_soc_component_update_bits(component, 1371 CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0, 1372 softclip_mux_mask, 0x00); 1373 } 1374 } 1375 } 1376 1377 static int wsa_macro_config_softclip(struct snd_soc_component *component, 1378 int path, int event) 1379 { 1380 u16 softclip_ctrl_reg; 1381 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1382 int softclip_path = 0; 1383 1384 if (path == WSA_MACRO_COMP1) 1385 softclip_path = WSA_MACRO_SOFTCLIP0; 1386 else if (path == WSA_MACRO_COMP2) 1387 softclip_path = WSA_MACRO_SOFTCLIP1; 1388 1389 if (!wsa->is_softclip_on[softclip_path]) 1390 return 0; 1391 1392 softclip_ctrl_reg = CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL + 1393 (softclip_path * WSA_MACRO_RX_SOFTCLIP_OFFSET); 1394 1395 if (SND_SOC_DAPM_EVENT_ON(event)) { 1396 /* Enable Softclip clock and mux */ 1397 wsa_macro_enable_softclip_clk(component, wsa, softclip_path, 1398 true); 1399 /* Enable Softclip control */ 1400 snd_soc_component_update_bits(component, softclip_ctrl_reg, 1401 CDC_WSA_SOFTCLIP_EN_MASK, 1402 CDC_WSA_SOFTCLIP_ENABLE); 1403 } 1404 1405 if (SND_SOC_DAPM_EVENT_OFF(event)) { 1406 snd_soc_component_update_bits(component, softclip_ctrl_reg, 1407 CDC_WSA_SOFTCLIP_EN_MASK, 0); 1408 wsa_macro_enable_softclip_clk(component, wsa, softclip_path, 1409 false); 1410 } 1411 1412 return 0; 1413 } 1414 1415 static bool wsa_macro_adie_lb(struct snd_soc_component *component, 1416 int interp_idx) 1417 { 1418 u16 int_mux_cfg0, int_mux_cfg1; 1419 u8 int_n_inp0, int_n_inp1, int_n_inp2; 1420 1421 int_mux_cfg0 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG0 + interp_idx * 8; 1422 int_mux_cfg1 = int_mux_cfg0 + 4; 1423 1424 int_n_inp0 = snd_soc_component_read_field(component, int_mux_cfg0, 1425 CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK); 1426 if (int_n_inp0 == INTn_1_INP_SEL_DEC0 || 1427 int_n_inp0 == INTn_1_INP_SEL_DEC1) 1428 return true; 1429 1430 int_n_inp1 = snd_soc_component_read_field(component, int_mux_cfg0, 1431 CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK); 1432 if (int_n_inp1 == INTn_1_INP_SEL_DEC0 || 1433 int_n_inp1 == INTn_1_INP_SEL_DEC1) 1434 return true; 1435 1436 int_n_inp2 = snd_soc_component_read_field(component, int_mux_cfg1, 1437 CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK); 1438 if (int_n_inp2 == INTn_1_INP_SEL_DEC0 || 1439 int_n_inp2 == INTn_1_INP_SEL_DEC1) 1440 return true; 1441 1442 return false; 1443 } 1444 1445 static int wsa_macro_enable_main_path(struct snd_soc_dapm_widget *w, 1446 struct snd_kcontrol *kcontrol, 1447 int event) 1448 { 1449 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1450 u16 reg; 1451 1452 reg = CDC_WSA_RX0_RX_PATH_CTL + WSA_MACRO_RX_PATH_OFFSET * w->shift; 1453 switch (event) { 1454 case SND_SOC_DAPM_PRE_PMU: 1455 if (wsa_macro_adie_lb(component, w->shift)) { 1456 snd_soc_component_update_bits(component, reg, 1457 CDC_WSA_RX_PATH_CLK_EN_MASK, 1458 CDC_WSA_RX_PATH_CLK_ENABLE); 1459 } 1460 break; 1461 default: 1462 break; 1463 } 1464 return 0; 1465 } 1466 1467 static int wsa_macro_interp_get_primary_reg(u16 reg, u16 *ind) 1468 { 1469 u16 prim_int_reg = 0; 1470 1471 switch (reg) { 1472 case CDC_WSA_RX0_RX_PATH_CTL: 1473 case CDC_WSA_RX0_RX_PATH_MIX_CTL: 1474 prim_int_reg = CDC_WSA_RX0_RX_PATH_CTL; 1475 *ind = 0; 1476 break; 1477 case CDC_WSA_RX1_RX_PATH_CTL: 1478 case CDC_WSA_RX1_RX_PATH_MIX_CTL: 1479 prim_int_reg = CDC_WSA_RX1_RX_PATH_CTL; 1480 *ind = 1; 1481 break; 1482 } 1483 1484 return prim_int_reg; 1485 } 1486 1487 static int wsa_macro_enable_prim_interpolator(struct snd_soc_component *component, 1488 u16 reg, int event) 1489 { 1490 u16 prim_int_reg; 1491 u16 ind = 0; 1492 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1493 1494 prim_int_reg = wsa_macro_interp_get_primary_reg(reg, &ind); 1495 1496 switch (event) { 1497 case SND_SOC_DAPM_PRE_PMU: 1498 wsa->prim_int_users[ind]++; 1499 if (wsa->prim_int_users[ind] == 1) { 1500 snd_soc_component_update_bits(component, 1501 prim_int_reg + WSA_MACRO_RX_PATH_CFG3_OFFSET, 1502 CDC_WSA_RX_DC_DCOEFF_MASK, 1503 0x3); 1504 snd_soc_component_update_bits(component, prim_int_reg, 1505 CDC_WSA_RX_PATH_PGA_MUTE_EN_MASK, 1506 CDC_WSA_RX_PATH_PGA_MUTE_ENABLE); 1507 wsa_macro_hd2_control(component, prim_int_reg, event); 1508 snd_soc_component_update_bits(component, 1509 prim_int_reg + WSA_MACRO_RX_PATH_DSMDEM_OFFSET, 1510 CDC_WSA_RX_DSMDEM_CLK_EN_MASK, 1511 CDC_WSA_RX_DSMDEM_CLK_ENABLE); 1512 } 1513 if ((reg != prim_int_reg) && 1514 ((snd_soc_component_read( 1515 component, prim_int_reg)) & 0x10)) 1516 snd_soc_component_update_bits(component, reg, 1517 0x10, 0x10); 1518 break; 1519 case SND_SOC_DAPM_POST_PMD: 1520 wsa->prim_int_users[ind]--; 1521 if (wsa->prim_int_users[ind] == 0) { 1522 snd_soc_component_update_bits(component, 1523 prim_int_reg + WSA_MACRO_RX_PATH_DSMDEM_OFFSET, 1524 CDC_WSA_RX_DSMDEM_CLK_EN_MASK, 0); 1525 wsa_macro_hd2_control(component, prim_int_reg, event); 1526 } 1527 break; 1528 } 1529 1530 return 0; 1531 } 1532 1533 static int wsa_macro_config_ear_spkr_gain(struct snd_soc_component *component, 1534 struct wsa_macro *wsa, 1535 int event, int gain_reg) 1536 { 1537 int comp_gain_offset, val; 1538 1539 switch (wsa->spkr_mode) { 1540 /* Compander gain in WSA_MACRO_SPKR_MODE1 case is 12 dB */ 1541 case WSA_MACRO_SPKR_MODE_1: 1542 comp_gain_offset = -12; 1543 break; 1544 /* Default case compander gain is 15 dB */ 1545 default: 1546 comp_gain_offset = -15; 1547 break; 1548 } 1549 1550 switch (event) { 1551 case SND_SOC_DAPM_POST_PMU: 1552 /* Apply ear spkr gain only if compander is enabled */ 1553 if (wsa->comp_enabled[WSA_MACRO_COMP1] && 1554 (gain_reg == CDC_WSA_RX0_RX_VOL_CTL) && 1555 (wsa->ear_spkr_gain != 0)) { 1556 /* For example, val is -8(-12+5-1) for 4dB of gain */ 1557 val = comp_gain_offset + wsa->ear_spkr_gain - 1; 1558 snd_soc_component_write(component, gain_reg, val); 1559 } 1560 break; 1561 case SND_SOC_DAPM_POST_PMD: 1562 /* 1563 * Reset RX0 volume to 0 dB if compander is enabled and 1564 * ear_spkr_gain is non-zero. 1565 */ 1566 if (wsa->comp_enabled[WSA_MACRO_COMP1] && 1567 (gain_reg == CDC_WSA_RX0_RX_VOL_CTL) && 1568 (wsa->ear_spkr_gain != 0)) { 1569 snd_soc_component_write(component, gain_reg, 0x0); 1570 } 1571 break; 1572 } 1573 1574 return 0; 1575 } 1576 1577 static int wsa_macro_enable_interpolator(struct snd_soc_dapm_widget *w, 1578 struct snd_kcontrol *kcontrol, 1579 int event) 1580 { 1581 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1582 u16 gain_reg; 1583 u16 reg; 1584 int val; 1585 int offset_val = 0; 1586 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1587 1588 if (w->shift == WSA_MACRO_COMP1) { 1589 reg = CDC_WSA_RX0_RX_PATH_CTL; 1590 gain_reg = CDC_WSA_RX0_RX_VOL_CTL; 1591 } else if (w->shift == WSA_MACRO_COMP2) { 1592 reg = CDC_WSA_RX1_RX_PATH_CTL; 1593 gain_reg = CDC_WSA_RX1_RX_VOL_CTL; 1594 } 1595 1596 switch (event) { 1597 case SND_SOC_DAPM_PRE_PMU: 1598 /* Reset if needed */ 1599 wsa_macro_enable_prim_interpolator(component, reg, event); 1600 break; 1601 case SND_SOC_DAPM_POST_PMU: 1602 wsa_macro_config_compander(component, w->shift, event); 1603 wsa_macro_config_softclip(component, w->shift, event); 1604 /* apply gain after int clk is enabled */ 1605 if ((wsa->spkr_gain_offset == WSA_MACRO_GAIN_OFFSET_M1P5_DB) && 1606 (wsa->comp_enabled[WSA_MACRO_COMP1] || 1607 wsa->comp_enabled[WSA_MACRO_COMP2])) { 1608 snd_soc_component_update_bits(component, 1609 CDC_WSA_RX0_RX_PATH_SEC1, 1610 CDC_WSA_RX_PGA_HALF_DB_MASK, 1611 CDC_WSA_RX_PGA_HALF_DB_ENABLE); 1612 snd_soc_component_update_bits(component, 1613 CDC_WSA_RX0_RX_PATH_MIX_SEC0, 1614 CDC_WSA_RX_PGA_HALF_DB_MASK, 1615 CDC_WSA_RX_PGA_HALF_DB_ENABLE); 1616 snd_soc_component_update_bits(component, 1617 CDC_WSA_RX1_RX_PATH_SEC1, 1618 CDC_WSA_RX_PGA_HALF_DB_MASK, 1619 CDC_WSA_RX_PGA_HALF_DB_ENABLE); 1620 snd_soc_component_update_bits(component, 1621 CDC_WSA_RX1_RX_PATH_MIX_SEC0, 1622 CDC_WSA_RX_PGA_HALF_DB_MASK, 1623 CDC_WSA_RX_PGA_HALF_DB_ENABLE); 1624 offset_val = -2; 1625 } 1626 val = snd_soc_component_read(component, gain_reg); 1627 val += offset_val; 1628 snd_soc_component_write(component, gain_reg, val); 1629 wsa_macro_config_ear_spkr_gain(component, wsa, 1630 event, gain_reg); 1631 break; 1632 case SND_SOC_DAPM_POST_PMD: 1633 wsa_macro_config_compander(component, w->shift, event); 1634 wsa_macro_config_softclip(component, w->shift, event); 1635 wsa_macro_enable_prim_interpolator(component, reg, event); 1636 if ((wsa->spkr_gain_offset == WSA_MACRO_GAIN_OFFSET_M1P5_DB) && 1637 (wsa->comp_enabled[WSA_MACRO_COMP1] || 1638 wsa->comp_enabled[WSA_MACRO_COMP2])) { 1639 snd_soc_component_update_bits(component, 1640 CDC_WSA_RX0_RX_PATH_SEC1, 1641 CDC_WSA_RX_PGA_HALF_DB_MASK, 1642 CDC_WSA_RX_PGA_HALF_DB_DISABLE); 1643 snd_soc_component_update_bits(component, 1644 CDC_WSA_RX0_RX_PATH_MIX_SEC0, 1645 CDC_WSA_RX_PGA_HALF_DB_MASK, 1646 CDC_WSA_RX_PGA_HALF_DB_DISABLE); 1647 snd_soc_component_update_bits(component, 1648 CDC_WSA_RX1_RX_PATH_SEC1, 1649 CDC_WSA_RX_PGA_HALF_DB_MASK, 1650 CDC_WSA_RX_PGA_HALF_DB_DISABLE); 1651 snd_soc_component_update_bits(component, 1652 CDC_WSA_RX1_RX_PATH_MIX_SEC0, 1653 CDC_WSA_RX_PGA_HALF_DB_MASK, 1654 CDC_WSA_RX_PGA_HALF_DB_DISABLE); 1655 offset_val = 2; 1656 val = snd_soc_component_read(component, gain_reg); 1657 val += offset_val; 1658 snd_soc_component_write(component, gain_reg, val); 1659 } 1660 wsa_macro_config_ear_spkr_gain(component, wsa, 1661 event, gain_reg); 1662 break; 1663 } 1664 1665 return 0; 1666 } 1667 1668 static int wsa_macro_spk_boost_event(struct snd_soc_dapm_widget *w, 1669 struct snd_kcontrol *kcontrol, 1670 int event) 1671 { 1672 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1673 u16 boost_path_ctl, boost_path_cfg1; 1674 u16 reg, reg_mix; 1675 1676 if (!strcmp(w->name, "WSA_RX INT0 CHAIN")) { 1677 boost_path_ctl = CDC_WSA_BOOST0_BOOST_PATH_CTL; 1678 boost_path_cfg1 = CDC_WSA_RX0_RX_PATH_CFG1; 1679 reg = CDC_WSA_RX0_RX_PATH_CTL; 1680 reg_mix = CDC_WSA_RX0_RX_PATH_MIX_CTL; 1681 } else if (!strcmp(w->name, "WSA_RX INT1 CHAIN")) { 1682 boost_path_ctl = CDC_WSA_BOOST1_BOOST_PATH_CTL; 1683 boost_path_cfg1 = CDC_WSA_RX1_RX_PATH_CFG1; 1684 reg = CDC_WSA_RX1_RX_PATH_CTL; 1685 reg_mix = CDC_WSA_RX1_RX_PATH_MIX_CTL; 1686 } 1687 1688 switch (event) { 1689 case SND_SOC_DAPM_PRE_PMU: 1690 snd_soc_component_update_bits(component, boost_path_cfg1, 1691 CDC_WSA_RX_PATH_SMART_BST_EN_MASK, 1692 CDC_WSA_RX_PATH_SMART_BST_ENABLE); 1693 snd_soc_component_update_bits(component, boost_path_ctl, 1694 CDC_WSA_BOOST_PATH_CLK_EN_MASK, 1695 CDC_WSA_BOOST_PATH_CLK_ENABLE); 1696 if ((snd_soc_component_read(component, reg_mix)) & 0x10) 1697 snd_soc_component_update_bits(component, reg_mix, 1698 0x10, 0x00); 1699 break; 1700 case SND_SOC_DAPM_POST_PMU: 1701 snd_soc_component_update_bits(component, reg, 0x10, 0x00); 1702 break; 1703 case SND_SOC_DAPM_POST_PMD: 1704 snd_soc_component_update_bits(component, boost_path_ctl, 1705 CDC_WSA_BOOST_PATH_CLK_EN_MASK, 1706 CDC_WSA_BOOST_PATH_CLK_DISABLE); 1707 snd_soc_component_update_bits(component, boost_path_cfg1, 1708 CDC_WSA_RX_PATH_SMART_BST_EN_MASK, 1709 CDC_WSA_RX_PATH_SMART_BST_DISABLE); 1710 break; 1711 } 1712 1713 return 0; 1714 } 1715 1716 static int wsa_macro_enable_echo(struct snd_soc_dapm_widget *w, 1717 struct snd_kcontrol *kcontrol, 1718 int event) 1719 { 1720 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 1721 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1722 u16 val, ec_tx, ec_hq_reg; 1723 1724 val = snd_soc_component_read(component, CDC_WSA_RX_INP_MUX_RX_MIX_CFG0); 1725 1726 switch (w->shift) { 1727 case WSA_MACRO_EC0_MUX: 1728 val = val & CDC_WSA_RX_MIX_TX0_SEL_MASK; 1729 ec_tx = val - 1; 1730 break; 1731 case WSA_MACRO_EC1_MUX: 1732 val = val & CDC_WSA_RX_MIX_TX1_SEL_MASK; 1733 ec_tx = (val >> CDC_WSA_RX_MIX_TX1_SEL_SHFT) - 1; 1734 break; 1735 default: 1736 dev_err(component->dev, "%s: Invalid shift %u\n", 1737 __func__, w->shift); 1738 return -EINVAL; 1739 } 1740 1741 if (wsa->ec_hq[ec_tx]) { 1742 ec_hq_reg = CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL + 0x40 * ec_tx; 1743 snd_soc_component_update_bits(component, ec_hq_reg, 1744 CDC_WSA_EC_HQ_EC_CLK_EN_MASK, 1745 CDC_WSA_EC_HQ_EC_CLK_ENABLE); 1746 ec_hq_reg = CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0 + 0x40 * ec_tx; 1747 /* default set to 48k */ 1748 snd_soc_component_update_bits(component, ec_hq_reg, 1749 CDC_WSA_EC_HQ_EC_REF_PCM_RATE_MASK, 1750 CDC_WSA_EC_HQ_EC_REF_PCM_RATE_48K); 1751 } 1752 1753 return 0; 1754 } 1755 1756 static int wsa_macro_get_ec_hq(struct snd_kcontrol *kcontrol, 1757 struct snd_ctl_elem_value *ucontrol) 1758 { 1759 1760 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1761 int ec_tx = ((struct soc_mixer_control *) kcontrol->private_value)->shift; 1762 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1763 1764 ucontrol->value.integer.value[0] = wsa->ec_hq[ec_tx]; 1765 1766 return 0; 1767 } 1768 1769 static int wsa_macro_set_ec_hq(struct snd_kcontrol *kcontrol, 1770 struct snd_ctl_elem_value *ucontrol) 1771 { 1772 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1773 int ec_tx = ((struct soc_mixer_control *) kcontrol->private_value)->shift; 1774 int value = ucontrol->value.integer.value[0]; 1775 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1776 1777 wsa->ec_hq[ec_tx] = value; 1778 1779 return 0; 1780 } 1781 1782 static int wsa_macro_get_compander(struct snd_kcontrol *kcontrol, 1783 struct snd_ctl_elem_value *ucontrol) 1784 { 1785 1786 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1787 int comp = ((struct soc_mixer_control *) kcontrol->private_value)->shift; 1788 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1789 1790 ucontrol->value.integer.value[0] = wsa->comp_enabled[comp]; 1791 return 0; 1792 } 1793 1794 static int wsa_macro_set_compander(struct snd_kcontrol *kcontrol, 1795 struct snd_ctl_elem_value *ucontrol) 1796 { 1797 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1798 int comp = ((struct soc_mixer_control *) kcontrol->private_value)->shift; 1799 int value = ucontrol->value.integer.value[0]; 1800 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1801 1802 wsa->comp_enabled[comp] = value; 1803 1804 return 0; 1805 } 1806 1807 static int wsa_macro_ear_spkr_pa_gain_get(struct snd_kcontrol *kcontrol, 1808 struct snd_ctl_elem_value *ucontrol) 1809 { 1810 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1811 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1812 1813 ucontrol->value.integer.value[0] = wsa->ear_spkr_gain; 1814 1815 return 0; 1816 } 1817 1818 static int wsa_macro_ear_spkr_pa_gain_put(struct snd_kcontrol *kcontrol, 1819 struct snd_ctl_elem_value *ucontrol) 1820 { 1821 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1822 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1823 1824 wsa->ear_spkr_gain = ucontrol->value.integer.value[0]; 1825 1826 return 0; 1827 } 1828 1829 static int wsa_macro_rx_mux_get(struct snd_kcontrol *kcontrol, 1830 struct snd_ctl_elem_value *ucontrol) 1831 { 1832 struct snd_soc_dapm_widget *widget = 1833 snd_soc_dapm_kcontrol_widget(kcontrol); 1834 struct snd_soc_component *component = 1835 snd_soc_dapm_to_component(widget->dapm); 1836 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1837 1838 ucontrol->value.integer.value[0] = 1839 wsa->rx_port_value[widget->shift]; 1840 return 0; 1841 } 1842 1843 static int wsa_macro_rx_mux_put(struct snd_kcontrol *kcontrol, 1844 struct snd_ctl_elem_value *ucontrol) 1845 { 1846 struct snd_soc_dapm_widget *widget = 1847 snd_soc_dapm_kcontrol_widget(kcontrol); 1848 struct snd_soc_component *component = 1849 snd_soc_dapm_to_component(widget->dapm); 1850 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 1851 struct snd_soc_dapm_update *update = NULL; 1852 u32 rx_port_value = ucontrol->value.integer.value[0]; 1853 u32 bit_input; 1854 u32 aif_rst; 1855 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1856 1857 aif_rst = wsa->rx_port_value[widget->shift]; 1858 if (!rx_port_value) { 1859 if (aif_rst == 0) 1860 return 0; 1861 if (aif_rst >= WSA_MACRO_RX_MAX) { 1862 dev_err(component->dev, "%s: Invalid AIF reset\n", __func__); 1863 return 0; 1864 } 1865 } 1866 wsa->rx_port_value[widget->shift] = rx_port_value; 1867 1868 bit_input = widget->shift; 1869 1870 switch (rx_port_value) { 1871 case 0: 1872 if (wsa->active_ch_cnt[aif_rst]) { 1873 clear_bit(bit_input, 1874 &wsa->active_ch_mask[aif_rst]); 1875 wsa->active_ch_cnt[aif_rst]--; 1876 } 1877 break; 1878 case 1: 1879 case 2: 1880 set_bit(bit_input, 1881 &wsa->active_ch_mask[rx_port_value]); 1882 wsa->active_ch_cnt[rx_port_value]++; 1883 break; 1884 default: 1885 dev_err(component->dev, 1886 "%s: Invalid AIF_ID for WSA RX MUX %d\n", 1887 __func__, rx_port_value); 1888 return -EINVAL; 1889 } 1890 1891 snd_soc_dapm_mux_update_power(widget->dapm, kcontrol, 1892 rx_port_value, e, update); 1893 return 0; 1894 } 1895 1896 static int wsa_macro_soft_clip_enable_get(struct snd_kcontrol *kcontrol, 1897 struct snd_ctl_elem_value *ucontrol) 1898 { 1899 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1900 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1901 int path = ((struct soc_mixer_control *)kcontrol->private_value)->shift; 1902 1903 ucontrol->value.integer.value[0] = wsa->is_softclip_on[path]; 1904 1905 return 0; 1906 } 1907 1908 static int wsa_macro_soft_clip_enable_put(struct snd_kcontrol *kcontrol, 1909 struct snd_ctl_elem_value *ucontrol) 1910 { 1911 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 1912 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1913 int path = ((struct soc_mixer_control *) kcontrol->private_value)->shift; 1914 1915 wsa->is_softclip_on[path] = ucontrol->value.integer.value[0]; 1916 1917 return 0; 1918 } 1919 1920 static const struct snd_kcontrol_new wsa_macro_snd_controls[] = { 1921 SOC_ENUM_EXT("EAR SPKR PA Gain", wsa_macro_ear_spkr_pa_gain_enum, 1922 wsa_macro_ear_spkr_pa_gain_get, 1923 wsa_macro_ear_spkr_pa_gain_put), 1924 SOC_SINGLE_EXT("WSA_Softclip0 Enable", SND_SOC_NOPM, 1925 WSA_MACRO_SOFTCLIP0, 1, 0, 1926 wsa_macro_soft_clip_enable_get, 1927 wsa_macro_soft_clip_enable_put), 1928 SOC_SINGLE_EXT("WSA_Softclip1 Enable", SND_SOC_NOPM, 1929 WSA_MACRO_SOFTCLIP1, 1, 0, 1930 wsa_macro_soft_clip_enable_get, 1931 wsa_macro_soft_clip_enable_put), 1932 1933 SOC_SINGLE_S8_TLV("WSA_RX0 Digital Volume", CDC_WSA_RX0_RX_VOL_CTL, 1934 -84, 40, digital_gain), 1935 SOC_SINGLE_S8_TLV("WSA_RX1 Digital Volume", CDC_WSA_RX1_RX_VOL_CTL, 1936 -84, 40, digital_gain), 1937 1938 SOC_SINGLE("WSA_RX0 Digital Mute", CDC_WSA_RX0_RX_PATH_CTL, 4, 1, 0), 1939 SOC_SINGLE("WSA_RX1 Digital Mute", CDC_WSA_RX1_RX_PATH_CTL, 4, 1, 0), 1940 SOC_SINGLE("WSA_RX0_MIX Digital Mute", CDC_WSA_RX0_RX_PATH_MIX_CTL, 4, 1941 1, 0), 1942 SOC_SINGLE("WSA_RX1_MIX Digital Mute", CDC_WSA_RX1_RX_PATH_MIX_CTL, 4, 1943 1, 0), 1944 SOC_SINGLE_EXT("WSA_COMP1 Switch", SND_SOC_NOPM, WSA_MACRO_COMP1, 1, 0, 1945 wsa_macro_get_compander, wsa_macro_set_compander), 1946 SOC_SINGLE_EXT("WSA_COMP2 Switch", SND_SOC_NOPM, WSA_MACRO_COMP2, 1, 0, 1947 wsa_macro_get_compander, wsa_macro_set_compander), 1948 SOC_SINGLE_EXT("WSA_RX0 EC_HQ Switch", SND_SOC_NOPM, WSA_MACRO_RX0, 1, 0, 1949 wsa_macro_get_ec_hq, wsa_macro_set_ec_hq), 1950 SOC_SINGLE_EXT("WSA_RX1 EC_HQ Switch", SND_SOC_NOPM, WSA_MACRO_RX1, 1, 0, 1951 wsa_macro_get_ec_hq, wsa_macro_set_ec_hq), 1952 }; 1953 1954 static const struct soc_enum rx_mux_enum = 1955 SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(rx_mux_text), rx_mux_text); 1956 1957 static const struct snd_kcontrol_new rx_mux[WSA_MACRO_RX_MAX] = { 1958 SOC_DAPM_ENUM_EXT("WSA RX0 Mux", rx_mux_enum, 1959 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put), 1960 SOC_DAPM_ENUM_EXT("WSA RX1 Mux", rx_mux_enum, 1961 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put), 1962 SOC_DAPM_ENUM_EXT("WSA RX_MIX0 Mux", rx_mux_enum, 1963 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put), 1964 SOC_DAPM_ENUM_EXT("WSA RX_MIX1 Mux", rx_mux_enum, 1965 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put), 1966 }; 1967 1968 static int wsa_macro_vi_feed_mixer_get(struct snd_kcontrol *kcontrol, 1969 struct snd_ctl_elem_value *ucontrol) 1970 { 1971 struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol); 1972 struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm); 1973 struct soc_mixer_control *mixer = (struct soc_mixer_control *)kcontrol->private_value; 1974 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1975 u32 spk_tx_id = mixer->shift; 1976 u32 dai_id = widget->shift; 1977 1978 if (test_bit(spk_tx_id, &wsa->active_ch_mask[dai_id])) 1979 ucontrol->value.integer.value[0] = 1; 1980 else 1981 ucontrol->value.integer.value[0] = 0; 1982 1983 return 0; 1984 } 1985 1986 static int wsa_macro_vi_feed_mixer_put(struct snd_kcontrol *kcontrol, 1987 struct snd_ctl_elem_value *ucontrol) 1988 { 1989 struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol); 1990 struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm); 1991 struct soc_mixer_control *mixer = (struct soc_mixer_control *)kcontrol->private_value; 1992 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component); 1993 u32 enable = ucontrol->value.integer.value[0]; 1994 u32 spk_tx_id = mixer->shift; 1995 1996 if (enable) { 1997 if (spk_tx_id == WSA_MACRO_TX0 && 1998 !test_bit(WSA_MACRO_TX0, 1999 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) { 2000 set_bit(WSA_MACRO_TX0, 2001 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]); 2002 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]++; 2003 } 2004 if (spk_tx_id == WSA_MACRO_TX1 && 2005 !test_bit(WSA_MACRO_TX1, 2006 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) { 2007 set_bit(WSA_MACRO_TX1, 2008 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]); 2009 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]++; 2010 } 2011 } else { 2012 if (spk_tx_id == WSA_MACRO_TX0 && 2013 test_bit(WSA_MACRO_TX0, 2014 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) { 2015 clear_bit(WSA_MACRO_TX0, 2016 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]); 2017 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]--; 2018 } 2019 if (spk_tx_id == WSA_MACRO_TX1 && 2020 test_bit(WSA_MACRO_TX1, 2021 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) { 2022 clear_bit(WSA_MACRO_TX1, 2023 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]); 2024 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]--; 2025 } 2026 } 2027 snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, NULL); 2028 2029 return 0; 2030 } 2031 2032 static const struct snd_kcontrol_new aif_vi_mixer[] = { 2033 SOC_SINGLE_EXT("WSA_SPKR_VI_1", SND_SOC_NOPM, WSA_MACRO_TX0, 1, 0, 2034 wsa_macro_vi_feed_mixer_get, 2035 wsa_macro_vi_feed_mixer_put), 2036 SOC_SINGLE_EXT("WSA_SPKR_VI_2", SND_SOC_NOPM, WSA_MACRO_TX1, 1, 0, 2037 wsa_macro_vi_feed_mixer_get, 2038 wsa_macro_vi_feed_mixer_put), 2039 }; 2040 2041 static const struct snd_soc_dapm_widget wsa_macro_dapm_widgets[] = { 2042 SND_SOC_DAPM_AIF_IN("WSA AIF1 PB", "WSA_AIF1 Playback", 0, 2043 SND_SOC_NOPM, 0, 0), 2044 SND_SOC_DAPM_AIF_IN("WSA AIF_MIX1 PB", "WSA_AIF_MIX1 Playback", 0, 2045 SND_SOC_NOPM, 0, 0), 2046 2047 SND_SOC_DAPM_AIF_OUT_E("WSA AIF_VI", "WSA_AIF_VI Capture", 0, 2048 SND_SOC_NOPM, WSA_MACRO_AIF_VI, 0, 2049 wsa_macro_enable_vi_feedback, 2050 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), 2051 SND_SOC_DAPM_AIF_OUT("WSA AIF_ECHO", "WSA_AIF_ECHO Capture", 0, 2052 SND_SOC_NOPM, 0, 0), 2053 2054 SND_SOC_DAPM_MIXER("WSA_AIF_VI Mixer", SND_SOC_NOPM, WSA_MACRO_AIF_VI, 2055 0, aif_vi_mixer, ARRAY_SIZE(aif_vi_mixer)), 2056 SND_SOC_DAPM_MUX_E("WSA RX_MIX EC0_MUX", SND_SOC_NOPM, 2057 WSA_MACRO_EC0_MUX, 0, 2058 &rx_mix_ec0_mux, wsa_macro_enable_echo, 2059 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), 2060 SND_SOC_DAPM_MUX_E("WSA RX_MIX EC1_MUX", SND_SOC_NOPM, 2061 WSA_MACRO_EC1_MUX, 0, 2062 &rx_mix_ec1_mux, wsa_macro_enable_echo, 2063 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), 2064 2065 SND_SOC_DAPM_MUX("WSA RX0 MUX", SND_SOC_NOPM, WSA_MACRO_RX0, 0, 2066 &rx_mux[WSA_MACRO_RX0]), 2067 SND_SOC_DAPM_MUX("WSA RX1 MUX", SND_SOC_NOPM, WSA_MACRO_RX1, 0, 2068 &rx_mux[WSA_MACRO_RX1]), 2069 SND_SOC_DAPM_MUX("WSA RX_MIX0 MUX", SND_SOC_NOPM, WSA_MACRO_RX_MIX0, 0, 2070 &rx_mux[WSA_MACRO_RX_MIX0]), 2071 SND_SOC_DAPM_MUX("WSA RX_MIX1 MUX", SND_SOC_NOPM, WSA_MACRO_RX_MIX1, 0, 2072 &rx_mux[WSA_MACRO_RX_MIX1]), 2073 2074 SND_SOC_DAPM_MIXER("WSA RX0", SND_SOC_NOPM, 0, 0, NULL, 0), 2075 SND_SOC_DAPM_MIXER("WSA RX1", SND_SOC_NOPM, 0, 0, NULL, 0), 2076 SND_SOC_DAPM_MIXER("WSA RX_MIX0", SND_SOC_NOPM, 0, 0, NULL, 0), 2077 SND_SOC_DAPM_MIXER("WSA RX_MIX1", SND_SOC_NOPM, 0, 0, NULL, 0), 2078 2079 SND_SOC_DAPM_MUX("WSA_RX0 INP0", SND_SOC_NOPM, 0, 0, &rx0_prim_inp0_mux), 2080 SND_SOC_DAPM_MUX("WSA_RX0 INP1", SND_SOC_NOPM, 0, 0, &rx0_prim_inp1_mux), 2081 SND_SOC_DAPM_MUX("WSA_RX0 INP2", SND_SOC_NOPM, 0, 0, &rx0_prim_inp2_mux), 2082 SND_SOC_DAPM_MUX_E("WSA_RX0 MIX INP", SND_SOC_NOPM, WSA_MACRO_RX_MIX0, 2083 0, &rx0_mix_mux, wsa_macro_enable_mix_path, 2084 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), 2085 SND_SOC_DAPM_MUX("WSA_RX1 INP0", SND_SOC_NOPM, 0, 0, &rx1_prim_inp0_mux), 2086 SND_SOC_DAPM_MUX("WSA_RX1 INP1", SND_SOC_NOPM, 0, 0, &rx1_prim_inp1_mux), 2087 SND_SOC_DAPM_MUX("WSA_RX1 INP2", SND_SOC_NOPM, 0, 0, &rx1_prim_inp2_mux), 2088 SND_SOC_DAPM_MUX_E("WSA_RX1 MIX INP", SND_SOC_NOPM, WSA_MACRO_RX_MIX1, 2089 0, &rx1_mix_mux, wsa_macro_enable_mix_path, 2090 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), 2091 2092 SND_SOC_DAPM_MIXER_E("WSA_RX INT0 MIX", SND_SOC_NOPM, 0, 0, NULL, 0, 2093 wsa_macro_enable_main_path, SND_SOC_DAPM_PRE_PMU), 2094 SND_SOC_DAPM_MIXER_E("WSA_RX INT1 MIX", SND_SOC_NOPM, 1, 0, NULL, 0, 2095 wsa_macro_enable_main_path, SND_SOC_DAPM_PRE_PMU), 2096 2097 SND_SOC_DAPM_MIXER("WSA_RX INT0 SEC MIX", SND_SOC_NOPM, 0, 0, NULL, 0), 2098 SND_SOC_DAPM_MIXER("WSA_RX INT1 SEC MIX", SND_SOC_NOPM, 0, 0, NULL, 0), 2099 2100 SND_SOC_DAPM_MUX("WSA_RX0 INT0 SIDETONE MIX", CDC_WSA_RX0_RX_PATH_CFG1, 2101 4, 0, &rx0_sidetone_mix_mux), 2102 2103 SND_SOC_DAPM_INPUT("WSA SRC0_INP"), 2104 SND_SOC_DAPM_INPUT("WSA_TX DEC0_INP"), 2105 SND_SOC_DAPM_INPUT("WSA_TX DEC1_INP"), 2106 2107 SND_SOC_DAPM_MIXER_E("WSA_RX INT0 INTERP", SND_SOC_NOPM, 2108 WSA_MACRO_COMP1, 0, NULL, 0, 2109 wsa_macro_enable_interpolator, 2110 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | 2111 SND_SOC_DAPM_POST_PMD), 2112 2113 SND_SOC_DAPM_MIXER_E("WSA_RX INT1 INTERP", SND_SOC_NOPM, 2114 WSA_MACRO_COMP2, 0, NULL, 0, 2115 wsa_macro_enable_interpolator, 2116 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | 2117 SND_SOC_DAPM_POST_PMD), 2118 2119 SND_SOC_DAPM_MIXER_E("WSA_RX INT0 CHAIN", SND_SOC_NOPM, 0, 0, 2120 NULL, 0, wsa_macro_spk_boost_event, 2121 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | 2122 SND_SOC_DAPM_POST_PMD), 2123 2124 SND_SOC_DAPM_MIXER_E("WSA_RX INT1 CHAIN", SND_SOC_NOPM, 0, 0, 2125 NULL, 0, wsa_macro_spk_boost_event, 2126 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | 2127 SND_SOC_DAPM_POST_PMD), 2128 2129 SND_SOC_DAPM_INPUT("VIINPUT_WSA"), 2130 SND_SOC_DAPM_OUTPUT("WSA_SPK1 OUT"), 2131 SND_SOC_DAPM_OUTPUT("WSA_SPK2 OUT"), 2132 2133 SND_SOC_DAPM_SUPPLY("WSA_RX0_CLK", CDC_WSA_RX0_RX_PATH_CTL, 5, 0, NULL, 0), 2134 SND_SOC_DAPM_SUPPLY("WSA_RX1_CLK", CDC_WSA_RX1_RX_PATH_CTL, 5, 0, NULL, 0), 2135 SND_SOC_DAPM_SUPPLY("WSA_RX_MIX0_CLK", CDC_WSA_RX0_RX_PATH_MIX_CTL, 5, 0, NULL, 0), 2136 SND_SOC_DAPM_SUPPLY("WSA_RX_MIX1_CLK", CDC_WSA_RX1_RX_PATH_MIX_CTL, 5, 0, NULL, 0), 2137 SND_SOC_DAPM_SUPPLY_S("WSA_MCLK", 0, SND_SOC_NOPM, 0, 0, 2138 wsa_macro_mclk_event, 2139 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), 2140 }; 2141 2142 static const struct snd_soc_dapm_route wsa_audio_map[] = { 2143 /* VI Feedback */ 2144 {"WSA_AIF_VI Mixer", "WSA_SPKR_VI_1", "VIINPUT_WSA"}, 2145 {"WSA_AIF_VI Mixer", "WSA_SPKR_VI_2", "VIINPUT_WSA"}, 2146 {"WSA AIF_VI", NULL, "WSA_AIF_VI Mixer"}, 2147 {"WSA AIF_VI", NULL, "WSA_MCLK"}, 2148 2149 {"WSA RX_MIX EC0_MUX", "RX_MIX_TX0", "WSA_RX INT0 SEC MIX"}, 2150 {"WSA RX_MIX EC1_MUX", "RX_MIX_TX0", "WSA_RX INT0 SEC MIX"}, 2151 {"WSA RX_MIX EC0_MUX", "RX_MIX_TX1", "WSA_RX INT1 SEC MIX"}, 2152 {"WSA RX_MIX EC1_MUX", "RX_MIX_TX1", "WSA_RX INT1 SEC MIX"}, 2153 {"WSA AIF_ECHO", NULL, "WSA RX_MIX EC0_MUX"}, 2154 {"WSA AIF_ECHO", NULL, "WSA RX_MIX EC1_MUX"}, 2155 {"WSA AIF_ECHO", NULL, "WSA_MCLK"}, 2156 2157 {"WSA AIF1 PB", NULL, "WSA_MCLK"}, 2158 {"WSA AIF_MIX1 PB", NULL, "WSA_MCLK"}, 2159 2160 {"WSA RX0 MUX", "AIF1_PB", "WSA AIF1 PB"}, 2161 {"WSA RX1 MUX", "AIF1_PB", "WSA AIF1 PB"}, 2162 {"WSA RX_MIX0 MUX", "AIF1_PB", "WSA AIF1 PB"}, 2163 {"WSA RX_MIX1 MUX", "AIF1_PB", "WSA AIF1 PB"}, 2164 2165 {"WSA RX0 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"}, 2166 {"WSA RX1 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"}, 2167 {"WSA RX_MIX0 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"}, 2168 {"WSA RX_MIX1 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"}, 2169 2170 {"WSA RX0", NULL, "WSA RX0 MUX"}, 2171 {"WSA RX1", NULL, "WSA RX1 MUX"}, 2172 {"WSA RX_MIX0", NULL, "WSA RX_MIX0 MUX"}, 2173 {"WSA RX_MIX1", NULL, "WSA RX_MIX1 MUX"}, 2174 2175 {"WSA RX0", NULL, "WSA_RX0_CLK"}, 2176 {"WSA RX1", NULL, "WSA_RX1_CLK"}, 2177 {"WSA RX_MIX0", NULL, "WSA_RX_MIX0_CLK"}, 2178 {"WSA RX_MIX1", NULL, "WSA_RX_MIX1_CLK"}, 2179 2180 {"WSA_RX0 INP0", "RX0", "WSA RX0"}, 2181 {"WSA_RX0 INP0", "RX1", "WSA RX1"}, 2182 {"WSA_RX0 INP0", "RX_MIX0", "WSA RX_MIX0"}, 2183 {"WSA_RX0 INP0", "RX_MIX1", "WSA RX_MIX1"}, 2184 {"WSA_RX0 INP0", "DEC0", "WSA_TX DEC0_INP"}, 2185 {"WSA_RX0 INP0", "DEC1", "WSA_TX DEC1_INP"}, 2186 {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP0"}, 2187 2188 {"WSA_RX0 INP1", "RX0", "WSA RX0"}, 2189 {"WSA_RX0 INP1", "RX1", "WSA RX1"}, 2190 {"WSA_RX0 INP1", "RX_MIX0", "WSA RX_MIX0"}, 2191 {"WSA_RX0 INP1", "RX_MIX1", "WSA RX_MIX1"}, 2192 {"WSA_RX0 INP1", "DEC0", "WSA_TX DEC0_INP"}, 2193 {"WSA_RX0 INP1", "DEC1", "WSA_TX DEC1_INP"}, 2194 {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP1"}, 2195 2196 {"WSA_RX0 INP2", "RX0", "WSA RX0"}, 2197 {"WSA_RX0 INP2", "RX1", "WSA RX1"}, 2198 {"WSA_RX0 INP2", "RX_MIX0", "WSA RX_MIX0"}, 2199 {"WSA_RX0 INP2", "RX_MIX1", "WSA RX_MIX1"}, 2200 {"WSA_RX0 INP2", "DEC0", "WSA_TX DEC0_INP"}, 2201 {"WSA_RX0 INP2", "DEC1", "WSA_TX DEC1_INP"}, 2202 {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP2"}, 2203 2204 {"WSA_RX0 MIX INP", "RX0", "WSA RX0"}, 2205 {"WSA_RX0 MIX INP", "RX1", "WSA RX1"}, 2206 {"WSA_RX0 MIX INP", "RX_MIX0", "WSA RX_MIX0"}, 2207 {"WSA_RX0 MIX INP", "RX_MIX1", "WSA RX_MIX1"}, 2208 {"WSA_RX INT0 SEC MIX", NULL, "WSA_RX0 MIX INP"}, 2209 2210 {"WSA_RX INT0 SEC MIX", NULL, "WSA_RX INT0 MIX"}, 2211 {"WSA_RX INT0 INTERP", NULL, "WSA_RX INT0 SEC MIX"}, 2212 {"WSA_RX0 INT0 SIDETONE MIX", "SRC0", "WSA SRC0_INP"}, 2213 {"WSA_RX INT0 INTERP", NULL, "WSA_RX0 INT0 SIDETONE MIX"}, 2214 {"WSA_RX INT0 CHAIN", NULL, "WSA_RX INT0 INTERP"}, 2215 2216 {"WSA_SPK1 OUT", NULL, "WSA_RX INT0 CHAIN"}, 2217 {"WSA_SPK1 OUT", NULL, "WSA_MCLK"}, 2218 2219 {"WSA_RX1 INP0", "RX0", "WSA RX0"}, 2220 {"WSA_RX1 INP0", "RX1", "WSA RX1"}, 2221 {"WSA_RX1 INP0", "RX_MIX0", "WSA RX_MIX0"}, 2222 {"WSA_RX1 INP0", "RX_MIX1", "WSA RX_MIX1"}, 2223 {"WSA_RX1 INP0", "DEC0", "WSA_TX DEC0_INP"}, 2224 {"WSA_RX1 INP0", "DEC1", "WSA_TX DEC1_INP"}, 2225 {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP0"}, 2226 2227 {"WSA_RX1 INP1", "RX0", "WSA RX0"}, 2228 {"WSA_RX1 INP1", "RX1", "WSA RX1"}, 2229 {"WSA_RX1 INP1", "RX_MIX0", "WSA RX_MIX0"}, 2230 {"WSA_RX1 INP1", "RX_MIX1", "WSA RX_MIX1"}, 2231 {"WSA_RX1 INP1", "DEC0", "WSA_TX DEC0_INP"}, 2232 {"WSA_RX1 INP1", "DEC1", "WSA_TX DEC1_INP"}, 2233 {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP1"}, 2234 2235 {"WSA_RX1 INP2", "RX0", "WSA RX0"}, 2236 {"WSA_RX1 INP2", "RX1", "WSA RX1"}, 2237 {"WSA_RX1 INP2", "RX_MIX0", "WSA RX_MIX0"}, 2238 {"WSA_RX1 INP2", "RX_MIX1", "WSA RX_MIX1"}, 2239 {"WSA_RX1 INP2", "DEC0", "WSA_TX DEC0_INP"}, 2240 {"WSA_RX1 INP2", "DEC1", "WSA_TX DEC1_INP"}, 2241 {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP2"}, 2242 2243 {"WSA_RX1 MIX INP", "RX0", "WSA RX0"}, 2244 {"WSA_RX1 MIX INP", "RX1", "WSA RX1"}, 2245 {"WSA_RX1 MIX INP", "RX_MIX0", "WSA RX_MIX0"}, 2246 {"WSA_RX1 MIX INP", "RX_MIX1", "WSA RX_MIX1"}, 2247 {"WSA_RX INT1 SEC MIX", NULL, "WSA_RX1 MIX INP"}, 2248 2249 {"WSA_RX INT1 SEC MIX", NULL, "WSA_RX INT1 MIX"}, 2250 {"WSA_RX INT1 INTERP", NULL, "WSA_RX INT1 SEC MIX"}, 2251 2252 {"WSA_RX INT1 CHAIN", NULL, "WSA_RX INT1 INTERP"}, 2253 {"WSA_SPK2 OUT", NULL, "WSA_RX INT1 CHAIN"}, 2254 {"WSA_SPK2 OUT", NULL, "WSA_MCLK"}, 2255 }; 2256 2257 static int wsa_swrm_clock(struct wsa_macro *wsa, bool enable) 2258 { 2259 struct regmap *regmap = wsa->regmap; 2260 2261 if (enable) { 2262 int ret; 2263 2264 ret = clk_prepare_enable(wsa->mclk); 2265 if (ret) { 2266 dev_err(wsa->dev, "failed to enable mclk\n"); 2267 return ret; 2268 } 2269 wsa_macro_mclk_enable(wsa, true); 2270 2271 regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 2272 CDC_WSA_SWR_CLK_EN_MASK, 2273 CDC_WSA_SWR_CLK_ENABLE); 2274 2275 } else { 2276 regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 2277 CDC_WSA_SWR_CLK_EN_MASK, 0); 2278 wsa_macro_mclk_enable(wsa, false); 2279 clk_disable_unprepare(wsa->mclk); 2280 } 2281 2282 return 0; 2283 } 2284 2285 static int wsa_macro_component_probe(struct snd_soc_component *comp) 2286 { 2287 struct wsa_macro *wsa = snd_soc_component_get_drvdata(comp); 2288 2289 snd_soc_component_init_regmap(comp, wsa->regmap); 2290 2291 wsa->spkr_gain_offset = WSA_MACRO_GAIN_OFFSET_M1P5_DB; 2292 2293 /* set SPKR rate to FS_2P4_3P072 */ 2294 snd_soc_component_update_bits(comp, CDC_WSA_RX0_RX_PATH_CFG1, 2295 CDC_WSA_RX_PATH_SPKR_RATE_MASK, 2296 CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072); 2297 2298 snd_soc_component_update_bits(comp, CDC_WSA_RX1_RX_PATH_CFG1, 2299 CDC_WSA_RX_PATH_SPKR_RATE_MASK, 2300 CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072); 2301 2302 wsa_macro_set_spkr_mode(comp, WSA_MACRO_SPKR_MODE_1); 2303 2304 return 0; 2305 } 2306 2307 static int swclk_gate_enable(struct clk_hw *hw) 2308 { 2309 return wsa_swrm_clock(to_wsa_macro(hw), true); 2310 } 2311 2312 static void swclk_gate_disable(struct clk_hw *hw) 2313 { 2314 wsa_swrm_clock(to_wsa_macro(hw), false); 2315 } 2316 2317 static int swclk_gate_is_enabled(struct clk_hw *hw) 2318 { 2319 struct wsa_macro *wsa = to_wsa_macro(hw); 2320 int ret, val; 2321 2322 regmap_read(wsa->regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, &val); 2323 ret = val & BIT(0); 2324 2325 return ret; 2326 } 2327 2328 static unsigned long swclk_recalc_rate(struct clk_hw *hw, 2329 unsigned long parent_rate) 2330 { 2331 return parent_rate / 2; 2332 } 2333 2334 static const struct clk_ops swclk_gate_ops = { 2335 .prepare = swclk_gate_enable, 2336 .unprepare = swclk_gate_disable, 2337 .is_enabled = swclk_gate_is_enabled, 2338 .recalc_rate = swclk_recalc_rate, 2339 }; 2340 2341 static int wsa_macro_register_mclk_output(struct wsa_macro *wsa) 2342 { 2343 struct device *dev = wsa->dev; 2344 const char *parent_clk_name; 2345 struct clk_hw *hw; 2346 struct clk_init_data init; 2347 int ret; 2348 2349 parent_clk_name = __clk_get_name(wsa->npl); 2350 2351 init.name = "mclk"; 2352 of_property_read_string(dev_of_node(dev), "clock-output-names", 2353 &init.name); 2354 init.ops = &swclk_gate_ops; 2355 init.flags = 0; 2356 init.parent_names = &parent_clk_name; 2357 init.num_parents = 1; 2358 wsa->hw.init = &init; 2359 hw = &wsa->hw; 2360 ret = clk_hw_register(wsa->dev, hw); 2361 if (ret) 2362 return ret; 2363 2364 return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, hw); 2365 } 2366 2367 static const struct snd_soc_component_driver wsa_macro_component_drv = { 2368 .name = "WSA MACRO", 2369 .probe = wsa_macro_component_probe, 2370 .controls = wsa_macro_snd_controls, 2371 .num_controls = ARRAY_SIZE(wsa_macro_snd_controls), 2372 .dapm_widgets = wsa_macro_dapm_widgets, 2373 .num_dapm_widgets = ARRAY_SIZE(wsa_macro_dapm_widgets), 2374 .dapm_routes = wsa_audio_map, 2375 .num_dapm_routes = ARRAY_SIZE(wsa_audio_map), 2376 }; 2377 2378 static int wsa_macro_probe(struct platform_device *pdev) 2379 { 2380 struct device *dev = &pdev->dev; 2381 struct wsa_macro *wsa; 2382 void __iomem *base; 2383 int ret; 2384 2385 wsa = devm_kzalloc(dev, sizeof(*wsa), GFP_KERNEL); 2386 if (!wsa) 2387 return -ENOMEM; 2388 2389 wsa->macro = devm_clk_get_optional(dev, "macro"); 2390 if (IS_ERR(wsa->macro)) 2391 return PTR_ERR(wsa->macro); 2392 2393 wsa->dcodec = devm_clk_get_optional(dev, "dcodec"); 2394 if (IS_ERR(wsa->dcodec)) 2395 return PTR_ERR(wsa->dcodec); 2396 2397 wsa->mclk = devm_clk_get(dev, "mclk"); 2398 if (IS_ERR(wsa->mclk)) 2399 return PTR_ERR(wsa->mclk); 2400 2401 wsa->npl = devm_clk_get(dev, "npl"); 2402 if (IS_ERR(wsa->npl)) 2403 return PTR_ERR(wsa->npl); 2404 2405 wsa->fsgen = devm_clk_get(dev, "fsgen"); 2406 if (IS_ERR(wsa->fsgen)) 2407 return PTR_ERR(wsa->fsgen); 2408 2409 base = devm_platform_ioremap_resource(pdev, 0); 2410 if (IS_ERR(base)) 2411 return PTR_ERR(base); 2412 2413 wsa->regmap = devm_regmap_init_mmio(dev, base, &wsa_regmap_config); 2414 if (IS_ERR(wsa->regmap)) 2415 return PTR_ERR(wsa->regmap); 2416 2417 dev_set_drvdata(dev, wsa); 2418 2419 wsa->dev = dev; 2420 2421 /* set MCLK and NPL rates */ 2422 clk_set_rate(wsa->mclk, WSA_MACRO_MCLK_FREQ); 2423 clk_set_rate(wsa->npl, WSA_MACRO_MCLK_FREQ); 2424 2425 ret = clk_prepare_enable(wsa->macro); 2426 if (ret) 2427 goto err; 2428 2429 ret = clk_prepare_enable(wsa->dcodec); 2430 if (ret) 2431 goto err_dcodec; 2432 2433 ret = clk_prepare_enable(wsa->mclk); 2434 if (ret) 2435 goto err_mclk; 2436 2437 ret = clk_prepare_enable(wsa->npl); 2438 if (ret) 2439 goto err_npl; 2440 2441 ret = clk_prepare_enable(wsa->fsgen); 2442 if (ret) 2443 goto err_fsgen; 2444 2445 /* reset swr ip */ 2446 regmap_update_bits(wsa->regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 2447 CDC_WSA_SWR_RST_EN_MASK, CDC_WSA_SWR_RST_ENABLE); 2448 2449 regmap_update_bits(wsa->regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 2450 CDC_WSA_SWR_CLK_EN_MASK, CDC_WSA_SWR_CLK_ENABLE); 2451 2452 /* Bring out of reset */ 2453 regmap_update_bits(wsa->regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 2454 CDC_WSA_SWR_RST_EN_MASK, CDC_WSA_SWR_RST_DISABLE); 2455 2456 ret = devm_snd_soc_register_component(dev, &wsa_macro_component_drv, 2457 wsa_macro_dai, 2458 ARRAY_SIZE(wsa_macro_dai)); 2459 if (ret) 2460 goto err_clkout; 2461 2462 pm_runtime_set_autosuspend_delay(dev, 3000); 2463 pm_runtime_use_autosuspend(dev); 2464 pm_runtime_mark_last_busy(dev); 2465 pm_runtime_set_active(dev); 2466 pm_runtime_enable(dev); 2467 2468 ret = wsa_macro_register_mclk_output(wsa); 2469 if (ret) 2470 goto err_clkout; 2471 2472 return 0; 2473 2474 err_clkout: 2475 clk_disable_unprepare(wsa->fsgen); 2476 err_fsgen: 2477 clk_disable_unprepare(wsa->npl); 2478 err_npl: 2479 clk_disable_unprepare(wsa->mclk); 2480 err_mclk: 2481 clk_disable_unprepare(wsa->dcodec); 2482 err_dcodec: 2483 clk_disable_unprepare(wsa->macro); 2484 err: 2485 return ret; 2486 2487 } 2488 2489 static int wsa_macro_remove(struct platform_device *pdev) 2490 { 2491 struct wsa_macro *wsa = dev_get_drvdata(&pdev->dev); 2492 2493 clk_disable_unprepare(wsa->macro); 2494 clk_disable_unprepare(wsa->dcodec); 2495 clk_disable_unprepare(wsa->mclk); 2496 clk_disable_unprepare(wsa->npl); 2497 clk_disable_unprepare(wsa->fsgen); 2498 2499 return 0; 2500 } 2501 2502 static int __maybe_unused wsa_macro_runtime_suspend(struct device *dev) 2503 { 2504 struct wsa_macro *wsa = dev_get_drvdata(dev); 2505 2506 regcache_cache_only(wsa->regmap, true); 2507 regcache_mark_dirty(wsa->regmap); 2508 2509 clk_disable_unprepare(wsa->mclk); 2510 clk_disable_unprepare(wsa->npl); 2511 clk_disable_unprepare(wsa->fsgen); 2512 2513 return 0; 2514 } 2515 2516 static int __maybe_unused wsa_macro_runtime_resume(struct device *dev) 2517 { 2518 struct wsa_macro *wsa = dev_get_drvdata(dev); 2519 int ret; 2520 2521 ret = clk_prepare_enable(wsa->mclk); 2522 if (ret) { 2523 dev_err(dev, "unable to prepare mclk\n"); 2524 return ret; 2525 } 2526 2527 ret = clk_prepare_enable(wsa->npl); 2528 if (ret) { 2529 dev_err(dev, "unable to prepare mclkx2\n"); 2530 goto err_npl; 2531 } 2532 2533 ret = clk_prepare_enable(wsa->fsgen); 2534 if (ret) { 2535 dev_err(dev, "unable to prepare fsgen\n"); 2536 goto err_fsgen; 2537 } 2538 2539 regcache_cache_only(wsa->regmap, false); 2540 regcache_sync(wsa->regmap); 2541 2542 return 0; 2543 err_fsgen: 2544 clk_disable_unprepare(wsa->npl); 2545 err_npl: 2546 clk_disable_unprepare(wsa->mclk); 2547 2548 return ret; 2549 } 2550 2551 static const struct dev_pm_ops wsa_macro_pm_ops = { 2552 SET_RUNTIME_PM_OPS(wsa_macro_runtime_suspend, wsa_macro_runtime_resume, NULL) 2553 }; 2554 2555 static const struct of_device_id wsa_macro_dt_match[] = { 2556 {.compatible = "qcom,sc7280-lpass-wsa-macro"}, 2557 {.compatible = "qcom,sm8250-lpass-wsa-macro"}, 2558 {.compatible = "qcom,sm8450-lpass-wsa-macro"}, 2559 {.compatible = "qcom,sc8280xp-lpass-wsa-macro" }, 2560 {} 2561 }; 2562 MODULE_DEVICE_TABLE(of, wsa_macro_dt_match); 2563 2564 static struct platform_driver wsa_macro_driver = { 2565 .driver = { 2566 .name = "wsa_macro", 2567 .of_match_table = wsa_macro_dt_match, 2568 .pm = &wsa_macro_pm_ops, 2569 }, 2570 .probe = wsa_macro_probe, 2571 .remove = wsa_macro_remove, 2572 }; 2573 2574 module_platform_driver(wsa_macro_driver); 2575 MODULE_DESCRIPTION("WSA macro driver"); 2576 MODULE_LICENSE("GPL"); 2577