~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/soc/codecs/lpass-va-macro.c

Version: ~ [ linux-6.11.5 ] ~ [ linux-6.10.14 ] ~ [ linux-6.9.12 ] ~ [ linux-6.8.12 ] ~ [ linux-6.7.12 ] ~ [ linux-6.6.58 ] ~ [ linux-6.5.13 ] ~ [ linux-6.4.16 ] ~ [ linux-6.3.13 ] ~ [ linux-6.2.16 ] ~ [ linux-6.1.114 ] ~ [ linux-6.0.19 ] ~ [ linux-5.19.17 ] ~ [ linux-5.18.19 ] ~ [ linux-5.17.15 ] ~ [ linux-5.16.20 ] ~ [ linux-5.15.169 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.228 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.284 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.322 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.336 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.337 ] ~ [ linux-4.4.302 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.9 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 // SPDX-License-Identifier: GPL-2.0-only
  2 // Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
  3 
  4 #include <linux/clk.h>
  5 #include <linux/clk-provider.h>
  6 #include <linux/init.h>
  7 #include <linux/io.h>
  8 #include <linux/module.h>
  9 #include <linux/of_clk.h>
 10 #include <linux/of_platform.h>
 11 #include <linux/platform_device.h>
 12 #include <linux/pm_runtime.h>
 13 #include <linux/regmap.h>
 14 #include <linux/regulator/consumer.h>
 15 #include <sound/soc.h>
 16 #include <sound/soc-dapm.h>
 17 #include <sound/tlv.h>
 18 
 19 #include "lpass-macro-common.h"
 20 
 21 /* VA macro registers */
 22 #define CDC_VA_CLK_RST_CTRL_MCLK_CONTROL        (0x0000)
 23 #define CDC_VA_MCLK_CONTROL_EN                  BIT(0)
 24 #define CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL      (0x0004)
 25 #define CDC_VA_FS_CONTROL_EN                    BIT(0)
 26 #define CDC_VA_FS_COUNTER_CLR                   BIT(1)
 27 #define CDC_VA_CLK_RST_CTRL_SWR_CONTROL         (0x0008)
 28 #define CDC_VA_SWR_RESET_MASK           BIT(1)
 29 #define CDC_VA_SWR_RESET_ENABLE         BIT(1)
 30 #define CDC_VA_SWR_CLK_EN_MASK          BIT(0)
 31 #define CDC_VA_SWR_CLK_ENABLE           BIT(0)
 32 #define CDC_VA_TOP_CSR_TOP_CFG0                 (0x0080)
 33 #define CDC_VA_FS_BROADCAST_EN                  BIT(1)
 34 #define CDC_VA_TOP_CSR_DMIC0_CTL                (0x0084)
 35 #define CDC_VA_TOP_CSR_DMIC1_CTL                (0x0088)
 36 #define CDC_VA_TOP_CSR_DMIC2_CTL                (0x008C)
 37 #define CDC_VA_TOP_CSR_DMIC3_CTL                (0x0090)
 38 #define CDC_VA_DMIC_EN_MASK                     BIT(0)
 39 #define CDC_VA_DMIC_ENABLE                      BIT(0)
 40 #define CDC_VA_DMIC_CLK_SEL_MASK                GENMASK(3, 1)
 41 #define CDC_VA_DMIC_CLK_SEL_SHFT                1
 42 #define CDC_VA_DMIC_CLK_SEL_DIV0                0x0
 43 #define CDC_VA_DMIC_CLK_SEL_DIV1                0x2
 44 #define CDC_VA_DMIC_CLK_SEL_DIV2                0x4
 45 #define CDC_VA_DMIC_CLK_SEL_DIV3                0x6
 46 #define CDC_VA_DMIC_CLK_SEL_DIV4                0x8
 47 #define CDC_VA_DMIC_CLK_SEL_DIV5                0xa
 48 #define CDC_VA_TOP_CSR_DMIC_CFG                 (0x0094)
 49 #define CDC_VA_RESET_ALL_DMICS_MASK             BIT(7)
 50 #define CDC_VA_RESET_ALL_DMICS_RESET            BIT(7)
 51 #define CDC_VA_RESET_ALL_DMICS_DISABLE          0
 52 #define CDC_VA_DMIC3_FREQ_CHANGE_MASK           BIT(3)
 53 #define CDC_VA_DMIC3_FREQ_CHANGE_EN             BIT(3)
 54 #define CDC_VA_DMIC2_FREQ_CHANGE_MASK           BIT(2)
 55 #define CDC_VA_DMIC2_FREQ_CHANGE_EN             BIT(2)
 56 #define CDC_VA_DMIC1_FREQ_CHANGE_MASK           BIT(1)
 57 #define CDC_VA_DMIC1_FREQ_CHANGE_EN             BIT(1)
 58 #define CDC_VA_DMIC0_FREQ_CHANGE_MASK           BIT(0)
 59 #define CDC_VA_DMIC0_FREQ_CHANGE_EN             BIT(0)
 60 #define CDC_VA_DMIC_FREQ_CHANGE_DISABLE         0
 61 #define CDC_VA_TOP_CSR_DEBUG_BUS                (0x009C)
 62 #define CDC_VA_TOP_CSR_DEBUG_EN                 (0x00A0)
 63 #define CDC_VA_TOP_CSR_TX_I2S_CTL               (0x00A4)
 64 #define CDC_VA_TOP_CSR_I2S_CLK                  (0x00A8)
 65 #define CDC_VA_TOP_CSR_I2S_RESET                (0x00AC)
 66 #define CDC_VA_TOP_CSR_CORE_ID_0                (0x00C0)
 67 #define CDC_VA_TOP_CSR_CORE_ID_1                (0x00C4)
 68 #define CDC_VA_TOP_CSR_CORE_ID_2                (0x00C8)
 69 #define CDC_VA_TOP_CSR_CORE_ID_3                (0x00CC)
 70 #define CDC_VA_TOP_CSR_SWR_MIC_CTL0             (0x00D0)
 71 #define CDC_VA_TOP_CSR_SWR_MIC_CTL1             (0x00D4)
 72 #define CDC_VA_TOP_CSR_SWR_MIC_CTL2             (0x00D8)
 73 #define CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK         (0xEE)
 74 #define CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1         (0xCC)
 75 #define CDC_VA_TOP_CSR_SWR_CTRL                 (0x00DC)
 76 #define CDC_VA_INP_MUX_ADC_MUX0_CFG0            (0x0100)
 77 #define CDC_VA_INP_MUX_ADC_MUX0_CFG1            (0x0104)
 78 #define CDC_VA_INP_MUX_ADC_MUX1_CFG0            (0x0108)
 79 #define CDC_VA_INP_MUX_ADC_MUX1_CFG1            (0x010C)
 80 #define CDC_VA_INP_MUX_ADC_MUX2_CFG0            (0x0110)
 81 #define CDC_VA_INP_MUX_ADC_MUX2_CFG1            (0x0114)
 82 #define CDC_VA_INP_MUX_ADC_MUX3_CFG0            (0x0118)
 83 #define CDC_VA_INP_MUX_ADC_MUX3_CFG1            (0x011C)
 84 #define CDC_VA_TX0_TX_PATH_CTL                  (0x0400)
 85 #define CDC_VA_TX_PATH_CLK_EN_MASK              BIT(5)
 86 #define CDC_VA_TX_PATH_CLK_EN                   BIT(5)
 87 #define CDC_VA_TX_PATH_CLK_DISABLE              0
 88 #define CDC_VA_TX_PATH_PGA_MUTE_EN_MASK         BIT(4)
 89 #define CDC_VA_TX_PATH_PGA_MUTE_EN              BIT(4)
 90 #define CDC_VA_TX_PATH_PGA_MUTE_DISABLE         0
 91 #define CDC_VA_TX0_TX_PATH_CFG0                 (0x0404)
 92 #define CDC_VA_ADC_MODE_MASK                    GENMASK(2, 1)
 93 #define CDC_VA_ADC_MODE_SHIFT                   1
 94 #define  TX_HPF_CUT_OFF_FREQ_MASK               GENMASK(6, 5)
 95 #define  CF_MIN_3DB_4HZ                 0x0
 96 #define  CF_MIN_3DB_75HZ                0x1
 97 #define  CF_MIN_3DB_150HZ               0x2
 98 #define CDC_VA_TX0_TX_PATH_CFG1                 (0x0408)
 99 #define CDC_VA_TX0_TX_VOL_CTL                   (0x040C)
100 #define CDC_VA_TX0_TX_PATH_SEC0                 (0x0410)
101 #define CDC_VA_TX0_TX_PATH_SEC1                 (0x0414)
102 #define CDC_VA_TX0_TX_PATH_SEC2                 (0x0418)
103 #define CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_MASK   BIT(1)
104 #define CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_REQ    BIT(1)
105 #define CDC_VA_TX_HPF_ZERO_GATE_MASK            BIT(0)
106 #define CDC_VA_TX_HPF_ZERO_NO_GATE              BIT(0)
107 #define CDC_VA_TX_HPF_ZERO_GATE                 0
108 #define CDC_VA_TX0_TX_PATH_SEC3                 (0x041C)
109 #define CDC_VA_TX0_TX_PATH_SEC4                 (0x0420)
110 #define CDC_VA_TX0_TX_PATH_SEC5                 (0x0424)
111 #define CDC_VA_TX0_TX_PATH_SEC6                 (0x0428)
112 #define CDC_VA_TX0_TX_PATH_SEC7                 (0x042C)
113 #define CDC_VA_TX1_TX_PATH_CTL                  (0x0480)
114 #define CDC_VA_TX1_TX_PATH_CFG0                 (0x0484)
115 #define CDC_VA_TX1_TX_PATH_CFG1                 (0x0488)
116 #define CDC_VA_TX1_TX_VOL_CTL                   (0x048C)
117 #define CDC_VA_TX1_TX_PATH_SEC0                 (0x0490)
118 #define CDC_VA_TX1_TX_PATH_SEC1                 (0x0494)
119 #define CDC_VA_TX1_TX_PATH_SEC2                 (0x0498)
120 #define CDC_VA_TX1_TX_PATH_SEC3                 (0x049C)
121 #define CDC_VA_TX1_TX_PATH_SEC4                 (0x04A0)
122 #define CDC_VA_TX1_TX_PATH_SEC5                 (0x04A4)
123 #define CDC_VA_TX1_TX_PATH_SEC6                 (0x04A8)
124 #define CDC_VA_TX2_TX_PATH_CTL                  (0x0500)
125 #define CDC_VA_TX2_TX_PATH_CFG0                 (0x0504)
126 #define CDC_VA_TX2_TX_PATH_CFG1                 (0x0508)
127 #define CDC_VA_TX2_TX_VOL_CTL                   (0x050C)
128 #define CDC_VA_TX2_TX_PATH_SEC0                 (0x0510)
129 #define CDC_VA_TX2_TX_PATH_SEC1                 (0x0514)
130 #define CDC_VA_TX2_TX_PATH_SEC2                 (0x0518)
131 #define CDC_VA_TX2_TX_PATH_SEC3                 (0x051C)
132 #define CDC_VA_TX2_TX_PATH_SEC4                 (0x0520)
133 #define CDC_VA_TX2_TX_PATH_SEC5                 (0x0524)
134 #define CDC_VA_TX2_TX_PATH_SEC6                 (0x0528)
135 #define CDC_VA_TX3_TX_PATH_CTL                  (0x0580)
136 #define CDC_VA_TX3_TX_PATH_CFG0                 (0x0584)
137 #define CDC_VA_TX_PATH_ADC_DMIC_SEL_MASK        BIT(7)
138 #define CDC_VA_TX_PATH_ADC_DMIC_SEL_DMIC        BIT(7)
139 #define CDC_VA_TX_PATH_ADC_DMIC_SEL_ADC         0
140 #define CDC_VA_TX3_TX_PATH_CFG1                 (0x0588)
141 #define CDC_VA_TX3_TX_VOL_CTL                   (0x058C)
142 #define CDC_VA_TX3_TX_PATH_SEC0                 (0x0590)
143 #define CDC_VA_TX3_TX_PATH_SEC1                 (0x0594)
144 #define CDC_VA_TX3_TX_PATH_SEC2                 (0x0598)
145 #define CDC_VA_TX3_TX_PATH_SEC3                 (0x059C)
146 #define CDC_VA_TX3_TX_PATH_SEC4                 (0x05A0)
147 #define CDC_VA_TX3_TX_PATH_SEC5                 (0x05A4)
148 #define CDC_VA_TX3_TX_PATH_SEC6                 (0x05A8)
149 
150 #define VA_MAX_OFFSET                           (0x07A8)
151 
152 #define VA_MACRO_NUM_DECIMATORS 4
153 #define VA_MACRO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
154                         SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
155                         SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
156 #define VA_MACRO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
157                 SNDRV_PCM_FMTBIT_S24_LE |\
158                 SNDRV_PCM_FMTBIT_S24_3LE)
159 
160 #define VA_MACRO_MCLK_FREQ 9600000
161 #define VA_MACRO_TX_PATH_OFFSET 0x80
162 #define VA_MACRO_SWR_MIC_MUX_SEL_MASK 0xF
163 #define VA_MACRO_ADC_MUX_CFG_OFFSET 0x8
164 
165 static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400);
166 
167 enum {
168         VA_MACRO_AIF_INVALID = 0,
169         VA_MACRO_AIF1_CAP,
170         VA_MACRO_AIF2_CAP,
171         VA_MACRO_AIF3_CAP,
172         VA_MACRO_MAX_DAIS,
173 };
174 
175 enum {
176         VA_MACRO_DEC0,
177         VA_MACRO_DEC1,
178         VA_MACRO_DEC2,
179         VA_MACRO_DEC3,
180         VA_MACRO_DEC4,
181         VA_MACRO_DEC5,
182         VA_MACRO_DEC6,
183         VA_MACRO_DEC7,
184         VA_MACRO_DEC_MAX,
185 };
186 
187 enum {
188         VA_MACRO_CLK_DIV_2,
189         VA_MACRO_CLK_DIV_3,
190         VA_MACRO_CLK_DIV_4,
191         VA_MACRO_CLK_DIV_6,
192         VA_MACRO_CLK_DIV_8,
193         VA_MACRO_CLK_DIV_16,
194 };
195 
196 #define VA_NUM_CLKS_MAX         3
197 
198 struct va_macro {
199         struct device *dev;
200         unsigned long active_ch_mask[VA_MACRO_MAX_DAIS];
201         unsigned long active_ch_cnt[VA_MACRO_MAX_DAIS];
202         u16 dmic_clk_div;
203         bool has_swr_master;
204         bool has_npl_clk;
205 
206         int dec_mode[VA_MACRO_NUM_DECIMATORS];
207         struct regmap *regmap;
208         struct clk *mclk;
209         struct clk *npl;
210         struct clk *macro;
211         struct clk *dcodec;
212         struct clk *fsgen;
213         struct clk_hw hw;
214         struct lpass_macro *pds;
215 
216         s32 dmic_0_1_clk_cnt;
217         s32 dmic_2_3_clk_cnt;
218         s32 dmic_4_5_clk_cnt;
219         s32 dmic_6_7_clk_cnt;
220         u8 dmic_0_1_clk_div;
221         u8 dmic_2_3_clk_div;
222         u8 dmic_4_5_clk_div;
223         u8 dmic_6_7_clk_div;
224 };
225 
226 #define to_va_macro(_hw) container_of(_hw, struct va_macro, hw)
227 
228 struct va_macro_data {
229         bool has_swr_master;
230         bool has_npl_clk;
231         int version;
232 };
233 
234 static const struct va_macro_data sm8250_va_data = {
235         .has_swr_master = false,
236         .has_npl_clk = false,
237         .version = LPASS_CODEC_VERSION_1_0,
238 };
239 
240 static const struct va_macro_data sm8450_va_data = {
241         .has_swr_master = true,
242         .has_npl_clk = true,
243 };
244 
245 static const struct va_macro_data sm8550_va_data = {
246         .has_swr_master = true,
247         .has_npl_clk = false,
248 };
249 
250 static bool va_is_volatile_register(struct device *dev, unsigned int reg)
251 {
252         switch (reg) {
253         case CDC_VA_TOP_CSR_CORE_ID_0:
254         case CDC_VA_TOP_CSR_CORE_ID_1:
255         case CDC_VA_TOP_CSR_CORE_ID_2:
256         case CDC_VA_TOP_CSR_CORE_ID_3:
257         case CDC_VA_TOP_CSR_DMIC0_CTL:
258         case CDC_VA_TOP_CSR_DMIC1_CTL:
259         case CDC_VA_TOP_CSR_DMIC2_CTL:
260         case CDC_VA_TOP_CSR_DMIC3_CTL:
261                 return true;
262         }
263         return false;
264 }
265 
266 static const struct reg_default va_defaults[] = {
267         /* VA macro */
268         { CDC_VA_CLK_RST_CTRL_MCLK_CONTROL, 0x00},
269         { CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL, 0x00},
270         { CDC_VA_CLK_RST_CTRL_SWR_CONTROL, 0x00},
271         { CDC_VA_TOP_CSR_TOP_CFG0, 0x00},
272         { CDC_VA_TOP_CSR_DMIC0_CTL, 0x00},
273         { CDC_VA_TOP_CSR_DMIC1_CTL, 0x00},
274         { CDC_VA_TOP_CSR_DMIC2_CTL, 0x00},
275         { CDC_VA_TOP_CSR_DMIC3_CTL, 0x00},
276         { CDC_VA_TOP_CSR_DMIC_CFG, 0x80},
277         { CDC_VA_TOP_CSR_DEBUG_BUS, 0x00},
278         { CDC_VA_TOP_CSR_DEBUG_EN, 0x00},
279         { CDC_VA_TOP_CSR_TX_I2S_CTL, 0x0C},
280         { CDC_VA_TOP_CSR_I2S_CLK, 0x00},
281         { CDC_VA_TOP_CSR_I2S_RESET, 0x00},
282         { CDC_VA_TOP_CSR_CORE_ID_0, 0x00},
283         { CDC_VA_TOP_CSR_CORE_ID_1, 0x00},
284         { CDC_VA_TOP_CSR_CORE_ID_2, 0x00},
285         { CDC_VA_TOP_CSR_CORE_ID_3, 0x00},
286         { CDC_VA_TOP_CSR_SWR_MIC_CTL0, 0xEE},
287         { CDC_VA_TOP_CSR_SWR_MIC_CTL1, 0xEE},
288         { CDC_VA_TOP_CSR_SWR_MIC_CTL2, 0xEE},
289         { CDC_VA_TOP_CSR_SWR_CTRL, 0x06},
290 
291         /* VA core */
292         { CDC_VA_INP_MUX_ADC_MUX0_CFG0, 0x00},
293         { CDC_VA_INP_MUX_ADC_MUX0_CFG1, 0x00},
294         { CDC_VA_INP_MUX_ADC_MUX1_CFG0, 0x00},
295         { CDC_VA_INP_MUX_ADC_MUX1_CFG1, 0x00},
296         { CDC_VA_INP_MUX_ADC_MUX2_CFG0, 0x00},
297         { CDC_VA_INP_MUX_ADC_MUX2_CFG1, 0x00},
298         { CDC_VA_INP_MUX_ADC_MUX3_CFG0, 0x00},
299         { CDC_VA_INP_MUX_ADC_MUX3_CFG1, 0x00},
300         { CDC_VA_TX0_TX_PATH_CTL, 0x04},
301         { CDC_VA_TX0_TX_PATH_CFG0, 0x10},
302         { CDC_VA_TX0_TX_PATH_CFG1, 0x0B},
303         { CDC_VA_TX0_TX_VOL_CTL, 0x00},
304         { CDC_VA_TX0_TX_PATH_SEC0, 0x00},
305         { CDC_VA_TX0_TX_PATH_SEC1, 0x00},
306         { CDC_VA_TX0_TX_PATH_SEC2, 0x01},
307         { CDC_VA_TX0_TX_PATH_SEC3, 0x3C},
308         { CDC_VA_TX0_TX_PATH_SEC4, 0x20},
309         { CDC_VA_TX0_TX_PATH_SEC5, 0x00},
310         { CDC_VA_TX0_TX_PATH_SEC6, 0x00},
311         { CDC_VA_TX0_TX_PATH_SEC7, 0x25},
312         { CDC_VA_TX1_TX_PATH_CTL, 0x04},
313         { CDC_VA_TX1_TX_PATH_CFG0, 0x10},
314         { CDC_VA_TX1_TX_PATH_CFG1, 0x0B},
315         { CDC_VA_TX1_TX_VOL_CTL, 0x00},
316         { CDC_VA_TX1_TX_PATH_SEC0, 0x00},
317         { CDC_VA_TX1_TX_PATH_SEC1, 0x00},
318         { CDC_VA_TX1_TX_PATH_SEC2, 0x01},
319         { CDC_VA_TX1_TX_PATH_SEC3, 0x3C},
320         { CDC_VA_TX1_TX_PATH_SEC4, 0x20},
321         { CDC_VA_TX1_TX_PATH_SEC5, 0x00},
322         { CDC_VA_TX1_TX_PATH_SEC6, 0x00},
323         { CDC_VA_TX2_TX_PATH_CTL, 0x04},
324         { CDC_VA_TX2_TX_PATH_CFG0, 0x10},
325         { CDC_VA_TX2_TX_PATH_CFG1, 0x0B},
326         { CDC_VA_TX2_TX_VOL_CTL, 0x00},
327         { CDC_VA_TX2_TX_PATH_SEC0, 0x00},
328         { CDC_VA_TX2_TX_PATH_SEC1, 0x00},
329         { CDC_VA_TX2_TX_PATH_SEC2, 0x01},
330         { CDC_VA_TX2_TX_PATH_SEC3, 0x3C},
331         { CDC_VA_TX2_TX_PATH_SEC4, 0x20},
332         { CDC_VA_TX2_TX_PATH_SEC5, 0x00},
333         { CDC_VA_TX2_TX_PATH_SEC6, 0x00},
334         { CDC_VA_TX3_TX_PATH_CTL, 0x04},
335         { CDC_VA_TX3_TX_PATH_CFG0, 0x10},
336         { CDC_VA_TX3_TX_PATH_CFG1, 0x0B},
337         { CDC_VA_TX3_TX_VOL_CTL, 0x00},
338         { CDC_VA_TX3_TX_PATH_SEC0, 0x00},
339         { CDC_VA_TX3_TX_PATH_SEC1, 0x00},
340         { CDC_VA_TX3_TX_PATH_SEC2, 0x01},
341         { CDC_VA_TX3_TX_PATH_SEC3, 0x3C},
342         { CDC_VA_TX3_TX_PATH_SEC4, 0x20},
343         { CDC_VA_TX3_TX_PATH_SEC5, 0x00},
344         { CDC_VA_TX3_TX_PATH_SEC6, 0x00},
345 };
346 
347 static bool va_is_rw_register(struct device *dev, unsigned int reg)
348 {
349         switch (reg) {
350         case CDC_VA_CLK_RST_CTRL_MCLK_CONTROL:
351         case CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL:
352         case CDC_VA_CLK_RST_CTRL_SWR_CONTROL:
353         case CDC_VA_TOP_CSR_TOP_CFG0:
354         case CDC_VA_TOP_CSR_DMIC0_CTL:
355         case CDC_VA_TOP_CSR_DMIC1_CTL:
356         case CDC_VA_TOP_CSR_DMIC2_CTL:
357         case CDC_VA_TOP_CSR_DMIC3_CTL:
358         case CDC_VA_TOP_CSR_DMIC_CFG:
359         case CDC_VA_TOP_CSR_SWR_MIC_CTL0:
360         case CDC_VA_TOP_CSR_SWR_MIC_CTL1:
361         case CDC_VA_TOP_CSR_SWR_MIC_CTL2:
362         case CDC_VA_TOP_CSR_DEBUG_BUS:
363         case CDC_VA_TOP_CSR_DEBUG_EN:
364         case CDC_VA_TOP_CSR_TX_I2S_CTL:
365         case CDC_VA_TOP_CSR_I2S_CLK:
366         case CDC_VA_TOP_CSR_I2S_RESET:
367         case CDC_VA_INP_MUX_ADC_MUX0_CFG0:
368         case CDC_VA_INP_MUX_ADC_MUX0_CFG1:
369         case CDC_VA_INP_MUX_ADC_MUX1_CFG0:
370         case CDC_VA_INP_MUX_ADC_MUX1_CFG1:
371         case CDC_VA_INP_MUX_ADC_MUX2_CFG0:
372         case CDC_VA_INP_MUX_ADC_MUX2_CFG1:
373         case CDC_VA_INP_MUX_ADC_MUX3_CFG0:
374         case CDC_VA_INP_MUX_ADC_MUX3_CFG1:
375         case CDC_VA_TX0_TX_PATH_CTL:
376         case CDC_VA_TX0_TX_PATH_CFG0:
377         case CDC_VA_TX0_TX_PATH_CFG1:
378         case CDC_VA_TX0_TX_VOL_CTL:
379         case CDC_VA_TX0_TX_PATH_SEC0:
380         case CDC_VA_TX0_TX_PATH_SEC1:
381         case CDC_VA_TX0_TX_PATH_SEC2:
382         case CDC_VA_TX0_TX_PATH_SEC3:
383         case CDC_VA_TX0_TX_PATH_SEC4:
384         case CDC_VA_TX0_TX_PATH_SEC5:
385         case CDC_VA_TX0_TX_PATH_SEC6:
386         case CDC_VA_TX0_TX_PATH_SEC7:
387         case CDC_VA_TX1_TX_PATH_CTL:
388         case CDC_VA_TX1_TX_PATH_CFG0:
389         case CDC_VA_TX1_TX_PATH_CFG1:
390         case CDC_VA_TX1_TX_VOL_CTL:
391         case CDC_VA_TX1_TX_PATH_SEC0:
392         case CDC_VA_TX1_TX_PATH_SEC1:
393         case CDC_VA_TX1_TX_PATH_SEC2:
394         case CDC_VA_TX1_TX_PATH_SEC3:
395         case CDC_VA_TX1_TX_PATH_SEC4:
396         case CDC_VA_TX1_TX_PATH_SEC5:
397         case CDC_VA_TX1_TX_PATH_SEC6:
398         case CDC_VA_TX2_TX_PATH_CTL:
399         case CDC_VA_TX2_TX_PATH_CFG0:
400         case CDC_VA_TX2_TX_PATH_CFG1:
401         case CDC_VA_TX2_TX_VOL_CTL:
402         case CDC_VA_TX2_TX_PATH_SEC0:
403         case CDC_VA_TX2_TX_PATH_SEC1:
404         case CDC_VA_TX2_TX_PATH_SEC2:
405         case CDC_VA_TX2_TX_PATH_SEC3:
406         case CDC_VA_TX2_TX_PATH_SEC4:
407         case CDC_VA_TX2_TX_PATH_SEC5:
408         case CDC_VA_TX2_TX_PATH_SEC6:
409         case CDC_VA_TX3_TX_PATH_CTL:
410         case CDC_VA_TX3_TX_PATH_CFG0:
411         case CDC_VA_TX3_TX_PATH_CFG1:
412         case CDC_VA_TX3_TX_VOL_CTL:
413         case CDC_VA_TX3_TX_PATH_SEC0:
414         case CDC_VA_TX3_TX_PATH_SEC1:
415         case CDC_VA_TX3_TX_PATH_SEC2:
416         case CDC_VA_TX3_TX_PATH_SEC3:
417         case CDC_VA_TX3_TX_PATH_SEC4:
418         case CDC_VA_TX3_TX_PATH_SEC5:
419         case CDC_VA_TX3_TX_PATH_SEC6:
420                 return true;
421         }
422 
423         return false;
424 }
425 
426 static bool va_is_readable_register(struct device *dev, unsigned int reg)
427 {
428         switch (reg) {
429         case CDC_VA_TOP_CSR_CORE_ID_0:
430         case CDC_VA_TOP_CSR_CORE_ID_1:
431         case CDC_VA_TOP_CSR_CORE_ID_2:
432         case CDC_VA_TOP_CSR_CORE_ID_3:
433                 return true;
434         }
435 
436         return va_is_rw_register(dev, reg);
437 }
438 
439 static const struct regmap_config va_regmap_config = {
440         .name = "va_macro",
441         .reg_bits = 32,
442         .val_bits = 32,
443         .reg_stride = 4,
444         .cache_type = REGCACHE_FLAT,
445         .reg_defaults = va_defaults,
446         .num_reg_defaults = ARRAY_SIZE(va_defaults),
447         .max_register = VA_MAX_OFFSET,
448         .volatile_reg = va_is_volatile_register,
449         .readable_reg = va_is_readable_register,
450         .writeable_reg = va_is_rw_register,
451 };
452 
453 static int va_clk_rsc_fs_gen_request(struct va_macro *va, bool enable)
454 {
455         struct regmap *regmap = va->regmap;
456 
457         if (enable) {
458                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_MCLK_CONTROL,
459                                    CDC_VA_MCLK_CONTROL_EN,
460                                    CDC_VA_MCLK_CONTROL_EN);
461                 /* clear the fs counter */
462                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL,
463                                    CDC_VA_FS_CONTROL_EN | CDC_VA_FS_COUNTER_CLR,
464                                    CDC_VA_FS_CONTROL_EN | CDC_VA_FS_COUNTER_CLR);
465                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL,
466                                    CDC_VA_FS_CONTROL_EN | CDC_VA_FS_COUNTER_CLR,
467                                    CDC_VA_FS_CONTROL_EN);
468 
469                 regmap_update_bits(regmap, CDC_VA_TOP_CSR_TOP_CFG0,
470                                    CDC_VA_FS_BROADCAST_EN,
471                                    CDC_VA_FS_BROADCAST_EN);
472         } else {
473                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_MCLK_CONTROL,
474                                    CDC_VA_MCLK_CONTROL_EN, 0x0);
475 
476                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_FS_CNT_CONTROL,
477                                    CDC_VA_FS_CONTROL_EN, 0x0);
478 
479                 regmap_update_bits(regmap, CDC_VA_TOP_CSR_TOP_CFG0,
480                                    CDC_VA_FS_BROADCAST_EN, 0x0);
481         }
482 
483         return 0;
484 }
485 
486 static int va_macro_mclk_enable(struct va_macro *va, bool mclk_enable)
487 {
488         struct regmap *regmap = va->regmap;
489 
490         if (mclk_enable) {
491                 va_clk_rsc_fs_gen_request(va, true);
492                 regcache_mark_dirty(regmap);
493                 regcache_sync_region(regmap, 0x0, VA_MAX_OFFSET);
494         } else {
495                 va_clk_rsc_fs_gen_request(va, false);
496         }
497 
498         return 0;
499 }
500 
501 static int va_macro_mclk_event(struct snd_soc_dapm_widget *w,
502                                struct snd_kcontrol *kcontrol, int event)
503 {
504         struct snd_soc_component *comp = snd_soc_dapm_to_component(w->dapm);
505         struct va_macro *va = snd_soc_component_get_drvdata(comp);
506 
507         switch (event) {
508         case SND_SOC_DAPM_PRE_PMU:
509                 return clk_prepare_enable(va->fsgen);
510         case SND_SOC_DAPM_POST_PMD:
511                 clk_disable_unprepare(va->fsgen);
512         }
513 
514         return 0;
515 }
516 
517 static int va_macro_put_dec_enum(struct snd_kcontrol *kcontrol,
518                                  struct snd_ctl_elem_value *ucontrol)
519 {
520         struct snd_soc_dapm_widget *widget =
521                 snd_soc_dapm_kcontrol_widget(kcontrol);
522         struct snd_soc_component *component =
523                 snd_soc_dapm_to_component(widget->dapm);
524         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
525         unsigned int val;
526         u16 mic_sel_reg;
527 
528         val = ucontrol->value.enumerated.item[0];
529 
530         switch (e->reg) {
531         case CDC_VA_INP_MUX_ADC_MUX0_CFG0:
532                 mic_sel_reg = CDC_VA_TX0_TX_PATH_CFG0;
533                 break;
534         case CDC_VA_INP_MUX_ADC_MUX1_CFG0:
535                 mic_sel_reg = CDC_VA_TX1_TX_PATH_CFG0;
536                 break;
537         case CDC_VA_INP_MUX_ADC_MUX2_CFG0:
538                 mic_sel_reg = CDC_VA_TX2_TX_PATH_CFG0;
539                 break;
540         case CDC_VA_INP_MUX_ADC_MUX3_CFG0:
541                 mic_sel_reg = CDC_VA_TX3_TX_PATH_CFG0;
542                 break;
543         default:
544                 dev_err(component->dev, "%s: e->reg: 0x%x not expected\n",
545                         __func__, e->reg);
546                 return -EINVAL;
547         }
548 
549         if (val != 0)
550                 snd_soc_component_update_bits(component, mic_sel_reg,
551                                               CDC_VA_TX_PATH_ADC_DMIC_SEL_MASK,
552                                               CDC_VA_TX_PATH_ADC_DMIC_SEL_DMIC);
553 
554         return snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
555 }
556 
557 static int va_macro_tx_mixer_get(struct snd_kcontrol *kcontrol,
558                                  struct snd_ctl_elem_value *ucontrol)
559 {
560         struct snd_soc_dapm_widget *widget =
561                 snd_soc_dapm_kcontrol_widget(kcontrol);
562         struct snd_soc_component *component =
563                                 snd_soc_dapm_to_component(widget->dapm);
564         struct soc_mixer_control *mc =
565                 (struct soc_mixer_control *)kcontrol->private_value;
566         u32 dai_id = widget->shift;
567         u32 dec_id = mc->shift;
568         struct va_macro *va = snd_soc_component_get_drvdata(component);
569 
570         if (test_bit(dec_id, &va->active_ch_mask[dai_id]))
571                 ucontrol->value.integer.value[0] = 1;
572         else
573                 ucontrol->value.integer.value[0] = 0;
574 
575         return 0;
576 }
577 
578 static int va_macro_tx_mixer_put(struct snd_kcontrol *kcontrol,
579                                  struct snd_ctl_elem_value *ucontrol)
580 {
581         struct snd_soc_dapm_widget *widget =
582                                         snd_soc_dapm_kcontrol_widget(kcontrol);
583         struct snd_soc_component *component =
584                                 snd_soc_dapm_to_component(widget->dapm);
585         struct snd_soc_dapm_update *update = NULL;
586         struct soc_mixer_control *mc =
587                 (struct soc_mixer_control *)kcontrol->private_value;
588         u32 dai_id = widget->shift;
589         u32 dec_id = mc->shift;
590         u32 enable = ucontrol->value.integer.value[0];
591         struct va_macro *va = snd_soc_component_get_drvdata(component);
592 
593         if (enable) {
594                 set_bit(dec_id, &va->active_ch_mask[dai_id]);
595                 va->active_ch_cnt[dai_id]++;
596         } else {
597                 clear_bit(dec_id, &va->active_ch_mask[dai_id]);
598                 va->active_ch_cnt[dai_id]--;
599         }
600 
601         snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, update);
602 
603         return 0;
604 }
605 
606 static int va_dmic_clk_enable(struct snd_soc_component *component,
607                               u32 dmic, bool enable)
608 {
609         struct va_macro *va = snd_soc_component_get_drvdata(component);
610         u16 dmic_clk_reg;
611         s32 *dmic_clk_cnt;
612         u8 *dmic_clk_div;
613         u8 freq_change_mask;
614         u8 clk_div;
615 
616         switch (dmic) {
617         case 0:
618         case 1:
619                 dmic_clk_cnt = &(va->dmic_0_1_clk_cnt);
620                 dmic_clk_div = &(va->dmic_0_1_clk_div);
621                 dmic_clk_reg = CDC_VA_TOP_CSR_DMIC0_CTL;
622                 freq_change_mask = CDC_VA_DMIC0_FREQ_CHANGE_MASK;
623                 break;
624         case 2:
625         case 3:
626                 dmic_clk_cnt = &(va->dmic_2_3_clk_cnt);
627                 dmic_clk_div = &(va->dmic_2_3_clk_div);
628                 dmic_clk_reg = CDC_VA_TOP_CSR_DMIC1_CTL;
629                 freq_change_mask = CDC_VA_DMIC1_FREQ_CHANGE_MASK;
630                 break;
631         case 4:
632         case 5:
633                 dmic_clk_cnt = &(va->dmic_4_5_clk_cnt);
634                 dmic_clk_div = &(va->dmic_4_5_clk_div);
635                 dmic_clk_reg = CDC_VA_TOP_CSR_DMIC2_CTL;
636                 freq_change_mask = CDC_VA_DMIC2_FREQ_CHANGE_MASK;
637                 break;
638         case 6:
639         case 7:
640                 dmic_clk_cnt = &(va->dmic_6_7_clk_cnt);
641                 dmic_clk_div = &(va->dmic_6_7_clk_div);
642                 dmic_clk_reg = CDC_VA_TOP_CSR_DMIC3_CTL;
643                 freq_change_mask = CDC_VA_DMIC3_FREQ_CHANGE_MASK;
644                 break;
645         default:
646                 dev_err(component->dev, "%s: Invalid DMIC Selection\n",
647                         __func__);
648                 return -EINVAL;
649         }
650 
651         if (enable) {
652                 clk_div = va->dmic_clk_div;
653                 (*dmic_clk_cnt)++;
654                 if (*dmic_clk_cnt == 1) {
655                         snd_soc_component_update_bits(component,
656                                               CDC_VA_TOP_CSR_DMIC_CFG,
657                                               CDC_VA_RESET_ALL_DMICS_MASK,
658                                               CDC_VA_RESET_ALL_DMICS_DISABLE);
659                         snd_soc_component_update_bits(component, dmic_clk_reg,
660                                         CDC_VA_DMIC_CLK_SEL_MASK,
661                                         clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
662                         snd_soc_component_update_bits(component, dmic_clk_reg,
663                                                       CDC_VA_DMIC_EN_MASK,
664                                                       CDC_VA_DMIC_ENABLE);
665                 } else {
666                         if (*dmic_clk_div > clk_div) {
667                                 snd_soc_component_update_bits(component,
668                                                 CDC_VA_TOP_CSR_DMIC_CFG,
669                                                 freq_change_mask,
670                                                 freq_change_mask);
671                                 snd_soc_component_update_bits(component, dmic_clk_reg,
672                                                 CDC_VA_DMIC_CLK_SEL_MASK,
673                                                 clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
674                                 snd_soc_component_update_bits(component,
675                                               CDC_VA_TOP_CSR_DMIC_CFG,
676                                               freq_change_mask,
677                                               CDC_VA_DMIC_FREQ_CHANGE_DISABLE);
678                         } else {
679                                 clk_div = *dmic_clk_div;
680                         }
681                 }
682                 *dmic_clk_div = clk_div;
683         } else {
684                 (*dmic_clk_cnt)--;
685                 if (*dmic_clk_cnt  == 0) {
686                         snd_soc_component_update_bits(component, dmic_clk_reg,
687                                                       CDC_VA_DMIC_EN_MASK, 0);
688                         clk_div = 0;
689                         snd_soc_component_update_bits(component, dmic_clk_reg,
690                                                 CDC_VA_DMIC_CLK_SEL_MASK,
691                                                 clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
692                 } else {
693                         clk_div = va->dmic_clk_div;
694                         if (*dmic_clk_div > clk_div) {
695                                 clk_div = va->dmic_clk_div;
696                                 snd_soc_component_update_bits(component,
697                                                         CDC_VA_TOP_CSR_DMIC_CFG,
698                                                         freq_change_mask,
699                                                         freq_change_mask);
700                                 snd_soc_component_update_bits(component, dmic_clk_reg,
701                                                 CDC_VA_DMIC_CLK_SEL_MASK,
702                                                 clk_div << CDC_VA_DMIC_CLK_SEL_SHFT);
703                                 snd_soc_component_update_bits(component,
704                                                       CDC_VA_TOP_CSR_DMIC_CFG,
705                                                       freq_change_mask,
706                                                       CDC_VA_DMIC_FREQ_CHANGE_DISABLE);
707                         } else {
708                                 clk_div = *dmic_clk_div;
709                         }
710                 }
711                 *dmic_clk_div = clk_div;
712         }
713 
714         return 0;
715 }
716 
717 static int va_macro_enable_dmic(struct snd_soc_dapm_widget *w,
718                                 struct snd_kcontrol *kcontrol, int event)
719 {
720         struct snd_soc_component *comp = snd_soc_dapm_to_component(w->dapm);
721         unsigned int dmic = w->shift;
722 
723         switch (event) {
724         case SND_SOC_DAPM_PRE_PMU:
725                 va_dmic_clk_enable(comp, dmic, true);
726                 break;
727         case SND_SOC_DAPM_POST_PMD:
728                 va_dmic_clk_enable(comp, dmic, false);
729                 break;
730         }
731 
732         return 0;
733 }
734 
735 static int va_macro_enable_dec(struct snd_soc_dapm_widget *w,
736                                struct snd_kcontrol *kcontrol, int event)
737 {
738         struct snd_soc_component *comp = snd_soc_dapm_to_component(w->dapm);
739         unsigned int decimator;
740         u16 tx_vol_ctl_reg, dec_cfg_reg, hpf_gate_reg;
741         u16 tx_gain_ctl_reg;
742         u8 hpf_cut_off_freq;
743 
744         struct va_macro *va = snd_soc_component_get_drvdata(comp);
745 
746         decimator = w->shift;
747 
748         tx_vol_ctl_reg = CDC_VA_TX0_TX_PATH_CTL +
749                                 VA_MACRO_TX_PATH_OFFSET * decimator;
750         hpf_gate_reg = CDC_VA_TX0_TX_PATH_SEC2 +
751                                 VA_MACRO_TX_PATH_OFFSET * decimator;
752         dec_cfg_reg = CDC_VA_TX0_TX_PATH_CFG0 +
753                                 VA_MACRO_TX_PATH_OFFSET * decimator;
754         tx_gain_ctl_reg = CDC_VA_TX0_TX_VOL_CTL +
755                                 VA_MACRO_TX_PATH_OFFSET * decimator;
756 
757         switch (event) {
758         case SND_SOC_DAPM_PRE_PMU:
759                 snd_soc_component_update_bits(comp,
760                         dec_cfg_reg, CDC_VA_ADC_MODE_MASK,
761                         va->dec_mode[decimator] << CDC_VA_ADC_MODE_SHIFT);
762                 /* Enable TX PGA Mute */
763                 break;
764         case SND_SOC_DAPM_POST_PMU:
765                 /* Enable TX CLK */
766                 snd_soc_component_update_bits(comp, tx_vol_ctl_reg,
767                                               CDC_VA_TX_PATH_CLK_EN_MASK,
768                                               CDC_VA_TX_PATH_CLK_EN);
769                 snd_soc_component_update_bits(comp, hpf_gate_reg,
770                                               CDC_VA_TX_HPF_ZERO_GATE_MASK,
771                                               CDC_VA_TX_HPF_ZERO_GATE);
772 
773                 usleep_range(1000, 1010);
774                 hpf_cut_off_freq = (snd_soc_component_read(comp, dec_cfg_reg) &
775                                     TX_HPF_CUT_OFF_FREQ_MASK) >> 5;
776 
777                 if (hpf_cut_off_freq != CF_MIN_3DB_150HZ) {
778                         snd_soc_component_update_bits(comp, dec_cfg_reg,
779                                                       TX_HPF_CUT_OFF_FREQ_MASK,
780                                                       CF_MIN_3DB_150HZ << 5);
781 
782                         snd_soc_component_update_bits(comp, hpf_gate_reg,
783                                       CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_MASK,
784                                       CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_REQ);
785 
786                         /*
787                          * Minimum 1 clk cycle delay is required as per HW spec
788                          */
789                         usleep_range(1000, 1010);
790 
791                         snd_soc_component_update_bits(comp,
792                                 hpf_gate_reg,
793                                 CDC_VA_TX_HPF_CUTOFF_FREQ_CHANGE_MASK,
794                                 0x0);
795                 }
796 
797 
798                 usleep_range(1000, 1010);
799                 snd_soc_component_update_bits(comp, hpf_gate_reg,
800                                               CDC_VA_TX_HPF_ZERO_GATE_MASK,
801                                               CDC_VA_TX_HPF_ZERO_NO_GATE);
802                 /*
803                  * 6ms delay is required as per HW spec
804                  */
805                 usleep_range(6000, 6010);
806                 /* apply gain after decimator is enabled */
807                 snd_soc_component_write(comp, tx_gain_ctl_reg,
808                         snd_soc_component_read(comp, tx_gain_ctl_reg));
809                 break;
810         case SND_SOC_DAPM_POST_PMD:
811                 /* Disable TX CLK */
812                 snd_soc_component_update_bits(comp, tx_vol_ctl_reg,
813                                                 CDC_VA_TX_PATH_CLK_EN_MASK,
814                                                 CDC_VA_TX_PATH_CLK_DISABLE);
815                 break;
816         }
817         return 0;
818 }
819 
820 static int va_macro_dec_mode_get(struct snd_kcontrol *kcontrol,
821                                  struct snd_ctl_elem_value *ucontrol)
822 {
823         struct snd_soc_component *comp = snd_soc_kcontrol_component(kcontrol);
824         struct va_macro *va = snd_soc_component_get_drvdata(comp);
825         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
826         int path = e->shift_l;
827 
828         ucontrol->value.enumerated.item[0] = va->dec_mode[path];
829 
830         return 0;
831 }
832 
833 static int va_macro_dec_mode_put(struct snd_kcontrol *kcontrol,
834                                  struct snd_ctl_elem_value *ucontrol)
835 {
836         struct snd_soc_component *comp = snd_soc_kcontrol_component(kcontrol);
837         int value = ucontrol->value.enumerated.item[0];
838         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
839         int path = e->shift_l;
840         struct va_macro *va = snd_soc_component_get_drvdata(comp);
841 
842         va->dec_mode[path] = value;
843 
844         return 0;
845 }
846 
847 static int va_macro_hw_params(struct snd_pcm_substream *substream,
848                               struct snd_pcm_hw_params *params,
849                               struct snd_soc_dai *dai)
850 {
851         int tx_fs_rate;
852         struct snd_soc_component *component = dai->component;
853         u32 decimator, sample_rate;
854         u16 tx_fs_reg;
855         struct device *va_dev = component->dev;
856         struct va_macro *va = snd_soc_component_get_drvdata(component);
857 
858         sample_rate = params_rate(params);
859         switch (sample_rate) {
860         case 8000:
861                 tx_fs_rate = 0;
862                 break;
863         case 16000:
864                 tx_fs_rate = 1;
865                 break;
866         case 32000:
867                 tx_fs_rate = 3;
868                 break;
869         case 48000:
870                 tx_fs_rate = 4;
871                 break;
872         case 96000:
873                 tx_fs_rate = 5;
874                 break;
875         case 192000:
876                 tx_fs_rate = 6;
877                 break;
878         case 384000:
879                 tx_fs_rate = 7;
880                 break;
881         default:
882                 dev_err(va_dev, "%s: Invalid TX sample rate: %d\n",
883                         __func__, params_rate(params));
884                 return -EINVAL;
885         }
886 
887         for_each_set_bit(decimator, &va->active_ch_mask[dai->id],
888                          VA_MACRO_DEC_MAX) {
889                 tx_fs_reg = CDC_VA_TX0_TX_PATH_CTL +
890                             VA_MACRO_TX_PATH_OFFSET * decimator;
891                 snd_soc_component_update_bits(component, tx_fs_reg, 0x0F,
892                                               tx_fs_rate);
893         }
894         return 0;
895 }
896 
897 static int va_macro_get_channel_map(const struct snd_soc_dai *dai,
898                                     unsigned int *tx_num, unsigned int *tx_slot,
899                                     unsigned int *rx_num, unsigned int *rx_slot)
900 {
901         struct snd_soc_component *component = dai->component;
902         struct device *va_dev = component->dev;
903         struct va_macro *va = snd_soc_component_get_drvdata(component);
904 
905         switch (dai->id) {
906         case VA_MACRO_AIF1_CAP:
907         case VA_MACRO_AIF2_CAP:
908         case VA_MACRO_AIF3_CAP:
909                 *tx_slot = va->active_ch_mask[dai->id];
910                 *tx_num = va->active_ch_cnt[dai->id];
911                 break;
912         default:
913                 dev_err(va_dev, "%s: Invalid AIF\n", __func__);
914                 break;
915         }
916         return 0;
917 }
918 
919 static int va_macro_digital_mute(struct snd_soc_dai *dai, int mute, int stream)
920 {
921         struct snd_soc_component *component = dai->component;
922         struct va_macro *va = snd_soc_component_get_drvdata(component);
923         u16 tx_vol_ctl_reg, decimator;
924 
925         for_each_set_bit(decimator, &va->active_ch_mask[dai->id],
926                          VA_MACRO_DEC_MAX) {
927                 tx_vol_ctl_reg = CDC_VA_TX0_TX_PATH_CTL +
928                                         VA_MACRO_TX_PATH_OFFSET * decimator;
929                 if (mute)
930                         snd_soc_component_update_bits(component, tx_vol_ctl_reg,
931                                         CDC_VA_TX_PATH_PGA_MUTE_EN_MASK,
932                                         CDC_VA_TX_PATH_PGA_MUTE_EN);
933                 else
934                         snd_soc_component_update_bits(component, tx_vol_ctl_reg,
935                                         CDC_VA_TX_PATH_PGA_MUTE_EN_MASK,
936                                         CDC_VA_TX_PATH_PGA_MUTE_DISABLE);
937         }
938 
939         return 0;
940 }
941 
942 static const struct snd_soc_dai_ops va_macro_dai_ops = {
943         .hw_params = va_macro_hw_params,
944         .get_channel_map = va_macro_get_channel_map,
945         .mute_stream = va_macro_digital_mute,
946 };
947 
948 static struct snd_soc_dai_driver va_macro_dais[] = {
949         {
950                 .name = "va_macro_tx1",
951                 .id = VA_MACRO_AIF1_CAP,
952                 .capture = {
953                         .stream_name = "VA_AIF1 Capture",
954                         .rates = VA_MACRO_RATES,
955                         .formats = VA_MACRO_FORMATS,
956                         .rate_max = 192000,
957                         .rate_min = 8000,
958                         .channels_min = 1,
959                         .channels_max = 8,
960                 },
961                 .ops = &va_macro_dai_ops,
962         },
963         {
964                 .name = "va_macro_tx2",
965                 .id = VA_MACRO_AIF2_CAP,
966                 .capture = {
967                         .stream_name = "VA_AIF2 Capture",
968                         .rates = VA_MACRO_RATES,
969                         .formats = VA_MACRO_FORMATS,
970                         .rate_max = 192000,
971                         .rate_min = 8000,
972                         .channels_min = 1,
973                         .channels_max = 8,
974                 },
975                 .ops = &va_macro_dai_ops,
976         },
977         {
978                 .name = "va_macro_tx3",
979                 .id = VA_MACRO_AIF3_CAP,
980                 .capture = {
981                         .stream_name = "VA_AIF3 Capture",
982                         .rates = VA_MACRO_RATES,
983                         .formats = VA_MACRO_FORMATS,
984                         .rate_max = 192000,
985                         .rate_min = 8000,
986                         .channels_min = 1,
987                         .channels_max = 8,
988                 },
989                 .ops = &va_macro_dai_ops,
990         },
991 };
992 
993 static const char * const adc_mux_text[] = {
994         "VA_DMIC", "SWR_MIC"
995 };
996 
997 static SOC_ENUM_SINGLE_DECL(va_dec0_enum, CDC_VA_INP_MUX_ADC_MUX0_CFG1,
998                    0, adc_mux_text);
999 static SOC_ENUM_SINGLE_DECL(va_dec1_enum, CDC_VA_INP_MUX_ADC_MUX1_CFG1,
1000                    0, adc_mux_text);
1001 static SOC_ENUM_SINGLE_DECL(va_dec2_enum, CDC_VA_INP_MUX_ADC_MUX2_CFG1,
1002                    0, adc_mux_text);
1003 static SOC_ENUM_SINGLE_DECL(va_dec3_enum, CDC_VA_INP_MUX_ADC_MUX3_CFG1,
1004                    0, adc_mux_text);
1005 
1006 static const struct snd_kcontrol_new va_dec0_mux = SOC_DAPM_ENUM("va_dec0",
1007                                                                  va_dec0_enum);
1008 static const struct snd_kcontrol_new va_dec1_mux = SOC_DAPM_ENUM("va_dec1",
1009                                                                  va_dec1_enum);
1010 static const struct snd_kcontrol_new va_dec2_mux = SOC_DAPM_ENUM("va_dec2",
1011                                                                  va_dec2_enum);
1012 static const struct snd_kcontrol_new va_dec3_mux = SOC_DAPM_ENUM("va_dec3",
1013                                                                  va_dec3_enum);
1014 
1015 static const char * const dmic_mux_text[] = {
1016         "ZERO", "DMIC0", "DMIC1", "DMIC2", "DMIC3",
1017         "DMIC4", "DMIC5", "DMIC6", "DMIC7"
1018 };
1019 
1020 static SOC_ENUM_SINGLE_DECL(va_dmic0_enum, CDC_VA_INP_MUX_ADC_MUX0_CFG0,
1021                         4, dmic_mux_text);
1022 
1023 static SOC_ENUM_SINGLE_DECL(va_dmic1_enum, CDC_VA_INP_MUX_ADC_MUX1_CFG0,
1024                         4, dmic_mux_text);
1025 
1026 static SOC_ENUM_SINGLE_DECL(va_dmic2_enum, CDC_VA_INP_MUX_ADC_MUX2_CFG0,
1027                         4, dmic_mux_text);
1028 
1029 static SOC_ENUM_SINGLE_DECL(va_dmic3_enum, CDC_VA_INP_MUX_ADC_MUX3_CFG0,
1030                         4, dmic_mux_text);
1031 
1032 static const struct snd_kcontrol_new va_dmic0_mux = SOC_DAPM_ENUM_EXT("va_dmic0",
1033                          va_dmic0_enum, snd_soc_dapm_get_enum_double,
1034                          va_macro_put_dec_enum);
1035 
1036 static const struct snd_kcontrol_new va_dmic1_mux = SOC_DAPM_ENUM_EXT("va_dmic1",
1037                          va_dmic1_enum, snd_soc_dapm_get_enum_double,
1038                          va_macro_put_dec_enum);
1039 
1040 static const struct snd_kcontrol_new va_dmic2_mux = SOC_DAPM_ENUM_EXT("va_dmic2",
1041                          va_dmic2_enum, snd_soc_dapm_get_enum_double,
1042                          va_macro_put_dec_enum);
1043 
1044 static const struct snd_kcontrol_new va_dmic3_mux = SOC_DAPM_ENUM_EXT("va_dmic3",
1045                          va_dmic3_enum, snd_soc_dapm_get_enum_double,
1046                          va_macro_put_dec_enum);
1047 
1048 static const struct snd_kcontrol_new va_aif1_cap_mixer[] = {
1049         SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, VA_MACRO_DEC0, 1, 0,
1050                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1051         SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, VA_MACRO_DEC1, 1, 0,
1052                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1053         SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, VA_MACRO_DEC2, 1, 0,
1054                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1055         SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, VA_MACRO_DEC3, 1, 0,
1056                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1057         SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, VA_MACRO_DEC4, 1, 0,
1058                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1059         SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, VA_MACRO_DEC5, 1, 0,
1060                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1061         SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, VA_MACRO_DEC6, 1, 0,
1062                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1063         SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, VA_MACRO_DEC7, 1, 0,
1064                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1065 };
1066 
1067 static const struct snd_kcontrol_new va_aif2_cap_mixer[] = {
1068         SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, VA_MACRO_DEC0, 1, 0,
1069                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1070         SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, VA_MACRO_DEC1, 1, 0,
1071                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1072         SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, VA_MACRO_DEC2, 1, 0,
1073                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1074         SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, VA_MACRO_DEC3, 1, 0,
1075                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1076         SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, VA_MACRO_DEC4, 1, 0,
1077                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1078         SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, VA_MACRO_DEC5, 1, 0,
1079                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1080         SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, VA_MACRO_DEC6, 1, 0,
1081                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1082         SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, VA_MACRO_DEC7, 1, 0,
1083                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1084 };
1085 
1086 static const struct snd_kcontrol_new va_aif3_cap_mixer[] = {
1087         SOC_SINGLE_EXT("DEC0", SND_SOC_NOPM, VA_MACRO_DEC0, 1, 0,
1088                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1089         SOC_SINGLE_EXT("DEC1", SND_SOC_NOPM, VA_MACRO_DEC1, 1, 0,
1090                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1091         SOC_SINGLE_EXT("DEC2", SND_SOC_NOPM, VA_MACRO_DEC2, 1, 0,
1092                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1093         SOC_SINGLE_EXT("DEC3", SND_SOC_NOPM, VA_MACRO_DEC3, 1, 0,
1094                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1095         SOC_SINGLE_EXT("DEC4", SND_SOC_NOPM, VA_MACRO_DEC4, 1, 0,
1096                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1097         SOC_SINGLE_EXT("DEC5", SND_SOC_NOPM, VA_MACRO_DEC5, 1, 0,
1098                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1099         SOC_SINGLE_EXT("DEC6", SND_SOC_NOPM, VA_MACRO_DEC6, 1, 0,
1100                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1101         SOC_SINGLE_EXT("DEC7", SND_SOC_NOPM, VA_MACRO_DEC7, 1, 0,
1102                         va_macro_tx_mixer_get, va_macro_tx_mixer_put),
1103 };
1104 
1105 static const struct snd_soc_dapm_widget va_macro_dapm_widgets[] = {
1106         SND_SOC_DAPM_AIF_OUT("VA_AIF1 CAP", "VA_AIF1 Capture", 0,
1107                 SND_SOC_NOPM, VA_MACRO_AIF1_CAP, 0),
1108 
1109         SND_SOC_DAPM_AIF_OUT("VA_AIF2 CAP", "VA_AIF2 Capture", 0,
1110                 SND_SOC_NOPM, VA_MACRO_AIF2_CAP, 0),
1111 
1112         SND_SOC_DAPM_AIF_OUT("VA_AIF3 CAP", "VA_AIF3 Capture", 0,
1113                 SND_SOC_NOPM, VA_MACRO_AIF3_CAP, 0),
1114 
1115         SND_SOC_DAPM_MIXER("VA_AIF1_CAP Mixer", SND_SOC_NOPM,
1116                 VA_MACRO_AIF1_CAP, 0,
1117                 va_aif1_cap_mixer, ARRAY_SIZE(va_aif1_cap_mixer)),
1118 
1119         SND_SOC_DAPM_MIXER("VA_AIF2_CAP Mixer", SND_SOC_NOPM,
1120                 VA_MACRO_AIF2_CAP, 0,
1121                 va_aif2_cap_mixer, ARRAY_SIZE(va_aif2_cap_mixer)),
1122 
1123         SND_SOC_DAPM_MIXER("VA_AIF3_CAP Mixer", SND_SOC_NOPM,
1124                 VA_MACRO_AIF3_CAP, 0,
1125                 va_aif3_cap_mixer, ARRAY_SIZE(va_aif3_cap_mixer)),
1126 
1127         SND_SOC_DAPM_MUX("VA DMIC MUX0", SND_SOC_NOPM, 0, 0, &va_dmic0_mux),
1128         SND_SOC_DAPM_MUX("VA DMIC MUX1", SND_SOC_NOPM, 0, 0, &va_dmic1_mux),
1129         SND_SOC_DAPM_MUX("VA DMIC MUX2", SND_SOC_NOPM, 0, 0, &va_dmic2_mux),
1130         SND_SOC_DAPM_MUX("VA DMIC MUX3", SND_SOC_NOPM, 0, 0, &va_dmic3_mux),
1131 
1132         SND_SOC_DAPM_REGULATOR_SUPPLY("vdd-micb", 0, 0),
1133         SND_SOC_DAPM_INPUT("DMIC0 Pin"),
1134         SND_SOC_DAPM_INPUT("DMIC1 Pin"),
1135         SND_SOC_DAPM_INPUT("DMIC2 Pin"),
1136         SND_SOC_DAPM_INPUT("DMIC3 Pin"),
1137         SND_SOC_DAPM_INPUT("DMIC4 Pin"),
1138         SND_SOC_DAPM_INPUT("DMIC5 Pin"),
1139         SND_SOC_DAPM_INPUT("DMIC6 Pin"),
1140         SND_SOC_DAPM_INPUT("DMIC7 Pin"),
1141 
1142         SND_SOC_DAPM_ADC_E("VA DMIC0", NULL, SND_SOC_NOPM, 0, 0,
1143                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1144                 SND_SOC_DAPM_POST_PMD),
1145 
1146         SND_SOC_DAPM_ADC_E("VA DMIC1", NULL, SND_SOC_NOPM, 1, 0,
1147                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1148                 SND_SOC_DAPM_POST_PMD),
1149 
1150         SND_SOC_DAPM_ADC_E("VA DMIC2", NULL, SND_SOC_NOPM, 2, 0,
1151                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1152                 SND_SOC_DAPM_POST_PMD),
1153 
1154         SND_SOC_DAPM_ADC_E("VA DMIC3", NULL, SND_SOC_NOPM, 3, 0,
1155                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1156                 SND_SOC_DAPM_POST_PMD),
1157 
1158         SND_SOC_DAPM_ADC_E("VA DMIC4", NULL, SND_SOC_NOPM, 4, 0,
1159                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1160                 SND_SOC_DAPM_POST_PMD),
1161 
1162         SND_SOC_DAPM_ADC_E("VA DMIC5", NULL, SND_SOC_NOPM, 5, 0,
1163                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1164                 SND_SOC_DAPM_POST_PMD),
1165 
1166         SND_SOC_DAPM_ADC_E("VA DMIC6", NULL, SND_SOC_NOPM, 6, 0,
1167                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1168                 SND_SOC_DAPM_POST_PMD),
1169 
1170         SND_SOC_DAPM_ADC_E("VA DMIC7", NULL, SND_SOC_NOPM, 7, 0,
1171                 va_macro_enable_dmic, SND_SOC_DAPM_PRE_PMU |
1172                 SND_SOC_DAPM_POST_PMD),
1173 
1174         SND_SOC_DAPM_INPUT("VA SWR_ADC0"),
1175         SND_SOC_DAPM_INPUT("VA SWR_ADC1"),
1176         SND_SOC_DAPM_INPUT("VA SWR_ADC2"),
1177         SND_SOC_DAPM_INPUT("VA SWR_ADC3"),
1178         SND_SOC_DAPM_INPUT("VA SWR_MIC0"),
1179         SND_SOC_DAPM_INPUT("VA SWR_MIC1"),
1180         SND_SOC_DAPM_INPUT("VA SWR_MIC2"),
1181         SND_SOC_DAPM_INPUT("VA SWR_MIC3"),
1182         SND_SOC_DAPM_INPUT("VA SWR_MIC4"),
1183         SND_SOC_DAPM_INPUT("VA SWR_MIC5"),
1184         SND_SOC_DAPM_INPUT("VA SWR_MIC6"),
1185         SND_SOC_DAPM_INPUT("VA SWR_MIC7"),
1186 
1187         SND_SOC_DAPM_MUX_E("VA DEC0 MUX", SND_SOC_NOPM, VA_MACRO_DEC0, 0,
1188                            &va_dec0_mux, va_macro_enable_dec,
1189                            SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1190                            SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1191 
1192         SND_SOC_DAPM_MUX_E("VA DEC1 MUX", SND_SOC_NOPM, VA_MACRO_DEC1, 0,
1193                            &va_dec1_mux, va_macro_enable_dec,
1194                            SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1195                            SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1196 
1197         SND_SOC_DAPM_MUX_E("VA DEC2 MUX", SND_SOC_NOPM, VA_MACRO_DEC2, 0,
1198                            &va_dec2_mux, va_macro_enable_dec,
1199                            SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1200                            SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1201 
1202         SND_SOC_DAPM_MUX_E("VA DEC3 MUX", SND_SOC_NOPM, VA_MACRO_DEC3, 0,
1203                            &va_dec3_mux, va_macro_enable_dec,
1204                            SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1205                            SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1206 
1207         SND_SOC_DAPM_SUPPLY_S("VA_MCLK", -1, SND_SOC_NOPM, 0, 0,
1208                               va_macro_mclk_event,
1209                               SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1210 };
1211 
1212 static const struct snd_soc_dapm_route va_audio_map[] = {
1213         {"VA_AIF1 CAP", NULL, "VA_MCLK"},
1214         {"VA_AIF2 CAP", NULL, "VA_MCLK"},
1215         {"VA_AIF3 CAP", NULL, "VA_MCLK"},
1216 
1217         {"VA_AIF1 CAP", NULL, "VA_AIF1_CAP Mixer"},
1218         {"VA_AIF2 CAP", NULL, "VA_AIF2_CAP Mixer"},
1219         {"VA_AIF3 CAP", NULL, "VA_AIF3_CAP Mixer"},
1220 
1221         {"VA_AIF1_CAP Mixer", "DEC0", "VA DEC0 MUX"},
1222         {"VA_AIF1_CAP Mixer", "DEC1", "VA DEC1 MUX"},
1223         {"VA_AIF1_CAP Mixer", "DEC2", "VA DEC2 MUX"},
1224         {"VA_AIF1_CAP Mixer", "DEC3", "VA DEC3 MUX"},
1225 
1226         {"VA_AIF2_CAP Mixer", "DEC0", "VA DEC0 MUX"},
1227         {"VA_AIF2_CAP Mixer", "DEC1", "VA DEC1 MUX"},
1228         {"VA_AIF2_CAP Mixer", "DEC2", "VA DEC2 MUX"},
1229         {"VA_AIF2_CAP Mixer", "DEC3", "VA DEC3 MUX"},
1230 
1231         {"VA_AIF3_CAP Mixer", "DEC0", "VA DEC0 MUX"},
1232         {"VA_AIF3_CAP Mixer", "DEC1", "VA DEC1 MUX"},
1233         {"VA_AIF3_CAP Mixer", "DEC2", "VA DEC2 MUX"},
1234         {"VA_AIF3_CAP Mixer", "DEC3", "VA DEC3 MUX"},
1235 
1236         {"VA DEC0 MUX", "VA_DMIC", "VA DMIC MUX0"},
1237         {"VA DMIC MUX0", "DMIC0", "VA DMIC0"},
1238         {"VA DMIC MUX0", "DMIC1", "VA DMIC1"},
1239         {"VA DMIC MUX0", "DMIC2", "VA DMIC2"},
1240         {"VA DMIC MUX0", "DMIC3", "VA DMIC3"},
1241         {"VA DMIC MUX0", "DMIC4", "VA DMIC4"},
1242         {"VA DMIC MUX0", "DMIC5", "VA DMIC5"},
1243         {"VA DMIC MUX0", "DMIC6", "VA DMIC6"},
1244         {"VA DMIC MUX0", "DMIC7", "VA DMIC7"},
1245 
1246         {"VA DEC1 MUX", "VA_DMIC", "VA DMIC MUX1"},
1247         {"VA DMIC MUX1", "DMIC0", "VA DMIC0"},
1248         {"VA DMIC MUX1", "DMIC1", "VA DMIC1"},
1249         {"VA DMIC MUX1", "DMIC2", "VA DMIC2"},
1250         {"VA DMIC MUX1", "DMIC3", "VA DMIC3"},
1251         {"VA DMIC MUX1", "DMIC4", "VA DMIC4"},
1252         {"VA DMIC MUX1", "DMIC5", "VA DMIC5"},
1253         {"VA DMIC MUX1", "DMIC6", "VA DMIC6"},
1254         {"VA DMIC MUX1", "DMIC7", "VA DMIC7"},
1255 
1256         {"VA DEC2 MUX", "VA_DMIC", "VA DMIC MUX2"},
1257         {"VA DMIC MUX2", "DMIC0", "VA DMIC0"},
1258         {"VA DMIC MUX2", "DMIC1", "VA DMIC1"},
1259         {"VA DMIC MUX2", "DMIC2", "VA DMIC2"},
1260         {"VA DMIC MUX2", "DMIC3", "VA DMIC3"},
1261         {"VA DMIC MUX2", "DMIC4", "VA DMIC4"},
1262         {"VA DMIC MUX2", "DMIC5", "VA DMIC5"},
1263         {"VA DMIC MUX2", "DMIC6", "VA DMIC6"},
1264         {"VA DMIC MUX2", "DMIC7", "VA DMIC7"},
1265 
1266         {"VA DEC3 MUX", "VA_DMIC", "VA DMIC MUX3"},
1267         {"VA DMIC MUX3", "DMIC0", "VA DMIC0"},
1268         {"VA DMIC MUX3", "DMIC1", "VA DMIC1"},
1269         {"VA DMIC MUX3", "DMIC2", "VA DMIC2"},
1270         {"VA DMIC MUX3", "DMIC3", "VA DMIC3"},
1271         {"VA DMIC MUX3", "DMIC4", "VA DMIC4"},
1272         {"VA DMIC MUX3", "DMIC5", "VA DMIC5"},
1273         {"VA DMIC MUX3", "DMIC6", "VA DMIC6"},
1274         {"VA DMIC MUX3", "DMIC7", "VA DMIC7"},
1275 
1276         { "VA DMIC0", NULL, "DMIC0 Pin" },
1277         { "VA DMIC1", NULL, "DMIC1 Pin" },
1278         { "VA DMIC2", NULL, "DMIC2 Pin" },
1279         { "VA DMIC3", NULL, "DMIC3 Pin" },
1280         { "VA DMIC4", NULL, "DMIC4 Pin" },
1281         { "VA DMIC5", NULL, "DMIC5 Pin" },
1282         { "VA DMIC6", NULL, "DMIC6 Pin" },
1283         { "VA DMIC7", NULL, "DMIC7 Pin" },
1284 };
1285 
1286 static const char * const dec_mode_mux_text[] = {
1287         "ADC_DEFAULT", "ADC_LOW_PWR", "ADC_HIGH_PERF",
1288 };
1289 
1290 static const struct soc_enum dec_mode_mux_enum[] = {
1291         SOC_ENUM_SINGLE(SND_SOC_NOPM, 0, ARRAY_SIZE(dec_mode_mux_text),
1292                         dec_mode_mux_text),
1293         SOC_ENUM_SINGLE(SND_SOC_NOPM, 1, ARRAY_SIZE(dec_mode_mux_text),
1294                         dec_mode_mux_text),
1295         SOC_ENUM_SINGLE(SND_SOC_NOPM, 2,  ARRAY_SIZE(dec_mode_mux_text),
1296                         dec_mode_mux_text),
1297         SOC_ENUM_SINGLE(SND_SOC_NOPM, 3, ARRAY_SIZE(dec_mode_mux_text),
1298                         dec_mode_mux_text),
1299 };
1300 
1301 static const struct snd_kcontrol_new va_macro_snd_controls[] = {
1302         SOC_SINGLE_S8_TLV("VA_DEC0 Volume", CDC_VA_TX0_TX_VOL_CTL,
1303                           -84, 40, digital_gain),
1304         SOC_SINGLE_S8_TLV("VA_DEC1 Volume", CDC_VA_TX1_TX_VOL_CTL,
1305                           -84, 40, digital_gain),
1306         SOC_SINGLE_S8_TLV("VA_DEC2 Volume", CDC_VA_TX2_TX_VOL_CTL,
1307                           -84, 40, digital_gain),
1308         SOC_SINGLE_S8_TLV("VA_DEC3 Volume", CDC_VA_TX3_TX_VOL_CTL,
1309                           -84, 40, digital_gain),
1310 
1311         SOC_ENUM_EXT("VA_DEC0 MODE", dec_mode_mux_enum[0],
1312                      va_macro_dec_mode_get, va_macro_dec_mode_put),
1313         SOC_ENUM_EXT("VA_DEC1 MODE", dec_mode_mux_enum[1],
1314                      va_macro_dec_mode_get, va_macro_dec_mode_put),
1315         SOC_ENUM_EXT("VA_DEC2 MODE", dec_mode_mux_enum[2],
1316                      va_macro_dec_mode_get, va_macro_dec_mode_put),
1317         SOC_ENUM_EXT("VA_DEC3 MODE", dec_mode_mux_enum[3],
1318                      va_macro_dec_mode_get, va_macro_dec_mode_put),
1319 };
1320 
1321 static int va_macro_component_probe(struct snd_soc_component *component)
1322 {
1323         struct va_macro *va = snd_soc_component_get_drvdata(component);
1324 
1325         snd_soc_component_init_regmap(component, va->regmap);
1326 
1327         return 0;
1328 }
1329 
1330 static const struct snd_soc_component_driver va_macro_component_drv = {
1331         .name = "VA MACRO",
1332         .probe = va_macro_component_probe,
1333         .controls = va_macro_snd_controls,
1334         .num_controls = ARRAY_SIZE(va_macro_snd_controls),
1335         .dapm_widgets = va_macro_dapm_widgets,
1336         .num_dapm_widgets = ARRAY_SIZE(va_macro_dapm_widgets),
1337         .dapm_routes = va_audio_map,
1338         .num_dapm_routes = ARRAY_SIZE(va_audio_map),
1339 };
1340 
1341 static int fsgen_gate_enable(struct clk_hw *hw)
1342 {
1343         struct va_macro *va = to_va_macro(hw);
1344         struct regmap *regmap = va->regmap;
1345         int ret;
1346 
1347         if (va->has_swr_master) {
1348                 ret = clk_prepare_enable(va->mclk);
1349                 if (ret)
1350                         return ret;
1351         }
1352 
1353         ret = va_macro_mclk_enable(va, true);
1354         if (va->has_swr_master)
1355                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
1356                                    CDC_VA_SWR_CLK_EN_MASK, CDC_VA_SWR_CLK_ENABLE);
1357 
1358         return ret;
1359 }
1360 
1361 static void fsgen_gate_disable(struct clk_hw *hw)
1362 {
1363         struct va_macro *va = to_va_macro(hw);
1364         struct regmap *regmap = va->regmap;
1365 
1366         if (va->has_swr_master)
1367                 regmap_update_bits(regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
1368                            CDC_VA_SWR_CLK_EN_MASK, 0x0);
1369 
1370         va_macro_mclk_enable(va, false);
1371         if (va->has_swr_master)
1372                 clk_disable_unprepare(va->mclk);
1373 }
1374 
1375 static int fsgen_gate_is_enabled(struct clk_hw *hw)
1376 {
1377         struct va_macro *va = to_va_macro(hw);
1378         int val;
1379 
1380         regmap_read(va->regmap, CDC_VA_TOP_CSR_TOP_CFG0, &val);
1381 
1382         return  !!(val & CDC_VA_FS_BROADCAST_EN);
1383 }
1384 
1385 static const struct clk_ops fsgen_gate_ops = {
1386         .prepare = fsgen_gate_enable,
1387         .unprepare = fsgen_gate_disable,
1388         .is_enabled = fsgen_gate_is_enabled,
1389 };
1390 
1391 static int va_macro_register_fsgen_output(struct va_macro *va)
1392 {
1393         struct clk *parent = va->mclk;
1394         struct device *dev = va->dev;
1395         struct device_node *np = dev->of_node;
1396         const char *parent_clk_name;
1397         const char *clk_name = "fsgen";
1398         struct clk_init_data init;
1399         int ret;
1400 
1401         if (va->has_npl_clk)
1402                 parent = va->npl;
1403 
1404         parent_clk_name = __clk_get_name(parent);
1405 
1406         of_property_read_string(np, "clock-output-names", &clk_name);
1407 
1408         init.name = clk_name;
1409         init.ops = &fsgen_gate_ops;
1410         init.flags = 0;
1411         init.parent_names = &parent_clk_name;
1412         init.num_parents = 1;
1413         va->hw.init = &init;
1414         ret = devm_clk_hw_register(va->dev, &va->hw);
1415         if (ret)
1416                 return ret;
1417 
1418         return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, &va->hw);
1419 }
1420 
1421 static int va_macro_validate_dmic_sample_rate(u32 dmic_sample_rate,
1422                                               struct va_macro *va)
1423 {
1424         u32 div_factor;
1425         u32 mclk_rate = VA_MACRO_MCLK_FREQ;
1426 
1427         if (!dmic_sample_rate || mclk_rate % dmic_sample_rate != 0)
1428                 goto undefined_rate;
1429 
1430         div_factor = mclk_rate / dmic_sample_rate;
1431 
1432         switch (div_factor) {
1433         case 2:
1434                 va->dmic_clk_div = VA_MACRO_CLK_DIV_2;
1435                 break;
1436         case 3:
1437                 va->dmic_clk_div = VA_MACRO_CLK_DIV_3;
1438                 break;
1439         case 4:
1440                 va->dmic_clk_div = VA_MACRO_CLK_DIV_4;
1441                 break;
1442         case 6:
1443                 va->dmic_clk_div = VA_MACRO_CLK_DIV_6;
1444                 break;
1445         case 8:
1446                 va->dmic_clk_div = VA_MACRO_CLK_DIV_8;
1447                 break;
1448         case 16:
1449                 va->dmic_clk_div = VA_MACRO_CLK_DIV_16;
1450                 break;
1451         default:
1452                 /* Any other DIV factor is invalid */
1453                 goto undefined_rate;
1454         }
1455 
1456         return dmic_sample_rate;
1457 
1458 undefined_rate:
1459         dev_err(va->dev, "%s: Invalid rate %d, for mclk %d\n",
1460                 __func__, dmic_sample_rate, mclk_rate);
1461         dmic_sample_rate = 0;
1462 
1463         return dmic_sample_rate;
1464 }
1465 
1466 static void va_macro_set_lpass_codec_version(struct va_macro *va)
1467 {
1468         int core_id_0 = 0, core_id_1 = 0, core_id_2 = 0;
1469         int version = LPASS_CODEC_VERSION_UNKNOWN;
1470 
1471         regmap_read(va->regmap, CDC_VA_TOP_CSR_CORE_ID_0, &core_id_0);
1472         regmap_read(va->regmap, CDC_VA_TOP_CSR_CORE_ID_1, &core_id_1);
1473         regmap_read(va->regmap, CDC_VA_TOP_CSR_CORE_ID_2, &core_id_2);
1474 
1475         if ((core_id_0 == 0x01) && (core_id_1 == 0x0F))
1476                 version = LPASS_CODEC_VERSION_2_0;
1477         if ((core_id_0 == 0x02) && (core_id_1 == 0x0F) && core_id_2 == 0x01)
1478                 version = LPASS_CODEC_VERSION_2_0;
1479         if ((core_id_0 == 0x02) && (core_id_1 == 0x0E))
1480                 version = LPASS_CODEC_VERSION_2_1;
1481         if ((core_id_0 == 0x02) && (core_id_1 == 0x0F) && (core_id_2 == 0x50 || core_id_2 == 0x51))
1482                 version = LPASS_CODEC_VERSION_2_5;
1483         if ((core_id_0 == 0x02) && (core_id_1 == 0x0F) && (core_id_2 == 0x60 || core_id_2 == 0x61))
1484                 version = LPASS_CODEC_VERSION_2_6;
1485         if ((core_id_0 == 0x02) && (core_id_1 == 0x0F) && (core_id_2 == 0x70 || core_id_2 == 0x71))
1486                 version = LPASS_CODEC_VERSION_2_7;
1487         if ((core_id_0 == 0x02) && (core_id_1 == 0x0F) && (core_id_2 == 0x80 || core_id_2 == 0x81))
1488                 version = LPASS_CODEC_VERSION_2_8;
1489 
1490         if (version == LPASS_CODEC_VERSION_UNKNOWN)
1491                 dev_warn(va->dev, "Unknown Codec version, ID: %02x / %02x / %02x\n",
1492                          core_id_0, core_id_1, core_id_2);
1493 
1494         lpass_macro_set_codec_version(version);
1495 
1496         dev_dbg(va->dev, "LPASS Codec Version %s\n", lpass_macro_get_codec_version_string(version));
1497 }
1498 
1499 static int va_macro_probe(struct platform_device *pdev)
1500 {
1501         struct device *dev = &pdev->dev;
1502         const struct va_macro_data *data;
1503         struct va_macro *va;
1504         void __iomem *base;
1505         u32 sample_rate = 0;
1506         int ret;
1507 
1508         va = devm_kzalloc(dev, sizeof(*va), GFP_KERNEL);
1509         if (!va)
1510                 return -ENOMEM;
1511 
1512         va->dev = dev;
1513 
1514         va->macro = devm_clk_get_optional(dev, "macro");
1515         if (IS_ERR(va->macro))
1516                 return dev_err_probe(dev, PTR_ERR(va->macro), "unable to get macro clock\n");
1517 
1518         va->dcodec = devm_clk_get_optional(dev, "dcodec");
1519         if (IS_ERR(va->dcodec))
1520                 return dev_err_probe(dev, PTR_ERR(va->dcodec), "unable to get dcodec clock\n");
1521 
1522         va->mclk = devm_clk_get(dev, "mclk");
1523         if (IS_ERR(va->mclk))
1524                 return dev_err_probe(dev, PTR_ERR(va->mclk), "unable to get mclk clock\n");
1525 
1526         va->pds = lpass_macro_pds_init(dev);
1527         if (IS_ERR(va->pds))
1528                 return PTR_ERR(va->pds);
1529 
1530         ret = of_property_read_u32(dev->of_node, "qcom,dmic-sample-rate",
1531                                    &sample_rate);
1532         if (ret) {
1533                 dev_err(dev, "qcom,dmic-sample-rate dt entry missing\n");
1534                 va->dmic_clk_div = VA_MACRO_CLK_DIV_2;
1535         } else {
1536                 ret = va_macro_validate_dmic_sample_rate(sample_rate, va);
1537                 if (!ret) {
1538                         ret = -EINVAL;
1539                         goto err;
1540                 }
1541         }
1542 
1543         base = devm_platform_ioremap_resource(pdev, 0);
1544         if (IS_ERR(base)) {
1545                 ret = PTR_ERR(base);
1546                 goto err;
1547         }
1548 
1549         va->regmap = devm_regmap_init_mmio(dev, base,  &va_regmap_config);
1550         if (IS_ERR(va->regmap)) {
1551                 ret = -EINVAL;
1552                 goto err;
1553         }
1554 
1555         dev_set_drvdata(dev, va);
1556 
1557         data = of_device_get_match_data(dev);
1558         va->has_swr_master = data->has_swr_master;
1559         va->has_npl_clk = data->has_npl_clk;
1560 
1561         /* mclk rate */
1562         clk_set_rate(va->mclk, 2 * VA_MACRO_MCLK_FREQ);
1563 
1564         if (va->has_npl_clk) {
1565                 va->npl = devm_clk_get(dev, "npl");
1566                 if (IS_ERR(va->npl)) {
1567                         ret = PTR_ERR(va->npl);
1568                         goto err;
1569                 }
1570 
1571                 clk_set_rate(va->npl, 2 * VA_MACRO_MCLK_FREQ);
1572         }
1573 
1574         ret = clk_prepare_enable(va->macro);
1575         if (ret)
1576                 goto err;
1577 
1578         ret = clk_prepare_enable(va->dcodec);
1579         if (ret)
1580                 goto err_dcodec;
1581 
1582         ret = clk_prepare_enable(va->mclk);
1583         if (ret)
1584                 goto err_mclk;
1585 
1586         if (va->has_npl_clk) {
1587                 ret = clk_prepare_enable(va->npl);
1588                 if (ret)
1589                         goto err_npl;
1590         }
1591 
1592         /**
1593          * old version of codecs do not have a reliable way to determine the
1594          * version from registers, get them from soc specific data
1595          */
1596         if (data->version)
1597                 lpass_macro_set_codec_version(data->version);
1598         else /* read version from register */
1599                 va_macro_set_lpass_codec_version(va);
1600 
1601         if (va->has_swr_master) {
1602                 /* Set default CLK div to 1 */
1603                 regmap_update_bits(va->regmap, CDC_VA_TOP_CSR_SWR_MIC_CTL0,
1604                                   CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK,
1605                                   CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1);
1606                 regmap_update_bits(va->regmap, CDC_VA_TOP_CSR_SWR_MIC_CTL1,
1607                                   CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK,
1608                                   CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1);
1609                 regmap_update_bits(va->regmap, CDC_VA_TOP_CSR_SWR_MIC_CTL2,
1610                                   CDC_VA_SWR_MIC_CLK_SEL_0_1_MASK,
1611                                   CDC_VA_SWR_MIC_CLK_SEL_0_1_DIV1);
1612 
1613         }
1614 
1615         if (va->has_swr_master) {
1616                 regmap_update_bits(va->regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
1617                                    CDC_VA_SWR_RESET_MASK,  CDC_VA_SWR_RESET_ENABLE);
1618                 regmap_update_bits(va->regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
1619                                    CDC_VA_SWR_CLK_EN_MASK, CDC_VA_SWR_CLK_ENABLE);
1620                 regmap_update_bits(va->regmap, CDC_VA_CLK_RST_CTRL_SWR_CONTROL,
1621                                    CDC_VA_SWR_RESET_MASK, 0x0);
1622         }
1623 
1624         ret = devm_snd_soc_register_component(dev, &va_macro_component_drv,
1625                                               va_macro_dais,
1626                                               ARRAY_SIZE(va_macro_dais));
1627         if (ret)
1628                 goto err_clkout;
1629 
1630         pm_runtime_set_autosuspend_delay(dev, 3000);
1631         pm_runtime_use_autosuspend(dev);
1632         pm_runtime_mark_last_busy(dev);
1633         pm_runtime_set_active(dev);
1634         pm_runtime_enable(dev);
1635 
1636         ret = va_macro_register_fsgen_output(va);
1637         if (ret)
1638                 goto err_clkout;
1639 
1640         va->fsgen = clk_hw_get_clk(&va->hw, "fsgen");
1641         if (IS_ERR(va->fsgen)) {
1642                 ret = PTR_ERR(va->fsgen);
1643                 goto err_clkout;
1644         }
1645 
1646         return 0;
1647 
1648 err_clkout:
1649         if (va->has_npl_clk)
1650                 clk_disable_unprepare(va->npl);
1651 err_npl:
1652         clk_disable_unprepare(va->mclk);
1653 err_mclk:
1654         clk_disable_unprepare(va->dcodec);
1655 err_dcodec:
1656         clk_disable_unprepare(va->macro);
1657 err:
1658         lpass_macro_pds_exit(va->pds);
1659 
1660         return ret;
1661 }
1662 
1663 static void va_macro_remove(struct platform_device *pdev)
1664 {
1665         struct va_macro *va = dev_get_drvdata(&pdev->dev);
1666 
1667         if (va->has_npl_clk)
1668                 clk_disable_unprepare(va->npl);
1669 
1670         clk_disable_unprepare(va->mclk);
1671         clk_disable_unprepare(va->dcodec);
1672         clk_disable_unprepare(va->macro);
1673 
1674         lpass_macro_pds_exit(va->pds);
1675 }
1676 
1677 static int __maybe_unused va_macro_runtime_suspend(struct device *dev)
1678 {
1679         struct va_macro *va = dev_get_drvdata(dev);
1680 
1681         regcache_cache_only(va->regmap, true);
1682         regcache_mark_dirty(va->regmap);
1683 
1684         if (va->has_npl_clk)
1685                 clk_disable_unprepare(va->npl);
1686 
1687         clk_disable_unprepare(va->mclk);
1688 
1689         return 0;
1690 }
1691 
1692 static int __maybe_unused va_macro_runtime_resume(struct device *dev)
1693 {
1694         struct va_macro *va = dev_get_drvdata(dev);
1695         int ret;
1696 
1697         ret = clk_prepare_enable(va->mclk);
1698         if (ret) {
1699                 dev_err(va->dev, "unable to prepare mclk\n");
1700                 return ret;
1701         }
1702 
1703         if (va->has_npl_clk) {
1704                 ret = clk_prepare_enable(va->npl);
1705                 if (ret) {
1706                         clk_disable_unprepare(va->mclk);
1707                         dev_err(va->dev, "unable to prepare npl\n");
1708                         return ret;
1709                 }
1710         }
1711 
1712         regcache_cache_only(va->regmap, false);
1713         regcache_sync(va->regmap);
1714 
1715         return 0;
1716 }
1717 
1718 
1719 static const struct dev_pm_ops va_macro_pm_ops = {
1720         SET_RUNTIME_PM_OPS(va_macro_runtime_suspend, va_macro_runtime_resume, NULL)
1721 };
1722 
1723 static const struct of_device_id va_macro_dt_match[] = {
1724         { .compatible = "qcom,sc7280-lpass-va-macro", .data = &sm8250_va_data },
1725         { .compatible = "qcom,sm8250-lpass-va-macro", .data = &sm8250_va_data },
1726         { .compatible = "qcom,sm8450-lpass-va-macro", .data = &sm8450_va_data },
1727         { .compatible = "qcom,sm8550-lpass-va-macro", .data = &sm8550_va_data },
1728         { .compatible = "qcom,sc8280xp-lpass-va-macro", .data = &sm8450_va_data },
1729         {}
1730 };
1731 MODULE_DEVICE_TABLE(of, va_macro_dt_match);
1732 
1733 static struct platform_driver va_macro_driver = {
1734         .driver = {
1735                 .name = "va_macro",
1736                 .of_match_table = va_macro_dt_match,
1737                 .suppress_bind_attrs = true,
1738                 .pm = &va_macro_pm_ops,
1739         },
1740         .probe = va_macro_probe,
1741         .remove_new = va_macro_remove,
1742 };
1743 
1744 module_platform_driver(va_macro_driver);
1745 MODULE_DESCRIPTION("VA macro driver");
1746 MODULE_LICENSE("GPL");
1747 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

sflogo.php