1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (c) 2016, The Linux Foundation. All rights reserved.
4 #include <linux/module.h>
6 #include <linux/kernel.h>
7 #include <linux/delay.h>
8 #include <linux/types.h>
11 #include <linux/platform_device.h>
12 #include <linux/regmap.h>
13 #include <linux/mfd/syscon.h>
14 #include <sound/soc.h>
15 #include <sound/pcm.h>
16 #include <sound/pcm_params.h>
17 #include <sound/tlv.h>
19 #define LPASS_CDC_CLK_RX_RESET_CTL (0x000)
20 #define LPASS_CDC_CLK_TX_RESET_B1_CTL (0x004)
21 #define CLK_RX_RESET_B1_CTL_TX1_RESET_MASK BIT(0)
22 #define CLK_RX_RESET_B1_CTL_TX2_RESET_MASK BIT(1)
23 #define LPASS_CDC_CLK_DMIC_B1_CTL (0x008)
24 #define DMIC_B1_CTL_DMIC0_CLK_SEL_MASK GENMASK(3, 1)
25 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV2 (0x0 << 1)
26 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV3 (0x1 << 1)
27 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV4 (0x2 << 1)
28 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV6 (0x3 << 1)
29 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV16 (0x4 << 1)
30 #define DMIC_B1_CTL_DMIC0_CLK_EN_MASK BIT(0)
31 #define DMIC_B1_CTL_DMIC0_CLK_EN_ENABLE BIT(0)
33 #define LPASS_CDC_CLK_RX_I2S_CTL (0x00C)
34 #define RX_I2S_CTL_RX_I2S_MODE_MASK BIT(5)
35 #define RX_I2S_CTL_RX_I2S_MODE_16 BIT(5)
36 #define RX_I2S_CTL_RX_I2S_MODE_32 0
37 #define RX_I2S_CTL_RX_I2S_FS_RATE_MASK GENMASK(2, 0)
38 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_8_KHZ 0x0
39 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_16_KHZ 0x1
40 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_32_KHZ 0x2
41 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_48_KHZ 0x3
42 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_96_KHZ 0x4
43 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_192_KHZ 0x5
44 #define LPASS_CDC_CLK_TX_I2S_CTL (0x010)
45 #define TX_I2S_CTL_TX_I2S_MODE_MASK BIT(5)
46 #define TX_I2S_CTL_TX_I2S_MODE_16 BIT(5)
47 #define TX_I2S_CTL_TX_I2S_MODE_32 0
48 #define TX_I2S_CTL_TX_I2S_FS_RATE_MASK GENMASK(2, 0)
49 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_8_KHZ 0x0
50 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_16_KHZ 0x1
51 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_32_KHZ 0x2
52 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_48_KHZ 0x3
53 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_96_KHZ 0x4
54 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_192_KHZ 0x5
56 #define LPASS_CDC_CLK_OTHR_RESET_B1_CTL (0x014)
57 #define LPASS_CDC_CLK_TX_CLK_EN_B1_CTL (0x018)
58 #define LPASS_CDC_CLK_OTHR_CTL (0x01C)
59 #define LPASS_CDC_CLK_RX_B1_CTL (0x020)
60 #define LPASS_CDC_CLK_MCLK_CTL (0x024)
61 #define MCLK_CTL_MCLK_EN_MASK BIT(0)
62 #define MCLK_CTL_MCLK_EN_ENABLE BIT(0)
63 #define MCLK_CTL_MCLK_EN_DISABLE 0
64 #define LPASS_CDC_CLK_PDM_CTL (0x028)
65 #define LPASS_CDC_CLK_PDM_CTL_PDM_EN_MASK BIT(0)
66 #define LPASS_CDC_CLK_PDM_CTL_PDM_EN BIT(0)
67 #define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK BIT(1)
68 #define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_FB BIT(1)
69 #define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_PDM_CLK 0
71 #define LPASS_CDC_CLK_SD_CTL (0x02C)
72 #define LPASS_CDC_RX1_B1_CTL (0x040)
73 #define LPASS_CDC_RX2_B1_CTL (0x060)
74 #define LPASS_CDC_RX3_B1_CTL (0x080)
75 #define LPASS_CDC_RX1_B2_CTL (0x044)
76 #define LPASS_CDC_RX2_B2_CTL (0x064)
77 #define LPASS_CDC_RX3_B2_CTL (0x084)
78 #define LPASS_CDC_RX1_B3_CTL (0x048)
79 #define LPASS_CDC_RX2_B3_CTL (0x068)
80 #define LPASS_CDC_RX3_B3_CTL (0x088)
81 #define LPASS_CDC_RX1_B4_CTL (0x04C)
82 #define LPASS_CDC_RX2_B4_CTL (0x06C)
83 #define LPASS_CDC_RX3_B4_CTL (0x08C)
84 #define LPASS_CDC_RX1_B5_CTL (0x050)
85 #define LPASS_CDC_RX2_B5_CTL (0x070)
86 #define LPASS_CDC_RX3_B5_CTL (0x090)
87 #define LPASS_CDC_RX1_B6_CTL (0x054)
88 #define RXn_B6_CTL_MUTE_MASK BIT(0)
89 #define RXn_B6_CTL_MUTE_ENABLE BIT(0)
90 #define RXn_B6_CTL_MUTE_DISABLE 0
91 #define LPASS_CDC_RX2_B6_CTL (0x074)
92 #define LPASS_CDC_RX3_B6_CTL (0x094)
93 #define LPASS_CDC_RX1_VOL_CTL_B1_CTL (0x058)
94 #define LPASS_CDC_RX2_VOL_CTL_B1_CTL (0x078)
95 #define LPASS_CDC_RX3_VOL_CTL_B1_CTL (0x098)
96 #define LPASS_CDC_RX1_VOL_CTL_B2_CTL (0x05C)
97 #define LPASS_CDC_RX2_VOL_CTL_B2_CTL (0x07C)
98 #define LPASS_CDC_RX3_VOL_CTL_B2_CTL (0x09C)
99 #define LPASS_CDC_TOP_GAIN_UPDATE (0x0A0)
100 #define LPASS_CDC_TOP_CTL (0x0A4)
101 #define TOP_CTL_DIG_MCLK_FREQ_MASK BIT(0)
102 #define TOP_CTL_DIG_MCLK_FREQ_F_12_288MHZ 0
103 #define TOP_CTL_DIG_MCLK_FREQ_F_9_6MHZ BIT(0)
105 #define LPASS_CDC_DEBUG_DESER1_CTL (0x0E0)
106 #define LPASS_CDC_DEBUG_DESER2_CTL (0x0E4)
107 #define LPASS_CDC_DEBUG_B1_CTL_CFG (0x0E8)
108 #define LPASS_CDC_DEBUG_B2_CTL_CFG (0x0EC)
109 #define LPASS_CDC_DEBUG_B3_CTL_CFG (0x0F0)
110 #define LPASS_CDC_IIR1_GAIN_B1_CTL (0x100)
111 #define LPASS_CDC_IIR2_GAIN_B1_CTL (0x140)
112 #define LPASS_CDC_IIR1_GAIN_B2_CTL (0x104)
113 #define LPASS_CDC_IIR2_GAIN_B2_CTL (0x144)
114 #define LPASS_CDC_IIR1_GAIN_B3_CTL (0x108)
115 #define LPASS_CDC_IIR2_GAIN_B3_CTL (0x148)
116 #define LPASS_CDC_IIR1_GAIN_B4_CTL (0x10C)
117 #define LPASS_CDC_IIR2_GAIN_B4_CTL (0x14C)
118 #define LPASS_CDC_IIR1_GAIN_B5_CTL (0x110)
119 #define LPASS_CDC_IIR2_GAIN_B5_CTL (0x150)
120 #define LPASS_CDC_IIR1_GAIN_B6_CTL (0x114)
121 #define LPASS_CDC_IIR2_GAIN_B6_CTL (0x154)
122 #define LPASS_CDC_IIR1_GAIN_B7_CTL (0x118)
123 #define LPASS_CDC_IIR2_GAIN_B7_CTL (0x158)
124 #define LPASS_CDC_IIR1_GAIN_B8_CTL (0x11C)
125 #define LPASS_CDC_IIR2_GAIN_B8_CTL (0x15C)
126 #define LPASS_CDC_IIR1_CTL (0x120)
127 #define LPASS_CDC_IIR2_CTL (0x160)
128 #define LPASS_CDC_IIR1_GAIN_TIMER_CTL (0x124)
129 #define LPASS_CDC_IIR2_GAIN_TIMER_CTL (0x164)
130 #define LPASS_CDC_IIR1_COEF_B1_CTL (0x128)
131 #define LPASS_CDC_IIR2_COEF_B1_CTL (0x168)
132 #define LPASS_CDC_IIR1_COEF_B2_CTL (0x12C)
133 #define LPASS_CDC_IIR2_COEF_B2_CTL (0x16C)
134 #define LPASS_CDC_CONN_RX1_B1_CTL (0x180)
135 #define LPASS_CDC_CONN_RX1_B2_CTL (0x184)
136 #define LPASS_CDC_CONN_RX1_B3_CTL (0x188)
137 #define LPASS_CDC_CONN_RX2_B1_CTL (0x18C)
138 #define LPASS_CDC_CONN_RX2_B2_CTL (0x190)
139 #define LPASS_CDC_CONN_RX2_B3_CTL (0x194)
140 #define LPASS_CDC_CONN_RX3_B1_CTL (0x198)
141 #define LPASS_CDC_CONN_RX3_B2_CTL (0x19C)
142 #define LPASS_CDC_CONN_TX_B1_CTL (0x1A0)
143 #define LPASS_CDC_CONN_EQ1_B1_CTL (0x1A8)
144 #define LPASS_CDC_CONN_EQ1_B2_CTL (0x1AC)
145 #define LPASS_CDC_CONN_EQ1_B3_CTL (0x1B0)
146 #define LPASS_CDC_CONN_EQ1_B4_CTL (0x1B4)
147 #define LPASS_CDC_CONN_EQ2_B1_CTL (0x1B8)
148 #define LPASS_CDC_CONN_EQ2_B2_CTL (0x1BC)
149 #define LPASS_CDC_CONN_EQ2_B3_CTL (0x1C0)
150 #define LPASS_CDC_CONN_EQ2_B4_CTL (0x1C4)
151 #define LPASS_CDC_CONN_TX_I2S_SD1_CTL (0x1C8)
152 #define LPASS_CDC_TX1_VOL_CTL_TIMER (0x280)
153 #define LPASS_CDC_TX2_VOL_CTL_TIMER (0x2A0)
154 #define LPASS_CDC_TX1_VOL_CTL_GAIN (0x284)
155 #define LPASS_CDC_TX2_VOL_CTL_GAIN (0x2A4)
156 #define LPASS_CDC_TX1_VOL_CTL_CFG (0x288)
157 #define TX_VOL_CTL_CFG_MUTE_EN_MASK BIT(0)
158 #define TX_VOL_CTL_CFG_MUTE_EN_ENABLE BIT(0)
160 #define LPASS_CDC_TX2_VOL_CTL_CFG (0x2A8)
161 #define LPASS_CDC_TX1_MUX_CTL (0x28C)
162 #define TX_MUX_CTL_CUT_OFF_FREQ_MASK GENMASK(5, 4)
163 #define TX_MUX_CTL_CUT_OFF_FREQ_SHIFT 4
164 #define TX_MUX_CTL_CF_NEG_3DB_4HZ (0x0 << 4)
165 #define TX_MUX_CTL_CF_NEG_3DB_75HZ (0x1 << 4)
166 #define TX_MUX_CTL_CF_NEG_3DB_150HZ (0x2 << 4)
167 #define TX_MUX_CTL_HPF_BP_SEL_MASK BIT(3)
168 #define TX_MUX_CTL_HPF_BP_SEL_BYPASS BIT(3)
169 #define TX_MUX_CTL_HPF_BP_SEL_NO_BYPASS 0
171 #define LPASS_CDC_TX2_MUX_CTL (0x2AC)
172 #define LPASS_CDC_TX1_CLK_FS_CTL (0x290)
173 #define LPASS_CDC_TX2_CLK_FS_CTL (0x2B0)
174 #define LPASS_CDC_TX1_DMIC_CTL (0x294)
175 #define LPASS_CDC_TX2_DMIC_CTL (0x2B4)
176 #define TXN_DMIC_CTL_CLK_SEL_MASK GENMASK(2, 0)
177 #define TXN_DMIC_CTL_CLK_SEL_DIV2 0x0
178 #define TXN_DMIC_CTL_CLK_SEL_DIV3 0x1
179 #define TXN_DMIC_CTL_CLK_SEL_DIV4 0x2
180 #define TXN_DMIC_CTL_CLK_SEL_DIV6 0x3
181 #define TXN_DMIC_CTL_CLK_SEL_DIV16 0x4
183 #define MSM8916_WCD_DIGITAL_RATES (SNDRV_PCM_RATE_8000 | \
184 SNDRV_PCM_RATE_16000 | \
185 SNDRV_PCM_RATE_32000 | \
186 SNDRV_PCM_RATE_48000)
187 #define MSM8916_WCD_DIGITAL_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
188 SNDRV_PCM_FMTBIT_S32_LE)
190 /* Codec supports 2 IIR filters */
197 /* Codec supports 5 bands */
207 #define WCD_IIR_FILTER_SIZE (sizeof(u32)*BAND_MAX)
209 #define WCD_IIR_FILTER_CTL(xname, iidx, bidx) \
210 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
211 .info = wcd_iir_filter_info, \
212 .get = msm8x16_wcd_get_iir_band_audio_mixer, \
213 .put = msm8x16_wcd_put_iir_band_audio_mixer, \
214 .private_value = (unsigned long)&(struct wcd_iir_filter_ctl) { \
217 .bytes_ext = {.max = WCD_IIR_FILTER_SIZE, }, \
221 struct wcd_iir_filter_ctl
{
222 unsigned int iir_idx
;
223 unsigned int band_idx
;
224 struct soc_bytes_ext bytes_ext
;
227 struct msm8916_wcd_digital_priv
{
228 struct clk
*ahbclk
, *mclk
;
231 static const unsigned long rx_gain_reg
[] = {
232 LPASS_CDC_RX1_VOL_CTL_B2_CTL
,
233 LPASS_CDC_RX2_VOL_CTL_B2_CTL
,
234 LPASS_CDC_RX3_VOL_CTL_B2_CTL
,
237 static const unsigned long tx_gain_reg
[] = {
238 LPASS_CDC_TX1_VOL_CTL_GAIN
,
239 LPASS_CDC_TX2_VOL_CTL_GAIN
,
242 static const char *const rx_mix1_text
[] = {
243 "ZERO", "IIR1", "IIR2", "RX1", "RX2", "RX3"
246 static const char * const rx_mix2_text
[] = {
247 "ZERO", "IIR1", "IIR2"
250 static const char *const dec_mux_text
[] = {
251 "ZERO", "ADC1", "ADC2", "ADC3", "DMIC1", "DMIC2"
254 static const char *const cic_mux_text
[] = { "AMIC", "DMIC" };
257 static const struct soc_enum rx_mix1_inp_enum
[] = {
258 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B1_CTL
, 0, 6, rx_mix1_text
),
259 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B1_CTL
, 3, 6, rx_mix1_text
),
260 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B2_CTL
, 0, 6, rx_mix1_text
),
264 static const struct soc_enum rx2_mix1_inp_enum
[] = {
265 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL
, 0, 6, rx_mix1_text
),
266 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL
, 3, 6, rx_mix1_text
),
267 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B2_CTL
, 0, 6, rx_mix1_text
),
271 static const struct soc_enum rx3_mix1_inp_enum
[] = {
272 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL
, 0, 6, rx_mix1_text
),
273 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL
, 3, 6, rx_mix1_text
),
274 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B2_CTL
, 0, 6, rx_mix1_text
),
278 static const struct soc_enum rx_mix2_inp1_chain_enum
=
279 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B3_CTL
,
283 static const struct soc_enum rx2_mix2_inp1_chain_enum
=
284 SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B3_CTL
,
288 static const struct soc_enum dec1_mux_enum
= SOC_ENUM_SINGLE(
289 LPASS_CDC_CONN_TX_B1_CTL
, 0, 6, dec_mux_text
);
290 static const struct soc_enum dec2_mux_enum
= SOC_ENUM_SINGLE(
291 LPASS_CDC_CONN_TX_B1_CTL
, 3, 6, dec_mux_text
);
294 static const struct soc_enum cic1_mux_enum
= SOC_ENUM_SINGLE(
295 LPASS_CDC_TX1_MUX_CTL
, 0, 2, cic_mux_text
);
296 static const struct soc_enum cic2_mux_enum
= SOC_ENUM_SINGLE(
297 LPASS_CDC_TX2_MUX_CTL
, 0, 2, cic_mux_text
);
300 static const struct snd_kcontrol_new dec1_mux
= SOC_DAPM_ENUM(
301 "DEC1 MUX Mux", dec1_mux_enum
);
302 static const struct snd_kcontrol_new dec2_mux
= SOC_DAPM_ENUM(
303 "DEC2 MUX Mux", dec2_mux_enum
);
304 static const struct snd_kcontrol_new cic1_mux
= SOC_DAPM_ENUM(
305 "CIC1 MUX Mux", cic1_mux_enum
);
306 static const struct snd_kcontrol_new cic2_mux
= SOC_DAPM_ENUM(
307 "CIC2 MUX Mux", cic2_mux_enum
);
308 static const struct snd_kcontrol_new rx_mix1_inp1_mux
= SOC_DAPM_ENUM(
309 "RX1 MIX1 INP1 Mux", rx_mix1_inp_enum
[0]);
310 static const struct snd_kcontrol_new rx_mix1_inp2_mux
= SOC_DAPM_ENUM(
311 "RX1 MIX1 INP2 Mux", rx_mix1_inp_enum
[1]);
312 static const struct snd_kcontrol_new rx_mix1_inp3_mux
= SOC_DAPM_ENUM(
313 "RX1 MIX1 INP3 Mux", rx_mix1_inp_enum
[2]);
314 static const struct snd_kcontrol_new rx2_mix1_inp1_mux
= SOC_DAPM_ENUM(
315 "RX2 MIX1 INP1 Mux", rx2_mix1_inp_enum
[0]);
316 static const struct snd_kcontrol_new rx2_mix1_inp2_mux
= SOC_DAPM_ENUM(
317 "RX2 MIX1 INP2 Mux", rx2_mix1_inp_enum
[1]);
318 static const struct snd_kcontrol_new rx2_mix1_inp3_mux
= SOC_DAPM_ENUM(
319 "RX2 MIX1 INP3 Mux", rx2_mix1_inp_enum
[2]);
320 static const struct snd_kcontrol_new rx3_mix1_inp1_mux
= SOC_DAPM_ENUM(
321 "RX3 MIX1 INP1 Mux", rx3_mix1_inp_enum
[0]);
322 static const struct snd_kcontrol_new rx3_mix1_inp2_mux
= SOC_DAPM_ENUM(
323 "RX3 MIX1 INP2 Mux", rx3_mix1_inp_enum
[1]);
324 static const struct snd_kcontrol_new rx3_mix1_inp3_mux
= SOC_DAPM_ENUM(
325 "RX3 MIX1 INP3 Mux", rx3_mix1_inp_enum
[2]);
326 static const struct snd_kcontrol_new rx1_mix2_inp1_mux
= SOC_DAPM_ENUM(
327 "RX1 MIX2 INP1 Mux", rx_mix2_inp1_chain_enum
);
328 static const struct snd_kcontrol_new rx2_mix2_inp1_mux
= SOC_DAPM_ENUM(
329 "RX2 MIX2 INP1 Mux", rx2_mix2_inp1_chain_enum
);
331 /* Digital Gain control -38.4 dB to +38.4 dB in 0.3 dB steps */
332 static const DECLARE_TLV_DB_SCALE(digital_gain
, -3840, 30, 0);
334 /* Cutoff Freq for High Pass Filter at -3dB */
335 static const char * const hpf_cutoff_text
[] = {
336 "4Hz", "75Hz", "150Hz",
339 static SOC_ENUM_SINGLE_DECL(tx1_hpf_cutoff_enum
, LPASS_CDC_TX1_MUX_CTL
, 4,
341 static SOC_ENUM_SINGLE_DECL(tx2_hpf_cutoff_enum
, LPASS_CDC_TX2_MUX_CTL
, 4,
344 /* cut off for dc blocker inside rx chain */
345 static const char * const dc_blocker_cutoff_text
[] = {
346 "4Hz", "75Hz", "150Hz",
349 static SOC_ENUM_SINGLE_DECL(rx1_dcb_cutoff_enum
, LPASS_CDC_RX1_B4_CTL
, 0,
350 dc_blocker_cutoff_text
);
351 static SOC_ENUM_SINGLE_DECL(rx2_dcb_cutoff_enum
, LPASS_CDC_RX2_B4_CTL
, 0,
352 dc_blocker_cutoff_text
);
353 static SOC_ENUM_SINGLE_DECL(rx3_dcb_cutoff_enum
, LPASS_CDC_RX3_B4_CTL
, 0,
354 dc_blocker_cutoff_text
);
356 static int msm8x16_wcd_codec_set_iir_gain(struct snd_soc_dapm_widget
*w
,
357 struct snd_kcontrol
*kcontrol
, int event
)
359 struct snd_soc_component
*component
=
360 snd_soc_dapm_to_component(w
->dapm
);
361 int value
= 0, reg
= 0;
364 case SND_SOC_DAPM_POST_PMU
:
366 reg
= LPASS_CDC_IIR1_GAIN_B1_CTL
;
367 else if (w
->shift
== 1)
368 reg
= LPASS_CDC_IIR2_GAIN_B1_CTL
;
369 value
= snd_soc_component_read32(component
, reg
);
370 snd_soc_component_write(component
, reg
, value
);
378 static uint32_t get_iir_band_coeff(struct snd_soc_component
*component
,
379 int iir_idx
, int band_idx
,
384 /* Address does not automatically update if reading */
385 snd_soc_component_write(component
,
386 (LPASS_CDC_IIR1_COEF_B1_CTL
+ 64 * iir_idx
),
387 ((band_idx
* BAND_MAX
+ coeff_idx
)
388 * sizeof(uint32_t)) & 0x7F);
390 value
|= snd_soc_component_read32(component
,
391 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
));
393 snd_soc_component_write(component
,
394 (LPASS_CDC_IIR1_COEF_B1_CTL
+ 64 * iir_idx
),
395 ((band_idx
* BAND_MAX
+ coeff_idx
)
396 * sizeof(uint32_t) + 1) & 0x7F);
398 value
|= (snd_soc_component_read32(component
,
399 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
)) << 8);
401 snd_soc_component_write(component
,
402 (LPASS_CDC_IIR1_COEF_B1_CTL
+ 64 * iir_idx
),
403 ((band_idx
* BAND_MAX
+ coeff_idx
)
404 * sizeof(uint32_t) + 2) & 0x7F);
406 value
|= (snd_soc_component_read32(component
,
407 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
)) << 16);
409 snd_soc_component_write(component
,
410 (LPASS_CDC_IIR1_COEF_B1_CTL
+ 64 * iir_idx
),
411 ((band_idx
* BAND_MAX
+ coeff_idx
)
412 * sizeof(uint32_t) + 3) & 0x7F);
414 /* Mask bits top 2 bits since they are reserved */
415 value
|= ((snd_soc_component_read32(component
,
416 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
)) & 0x3f) << 24);
421 static int msm8x16_wcd_get_iir_band_audio_mixer(
422 struct snd_kcontrol
*kcontrol
,
423 struct snd_ctl_elem_value
*ucontrol
)
426 struct snd_soc_component
*component
=
427 snd_soc_kcontrol_component(kcontrol
);
428 struct wcd_iir_filter_ctl
*ctl
=
429 (struct wcd_iir_filter_ctl
*)kcontrol
->private_value
;
430 struct soc_bytes_ext
*params
= &ctl
->bytes_ext
;
431 int iir_idx
= ctl
->iir_idx
;
432 int band_idx
= ctl
->band_idx
;
435 coeff
[0] = get_iir_band_coeff(component
, iir_idx
, band_idx
, 0);
436 coeff
[1] = get_iir_band_coeff(component
, iir_idx
, band_idx
, 1);
437 coeff
[2] = get_iir_band_coeff(component
, iir_idx
, band_idx
, 2);
438 coeff
[3] = get_iir_band_coeff(component
, iir_idx
, band_idx
, 3);
439 coeff
[4] = get_iir_band_coeff(component
, iir_idx
, band_idx
, 4);
441 memcpy(ucontrol
->value
.bytes
.data
, &coeff
[0], params
->max
);
446 static void set_iir_band_coeff(struct snd_soc_component
*component
,
447 int iir_idx
, int band_idx
,
450 snd_soc_component_write(component
,
451 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
),
454 snd_soc_component_write(component
,
455 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
),
456 (value
>> 8) & 0xFF);
458 snd_soc_component_write(component
,
459 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
),
460 (value
>> 16) & 0xFF);
462 /* Mask top 2 bits, 7-8 are reserved */
463 snd_soc_component_write(component
,
464 (LPASS_CDC_IIR1_COEF_B2_CTL
+ 64 * iir_idx
),
465 (value
>> 24) & 0x3F);
468 static int msm8x16_wcd_put_iir_band_audio_mixer(
469 struct snd_kcontrol
*kcontrol
,
470 struct snd_ctl_elem_value
*ucontrol
)
472 struct snd_soc_component
*component
=
473 snd_soc_kcontrol_component(kcontrol
);
474 struct wcd_iir_filter_ctl
*ctl
=
475 (struct wcd_iir_filter_ctl
*)kcontrol
->private_value
;
476 struct soc_bytes_ext
*params
= &ctl
->bytes_ext
;
477 int iir_idx
= ctl
->iir_idx
;
478 int band_idx
= ctl
->band_idx
;
481 memcpy(&coeff
[0], ucontrol
->value
.bytes
.data
, params
->max
);
483 /* Mask top bit it is reserved */
484 /* Updates addr automatically for each B2 write */
485 snd_soc_component_write(component
,
486 (LPASS_CDC_IIR1_COEF_B1_CTL
+ 64 * iir_idx
),
487 (band_idx
* BAND_MAX
* sizeof(uint32_t)) & 0x7F);
489 set_iir_band_coeff(component
, iir_idx
, band_idx
, coeff
[0]);
490 set_iir_band_coeff(component
, iir_idx
, band_idx
, coeff
[1]);
491 set_iir_band_coeff(component
, iir_idx
, band_idx
, coeff
[2]);
492 set_iir_band_coeff(component
, iir_idx
, band_idx
, coeff
[3]);
493 set_iir_band_coeff(component
, iir_idx
, band_idx
, coeff
[4]);
498 static int wcd_iir_filter_info(struct snd_kcontrol
*kcontrol
,
499 struct snd_ctl_elem_info
*ucontrol
)
501 struct wcd_iir_filter_ctl
*ctl
=
502 (struct wcd_iir_filter_ctl
*)kcontrol
->private_value
;
503 struct soc_bytes_ext
*params
= &ctl
->bytes_ext
;
505 ucontrol
->type
= SNDRV_CTL_ELEM_TYPE_BYTES
;
506 ucontrol
->count
= params
->max
;
511 static const struct snd_kcontrol_new msm8916_wcd_digital_snd_controls
[] = {
512 SOC_SINGLE_S8_TLV("RX1 Digital Volume", LPASS_CDC_RX1_VOL_CTL_B2_CTL
,
513 -128, 127, digital_gain
),
514 SOC_SINGLE_S8_TLV("RX2 Digital Volume", LPASS_CDC_RX2_VOL_CTL_B2_CTL
,
515 -128, 127, digital_gain
),
516 SOC_SINGLE_S8_TLV("RX3 Digital Volume", LPASS_CDC_RX3_VOL_CTL_B2_CTL
,
517 -128, 127, digital_gain
),
518 SOC_SINGLE_S8_TLV("TX1 Digital Volume", LPASS_CDC_TX1_VOL_CTL_GAIN
,
519 -128, 127, digital_gain
),
520 SOC_SINGLE_S8_TLV("TX2 Digital Volume", LPASS_CDC_TX2_VOL_CTL_GAIN
,
521 -128, 127, digital_gain
),
522 SOC_ENUM("TX1 HPF Cutoff", tx1_hpf_cutoff_enum
),
523 SOC_ENUM("TX2 HPF Cutoff", tx2_hpf_cutoff_enum
),
524 SOC_SINGLE("TX1 HPF Switch", LPASS_CDC_TX1_MUX_CTL
, 3, 1, 0),
525 SOC_SINGLE("TX2 HPF Switch", LPASS_CDC_TX2_MUX_CTL
, 3, 1, 0),
526 SOC_ENUM("RX1 DCB Cutoff", rx1_dcb_cutoff_enum
),
527 SOC_ENUM("RX2 DCB Cutoff", rx2_dcb_cutoff_enum
),
528 SOC_ENUM("RX3 DCB Cutoff", rx3_dcb_cutoff_enum
),
529 SOC_SINGLE("RX1 DCB Switch", LPASS_CDC_RX1_B5_CTL
, 2, 1, 0),
530 SOC_SINGLE("RX2 DCB Switch", LPASS_CDC_RX2_B5_CTL
, 2, 1, 0),
531 SOC_SINGLE("RX3 DCB Switch", LPASS_CDC_RX3_B5_CTL
, 2, 1, 0),
532 SOC_SINGLE("RX1 Mute Switch", LPASS_CDC_RX1_B6_CTL
, 0, 1, 0),
533 SOC_SINGLE("RX2 Mute Switch", LPASS_CDC_RX2_B6_CTL
, 0, 1, 0),
534 SOC_SINGLE("RX3 Mute Switch", LPASS_CDC_RX3_B6_CTL
, 0, 1, 0),
536 SOC_SINGLE("IIR1 Band1 Switch", LPASS_CDC_IIR1_CTL
, 0, 1, 0),
537 SOC_SINGLE("IIR1 Band2 Switch", LPASS_CDC_IIR1_CTL
, 1, 1, 0),
538 SOC_SINGLE("IIR1 Band3 Switch", LPASS_CDC_IIR1_CTL
, 2, 1, 0),
539 SOC_SINGLE("IIR1 Band4 Switch", LPASS_CDC_IIR1_CTL
, 3, 1, 0),
540 SOC_SINGLE("IIR1 Band5 Switch", LPASS_CDC_IIR1_CTL
, 4, 1, 0),
541 SOC_SINGLE("IIR2 Band1 Switch", LPASS_CDC_IIR2_CTL
, 0, 1, 0),
542 SOC_SINGLE("IIR2 Band2 Switch", LPASS_CDC_IIR2_CTL
, 1, 1, 0),
543 SOC_SINGLE("IIR2 Band3 Switch", LPASS_CDC_IIR2_CTL
, 2, 1, 0),
544 SOC_SINGLE("IIR2 Band4 Switch", LPASS_CDC_IIR2_CTL
, 3, 1, 0),
545 SOC_SINGLE("IIR2 Band5 Switch", LPASS_CDC_IIR2_CTL
, 4, 1, 0),
546 WCD_IIR_FILTER_CTL("IIR1 Band1", IIR1
, BAND1
),
547 WCD_IIR_FILTER_CTL("IIR1 Band2", IIR1
, BAND2
),
548 WCD_IIR_FILTER_CTL("IIR1 Band3", IIR1
, BAND3
),
549 WCD_IIR_FILTER_CTL("IIR1 Band4", IIR1
, BAND4
),
550 WCD_IIR_FILTER_CTL("IIR1 Band5", IIR1
, BAND5
),
551 WCD_IIR_FILTER_CTL("IIR2 Band1", IIR2
, BAND1
),
552 WCD_IIR_FILTER_CTL("IIR2 Band2", IIR2
, BAND2
),
553 WCD_IIR_FILTER_CTL("IIR2 Band3", IIR2
, BAND3
),
554 WCD_IIR_FILTER_CTL("IIR2 Band4", IIR2
, BAND4
),
555 WCD_IIR_FILTER_CTL("IIR2 Band5", IIR2
, BAND5
),
556 SOC_SINGLE_SX_TLV("IIR1 INP1 Volume", LPASS_CDC_IIR1_GAIN_B1_CTL
,
557 0, -84, 40, digital_gain
),
558 SOC_SINGLE_SX_TLV("IIR1 INP2 Volume", LPASS_CDC_IIR1_GAIN_B2_CTL
,
559 0, -84, 40, digital_gain
),
560 SOC_SINGLE_SX_TLV("IIR1 INP3 Volume", LPASS_CDC_IIR1_GAIN_B3_CTL
,
561 0, -84, 40, digital_gain
),
562 SOC_SINGLE_SX_TLV("IIR1 INP4 Volume", LPASS_CDC_IIR1_GAIN_B4_CTL
,
563 0, -84, 40, digital_gain
),
564 SOC_SINGLE_SX_TLV("IIR2 INP1 Volume", LPASS_CDC_IIR2_GAIN_B1_CTL
,
565 0, -84, 40, digital_gain
),
566 SOC_SINGLE_SX_TLV("IIR2 INP2 Volume", LPASS_CDC_IIR2_GAIN_B2_CTL
,
567 0, -84, 40, digital_gain
),
568 SOC_SINGLE_SX_TLV("IIR2 INP3 Volume", LPASS_CDC_IIR2_GAIN_B3_CTL
,
569 0, -84, 40, digital_gain
),
570 SOC_SINGLE_SX_TLV("IIR2 INP4 Volume", LPASS_CDC_IIR2_GAIN_B4_CTL
,
571 0, -84, 40, digital_gain
),
575 static int msm8916_wcd_digital_enable_interpolator(
576 struct snd_soc_dapm_widget
*w
,
577 struct snd_kcontrol
*kcontrol
,
580 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
583 case SND_SOC_DAPM_POST_PMU
:
584 /* apply the digital gain after the interpolator is enabled */
585 usleep_range(10000, 10100);
586 snd_soc_component_write(component
, rx_gain_reg
[w
->shift
],
587 snd_soc_component_read32(component
, rx_gain_reg
[w
->shift
]));
589 case SND_SOC_DAPM_POST_PMD
:
590 snd_soc_component_update_bits(component
, LPASS_CDC_CLK_RX_RESET_CTL
,
591 1 << w
->shift
, 1 << w
->shift
);
592 snd_soc_component_update_bits(component
, LPASS_CDC_CLK_RX_RESET_CTL
,
599 static int msm8916_wcd_digital_enable_dec(struct snd_soc_dapm_widget
*w
,
600 struct snd_kcontrol
*kcontrol
,
603 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
604 unsigned int decimator
= w
->shift
+ 1;
605 u16 dec_reset_reg
, tx_vol_ctl_reg
, tx_mux_ctl_reg
;
606 u8 dec_hpf_cut_of_freq
;
608 dec_reset_reg
= LPASS_CDC_CLK_TX_RESET_B1_CTL
;
609 tx_vol_ctl_reg
= LPASS_CDC_TX1_VOL_CTL_CFG
+ 32 * (decimator
- 1);
610 tx_mux_ctl_reg
= LPASS_CDC_TX1_MUX_CTL
+ 32 * (decimator
- 1);
613 case SND_SOC_DAPM_PRE_PMU
:
614 /* Enable TX digital mute */
615 snd_soc_component_update_bits(component
, tx_vol_ctl_reg
,
616 TX_VOL_CTL_CFG_MUTE_EN_MASK
,
617 TX_VOL_CTL_CFG_MUTE_EN_ENABLE
);
618 dec_hpf_cut_of_freq
= snd_soc_component_read32(component
, tx_mux_ctl_reg
) &
619 TX_MUX_CTL_CUT_OFF_FREQ_MASK
;
620 dec_hpf_cut_of_freq
>>= TX_MUX_CTL_CUT_OFF_FREQ_SHIFT
;
621 if (dec_hpf_cut_of_freq
!= TX_MUX_CTL_CF_NEG_3DB_150HZ
) {
622 /* set cut of freq to CF_MIN_3DB_150HZ (0x1) */
623 snd_soc_component_update_bits(component
, tx_mux_ctl_reg
,
624 TX_MUX_CTL_CUT_OFF_FREQ_MASK
,
625 TX_MUX_CTL_CF_NEG_3DB_150HZ
);
628 case SND_SOC_DAPM_POST_PMU
:
630 snd_soc_component_update_bits(component
, tx_mux_ctl_reg
,
631 TX_MUX_CTL_HPF_BP_SEL_MASK
,
632 TX_MUX_CTL_HPF_BP_SEL_NO_BYPASS
);
633 /* apply the digital gain after the decimator is enabled */
634 snd_soc_component_write(component
, tx_gain_reg
[w
->shift
],
635 snd_soc_component_read32(component
, tx_gain_reg
[w
->shift
]));
636 snd_soc_component_update_bits(component
, tx_vol_ctl_reg
,
637 TX_VOL_CTL_CFG_MUTE_EN_MASK
, 0);
639 case SND_SOC_DAPM_PRE_PMD
:
640 snd_soc_component_update_bits(component
, tx_vol_ctl_reg
,
641 TX_VOL_CTL_CFG_MUTE_EN_MASK
,
642 TX_VOL_CTL_CFG_MUTE_EN_ENABLE
);
643 snd_soc_component_update_bits(component
, tx_mux_ctl_reg
,
644 TX_MUX_CTL_HPF_BP_SEL_MASK
,
645 TX_MUX_CTL_HPF_BP_SEL_BYPASS
);
647 case SND_SOC_DAPM_POST_PMD
:
648 snd_soc_component_update_bits(component
, dec_reset_reg
, 1 << w
->shift
,
650 snd_soc_component_update_bits(component
, dec_reset_reg
, 1 << w
->shift
, 0x0);
651 snd_soc_component_update_bits(component
, tx_mux_ctl_reg
,
652 TX_MUX_CTL_HPF_BP_SEL_MASK
,
653 TX_MUX_CTL_HPF_BP_SEL_BYPASS
);
654 snd_soc_component_update_bits(component
, tx_vol_ctl_reg
,
655 TX_VOL_CTL_CFG_MUTE_EN_MASK
, 0);
662 static int msm8916_wcd_digital_enable_dmic(struct snd_soc_dapm_widget
*w
,
663 struct snd_kcontrol
*kcontrol
,
666 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
669 /* get dmic number out of widget name */
670 char *dmic_num
= strpbrk(w
->name
, "12");
672 if (dmic_num
== NULL
) {
673 dev_err(component
->dev
, "Invalid DMIC\n");
676 ret
= kstrtouint(dmic_num
, 10, &dmic
);
677 if (ret
< 0 || dmic
> 2) {
678 dev_err(component
->dev
, "Invalid DMIC line on the component\n");
683 case SND_SOC_DAPM_PRE_PMU
:
684 snd_soc_component_update_bits(component
, LPASS_CDC_CLK_DMIC_B1_CTL
,
685 DMIC_B1_CTL_DMIC0_CLK_SEL_MASK
,
686 DMIC_B1_CTL_DMIC0_CLK_SEL_DIV3
);
689 snd_soc_component_update_bits(component
, LPASS_CDC_TX1_DMIC_CTL
,
690 TXN_DMIC_CTL_CLK_SEL_MASK
,
691 TXN_DMIC_CTL_CLK_SEL_DIV3
);
694 snd_soc_component_update_bits(component
, LPASS_CDC_TX2_DMIC_CTL
,
695 TXN_DMIC_CTL_CLK_SEL_MASK
,
696 TXN_DMIC_CTL_CLK_SEL_DIV3
);
705 static const char * const iir_inp1_text
[] = {
706 "ZERO", "DEC1", "DEC2", "RX1", "RX2", "RX3"
709 static const struct soc_enum iir1_inp1_mux_enum
=
710 SOC_ENUM_SINGLE(LPASS_CDC_CONN_EQ1_B1_CTL
,
711 0, 6, iir_inp1_text
);
713 static const struct soc_enum iir2_inp1_mux_enum
=
714 SOC_ENUM_SINGLE(LPASS_CDC_CONN_EQ2_B1_CTL
,
715 0, 6, iir_inp1_text
);
717 static const struct snd_kcontrol_new iir1_inp1_mux
=
718 SOC_DAPM_ENUM("IIR1 INP1 Mux", iir1_inp1_mux_enum
);
720 static const struct snd_kcontrol_new iir2_inp1_mux
=
721 SOC_DAPM_ENUM("IIR2 INP1 Mux", iir2_inp1_mux_enum
);
723 static const struct snd_soc_dapm_widget msm8916_wcd_digital_dapm_widgets
[] = {
725 SND_SOC_DAPM_AIF_IN("I2S RX1", NULL
, 0, SND_SOC_NOPM
, 0, 0),
726 SND_SOC_DAPM_AIF_IN("I2S RX2", NULL
, 0, SND_SOC_NOPM
, 0, 0),
727 SND_SOC_DAPM_AIF_IN("I2S RX3", NULL
, 0, SND_SOC_NOPM
, 0, 0),
729 SND_SOC_DAPM_OUTPUT("PDM_RX1"),
730 SND_SOC_DAPM_OUTPUT("PDM_RX2"),
731 SND_SOC_DAPM_OUTPUT("PDM_RX3"),
733 SND_SOC_DAPM_INPUT("LPASS_PDM_TX"),
735 SND_SOC_DAPM_MIXER("RX1 MIX1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
736 SND_SOC_DAPM_MIXER("RX2 MIX1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
737 SND_SOC_DAPM_MIXER("RX3 MIX1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
740 SND_SOC_DAPM_MIXER_E("RX1 INT", LPASS_CDC_CLK_RX_B1_CTL
, 0, 0, NULL
,
741 0, msm8916_wcd_digital_enable_interpolator
,
742 SND_SOC_DAPM_POST_PMU
| SND_SOC_DAPM_POST_PMD
),
743 SND_SOC_DAPM_MIXER_E("RX2 INT", LPASS_CDC_CLK_RX_B1_CTL
, 1, 0, NULL
,
744 0, msm8916_wcd_digital_enable_interpolator
,
745 SND_SOC_DAPM_POST_PMU
| SND_SOC_DAPM_POST_PMD
),
746 SND_SOC_DAPM_MIXER_E("RX3 INT", LPASS_CDC_CLK_RX_B1_CTL
, 2, 0, NULL
,
747 0, msm8916_wcd_digital_enable_interpolator
,
748 SND_SOC_DAPM_POST_PMU
| SND_SOC_DAPM_POST_PMD
),
749 SND_SOC_DAPM_MUX("RX1 MIX1 INP1", SND_SOC_NOPM
, 0, 0,
751 SND_SOC_DAPM_MUX("RX1 MIX1 INP2", SND_SOC_NOPM
, 0, 0,
753 SND_SOC_DAPM_MUX("RX1 MIX1 INP3", SND_SOC_NOPM
, 0, 0,
755 SND_SOC_DAPM_MUX("RX2 MIX1 INP1", SND_SOC_NOPM
, 0, 0,
757 SND_SOC_DAPM_MUX("RX2 MIX1 INP2", SND_SOC_NOPM
, 0, 0,
759 SND_SOC_DAPM_MUX("RX2 MIX1 INP3", SND_SOC_NOPM
, 0, 0,
761 SND_SOC_DAPM_MUX("RX3 MIX1 INP1", SND_SOC_NOPM
, 0, 0,
763 SND_SOC_DAPM_MUX("RX3 MIX1 INP2", SND_SOC_NOPM
, 0, 0,
765 SND_SOC_DAPM_MUX("RX3 MIX1 INP3", SND_SOC_NOPM
, 0, 0,
767 SND_SOC_DAPM_MUX("RX1 MIX2 INP1", SND_SOC_NOPM
, 0, 0,
769 SND_SOC_DAPM_MUX("RX2 MIX2 INP1", SND_SOC_NOPM
, 0, 0,
772 SND_SOC_DAPM_MUX("CIC1 MUX", SND_SOC_NOPM
, 0, 0, &cic1_mux
),
773 SND_SOC_DAPM_MUX("CIC2 MUX", SND_SOC_NOPM
, 0, 0, &cic2_mux
),
775 SND_SOC_DAPM_MIXER("ADC1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
776 SND_SOC_DAPM_MIXER("ADC2", SND_SOC_NOPM
, 0, 0, NULL
, 0),
777 SND_SOC_DAPM_MIXER("ADC3", SND_SOC_NOPM
, 0, 0, NULL
, 0),
779 SND_SOC_DAPM_MUX_E("DEC1 MUX", LPASS_CDC_CLK_TX_CLK_EN_B1_CTL
, 0, 0,
780 &dec1_mux
, msm8916_wcd_digital_enable_dec
,
781 SND_SOC_DAPM_PRE_PMU
| SND_SOC_DAPM_POST_PMU
|
782 SND_SOC_DAPM_PRE_PMD
| SND_SOC_DAPM_POST_PMD
),
783 SND_SOC_DAPM_MUX_E("DEC2 MUX", LPASS_CDC_CLK_TX_CLK_EN_B1_CTL
, 1, 0,
784 &dec2_mux
, msm8916_wcd_digital_enable_dec
,
785 SND_SOC_DAPM_PRE_PMU
| SND_SOC_DAPM_POST_PMU
|
786 SND_SOC_DAPM_PRE_PMD
| SND_SOC_DAPM_POST_PMD
),
787 SND_SOC_DAPM_AIF_OUT("I2S TX1", NULL
, 0, SND_SOC_NOPM
, 0, 0),
788 SND_SOC_DAPM_AIF_OUT("I2S TX2", NULL
, 0, SND_SOC_NOPM
, 0, 0),
789 SND_SOC_DAPM_AIF_OUT("I2S TX3", NULL
, 0, SND_SOC_NOPM
, 0, 0),
791 /* Digital Mic Inputs */
792 SND_SOC_DAPM_ADC_E("DMIC1", NULL
, SND_SOC_NOPM
, 0, 0,
793 msm8916_wcd_digital_enable_dmic
,
794 SND_SOC_DAPM_PRE_PMU
| SND_SOC_DAPM_POST_PMD
),
795 SND_SOC_DAPM_ADC_E("DMIC2", NULL
, SND_SOC_NOPM
, 0, 0,
796 msm8916_wcd_digital_enable_dmic
,
797 SND_SOC_DAPM_PRE_PMU
| SND_SOC_DAPM_POST_PMD
),
798 SND_SOC_DAPM_SUPPLY("DMIC_CLK", LPASS_CDC_CLK_DMIC_B1_CTL
, 0, 0,
800 SND_SOC_DAPM_SUPPLY("RX_I2S_CLK", LPASS_CDC_CLK_RX_I2S_CTL
,
802 SND_SOC_DAPM_SUPPLY("TX_I2S_CLK", LPASS_CDC_CLK_TX_I2S_CTL
, 4, 0,
805 SND_SOC_DAPM_SUPPLY("MCLK", SND_SOC_NOPM
, 0, 0, NULL
, 0),
806 SND_SOC_DAPM_SUPPLY("PDM_CLK", LPASS_CDC_CLK_PDM_CTL
, 0, 0, NULL
, 0),
807 /* Connectivity Clock */
808 SND_SOC_DAPM_SUPPLY_S("CDC_CONN", -2, LPASS_CDC_CLK_OTHR_CTL
, 2, 0,
810 SND_SOC_DAPM_MIC("Digital Mic1", NULL
),
811 SND_SOC_DAPM_MIC("Digital Mic2", NULL
),
814 SND_SOC_DAPM_MUX("IIR1 INP1 MUX", SND_SOC_NOPM
, 0, 0, &iir1_inp1_mux
),
815 SND_SOC_DAPM_PGA_E("IIR1", LPASS_CDC_CLK_SD_CTL
, 0, 0, NULL
, 0,
816 msm8x16_wcd_codec_set_iir_gain
, SND_SOC_DAPM_POST_PMU
),
818 SND_SOC_DAPM_MUX("IIR2 INP1 MUX", SND_SOC_NOPM
, 0, 0, &iir2_inp1_mux
),
819 SND_SOC_DAPM_PGA_E("IIR2", LPASS_CDC_CLK_SD_CTL
, 1, 0, NULL
, 0,
820 msm8x16_wcd_codec_set_iir_gain
, SND_SOC_DAPM_POST_PMU
),
824 static int msm8916_wcd_digital_get_clks(struct platform_device
*pdev
,
825 struct msm8916_wcd_digital_priv
*priv
)
827 struct device
*dev
= &pdev
->dev
;
829 priv
->ahbclk
= devm_clk_get(dev
, "ahbix-clk");
830 if (IS_ERR(priv
->ahbclk
)) {
831 dev_err(dev
, "failed to get ahbix clk\n");
832 return PTR_ERR(priv
->ahbclk
);
835 priv
->mclk
= devm_clk_get(dev
, "mclk");
836 if (IS_ERR(priv
->mclk
)) {
837 dev_err(dev
, "failed to get mclk\n");
838 return PTR_ERR(priv
->mclk
);
844 static int msm8916_wcd_digital_component_probe(struct snd_soc_component
*component
)
846 struct msm8916_wcd_digital_priv
*priv
= dev_get_drvdata(component
->dev
);
848 snd_soc_component_set_drvdata(component
, priv
);
853 static int msm8916_wcd_digital_component_set_sysclk(struct snd_soc_component
*component
,
854 int clk_id
, int source
,
855 unsigned int freq
, int dir
)
857 struct msm8916_wcd_digital_priv
*p
= dev_get_drvdata(component
->dev
);
859 return clk_set_rate(p
->mclk
, freq
);
862 static int msm8916_wcd_digital_hw_params(struct snd_pcm_substream
*substream
,
863 struct snd_pcm_hw_params
*params
,
864 struct snd_soc_dai
*dai
)
869 switch (params_rate(params
)) {
871 tx_fs_rate
= TX_I2S_CTL_TX_I2S_FS_RATE_F_8_KHZ
;
872 rx_fs_rate
= RX_I2S_CTL_RX_I2S_FS_RATE_F_8_KHZ
;
875 tx_fs_rate
= TX_I2S_CTL_TX_I2S_FS_RATE_F_16_KHZ
;
876 rx_fs_rate
= RX_I2S_CTL_RX_I2S_FS_RATE_F_16_KHZ
;
879 tx_fs_rate
= TX_I2S_CTL_TX_I2S_FS_RATE_F_32_KHZ
;
880 rx_fs_rate
= RX_I2S_CTL_RX_I2S_FS_RATE_F_32_KHZ
;
883 tx_fs_rate
= TX_I2S_CTL_TX_I2S_FS_RATE_F_48_KHZ
;
884 rx_fs_rate
= RX_I2S_CTL_RX_I2S_FS_RATE_F_48_KHZ
;
887 dev_err(dai
->component
->dev
, "Invalid sampling rate %d\n",
888 params_rate(params
));
892 switch (substream
->stream
) {
893 case SNDRV_PCM_STREAM_CAPTURE
:
894 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_TX_I2S_CTL
,
895 TX_I2S_CTL_TX_I2S_FS_RATE_MASK
, tx_fs_rate
);
897 case SNDRV_PCM_STREAM_PLAYBACK
:
898 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_RX_I2S_CTL
,
899 RX_I2S_CTL_RX_I2S_FS_RATE_MASK
, rx_fs_rate
);
905 switch (params_format(params
)) {
906 case SNDRV_PCM_FORMAT_S16_LE
:
907 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_TX_I2S_CTL
,
908 TX_I2S_CTL_TX_I2S_MODE_MASK
,
909 TX_I2S_CTL_TX_I2S_MODE_16
);
910 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_RX_I2S_CTL
,
911 RX_I2S_CTL_RX_I2S_MODE_MASK
,
912 RX_I2S_CTL_RX_I2S_MODE_16
);
915 case SNDRV_PCM_FORMAT_S32_LE
:
916 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_TX_I2S_CTL
,
917 TX_I2S_CTL_TX_I2S_MODE_MASK
,
918 TX_I2S_CTL_TX_I2S_MODE_32
);
919 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_RX_I2S_CTL
,
920 RX_I2S_CTL_RX_I2S_MODE_MASK
,
921 RX_I2S_CTL_RX_I2S_MODE_32
);
924 dev_err(dai
->dev
, "%s: wrong format selected\n", __func__
);
931 static const struct snd_soc_dapm_route msm8916_wcd_digital_audio_map
[] = {
933 {"I2S RX1", NULL
, "AIF1 Playback"},
934 {"I2S RX2", NULL
, "AIF1 Playback"},
935 {"I2S RX3", NULL
, "AIF1 Playback"},
937 {"AIF1 Capture", NULL
, "I2S TX1"},
938 {"AIF1 Capture", NULL
, "I2S TX2"},
939 {"AIF1 Capture", NULL
, "I2S TX3"},
941 {"CIC1 MUX", "DMIC", "DEC1 MUX"},
942 {"CIC1 MUX", "AMIC", "DEC1 MUX"},
943 {"CIC2 MUX", "DMIC", "DEC2 MUX"},
944 {"CIC2 MUX", "AMIC", "DEC2 MUX"},
946 /* Decimator Inputs */
947 {"DEC1 MUX", "DMIC1", "DMIC1"},
948 {"DEC1 MUX", "DMIC2", "DMIC2"},
949 {"DEC1 MUX", "ADC1", "ADC1"},
950 {"DEC1 MUX", "ADC2", "ADC2"},
951 {"DEC1 MUX", "ADC3", "ADC3"},
952 {"DEC1 MUX", NULL
, "CDC_CONN"},
954 {"DEC2 MUX", "DMIC1", "DMIC1"},
955 {"DEC2 MUX", "DMIC2", "DMIC2"},
956 {"DEC2 MUX", "ADC1", "ADC1"},
957 {"DEC2 MUX", "ADC2", "ADC2"},
958 {"DEC2 MUX", "ADC3", "ADC3"},
959 {"DEC2 MUX", NULL
, "CDC_CONN"},
961 {"DMIC1", NULL
, "DMIC_CLK"},
962 {"DMIC2", NULL
, "DMIC_CLK"},
964 {"I2S TX1", NULL
, "CIC1 MUX"},
965 {"I2S TX2", NULL
, "CIC2 MUX"},
967 {"I2S TX1", NULL
, "TX_I2S_CLK"},
968 {"I2S TX2", NULL
, "TX_I2S_CLK"},
970 {"TX_I2S_CLK", NULL
, "MCLK"},
971 {"TX_I2S_CLK", NULL
, "PDM_CLK"},
973 {"ADC1", NULL
, "LPASS_PDM_TX"},
974 {"ADC2", NULL
, "LPASS_PDM_TX"},
975 {"ADC3", NULL
, "LPASS_PDM_TX"},
977 {"I2S RX1", NULL
, "RX_I2S_CLK"},
978 {"I2S RX2", NULL
, "RX_I2S_CLK"},
979 {"I2S RX3", NULL
, "RX_I2S_CLK"},
981 {"RX_I2S_CLK", NULL
, "PDM_CLK"},
982 {"RX_I2S_CLK", NULL
, "MCLK"},
983 {"RX_I2S_CLK", NULL
, "CDC_CONN"},
986 {"PDM_RX1", NULL
, "RX1 INT"},
987 {"RX1 INT", NULL
, "RX1 MIX1"},
989 {"RX1 MIX1", NULL
, "RX1 MIX1 INP1"},
990 {"RX1 MIX1", NULL
, "RX1 MIX1 INP2"},
991 {"RX1 MIX1", NULL
, "RX1 MIX1 INP3"},
993 {"RX1 MIX1 INP1", "RX1", "I2S RX1"},
994 {"RX1 MIX1 INP1", "RX2", "I2S RX2"},
995 {"RX1 MIX1 INP1", "RX3", "I2S RX3"},
996 {"RX1 MIX1 INP1", "IIR1", "IIR1"},
997 {"RX1 MIX1 INP1", "IIR2", "IIR2"},
999 {"RX1 MIX1 INP2", "RX1", "I2S RX1"},
1000 {"RX1 MIX1 INP2", "RX2", "I2S RX2"},
1001 {"RX1 MIX1 INP2", "RX3", "I2S RX3"},
1002 {"RX1 MIX1 INP2", "IIR1", "IIR1"},
1003 {"RX1 MIX1 INP2", "IIR2", "IIR2"},
1005 {"RX1 MIX1 INP3", "RX1", "I2S RX1"},
1006 {"RX1 MIX1 INP3", "RX2", "I2S RX2"},
1007 {"RX1 MIX1 INP3", "RX3", "I2S RX3"},
1010 {"PDM_RX2", NULL
, "RX2 INT"},
1011 {"RX2 INT", NULL
, "RX2 MIX1"},
1013 {"RX2 MIX1", NULL
, "RX2 MIX1 INP1"},
1014 {"RX2 MIX1", NULL
, "RX2 MIX1 INP2"},
1015 {"RX2 MIX1", NULL
, "RX2 MIX1 INP3"},
1017 {"RX2 MIX1 INP1", "RX1", "I2S RX1"},
1018 {"RX2 MIX1 INP1", "RX2", "I2S RX2"},
1019 {"RX2 MIX1 INP1", "RX3", "I2S RX3"},
1020 {"RX2 MIX1 INP1", "IIR1", "IIR1"},
1021 {"RX2 MIX1 INP1", "IIR2", "IIR2"},
1023 {"RX2 MIX1 INP2", "RX1", "I2S RX1"},
1024 {"RX2 MIX1 INP2", "RX2", "I2S RX2"},
1025 {"RX2 MIX1 INP2", "RX3", "I2S RX3"},
1026 {"RX2 MIX1 INP1", "IIR1", "IIR1"},
1027 {"RX2 MIX1 INP1", "IIR2", "IIR2"},
1029 {"RX2 MIX1 INP3", "RX1", "I2S RX1"},
1030 {"RX2 MIX1 INP3", "RX2", "I2S RX2"},
1031 {"RX2 MIX1 INP3", "RX3", "I2S RX3"},
1034 {"PDM_RX3", NULL
, "RX3 INT"},
1035 {"RX3 INT", NULL
, "RX3 MIX1"},
1037 {"RX3 MIX1", NULL
, "RX3 MIX1 INP1"},
1038 {"RX3 MIX1", NULL
, "RX3 MIX1 INP2"},
1039 {"RX3 MIX1", NULL
, "RX3 MIX1 INP3"},
1041 {"RX3 MIX1 INP1", "RX1", "I2S RX1"},
1042 {"RX3 MIX1 INP1", "RX2", "I2S RX2"},
1043 {"RX3 MIX1 INP1", "RX3", "I2S RX3"},
1044 {"RX3 MIX1 INP1", "IIR1", "IIR1"},
1045 {"RX3 MIX1 INP1", "IIR2", "IIR2"},
1047 {"RX3 MIX1 INP2", "RX1", "I2S RX1"},
1048 {"RX3 MIX1 INP2", "RX2", "I2S RX2"},
1049 {"RX3 MIX1 INP2", "RX3", "I2S RX3"},
1050 {"RX3 MIX1 INP2", "IIR1", "IIR1"},
1051 {"RX3 MIX1 INP2", "IIR2", "IIR2"},
1053 {"RX1 MIX2 INP1", "IIR1", "IIR1"},
1054 {"RX2 MIX2 INP1", "IIR1", "IIR1"},
1055 {"RX1 MIX2 INP1", "IIR2", "IIR2"},
1056 {"RX2 MIX2 INP1", "IIR2", "IIR2"},
1058 {"IIR1", NULL
, "IIR1 INP1 MUX"},
1059 {"IIR1 INP1 MUX", "DEC1", "DEC1 MUX"},
1060 {"IIR1 INP1 MUX", "DEC2", "DEC2 MUX"},
1062 {"IIR2", NULL
, "IIR2 INP1 MUX"},
1063 {"IIR2 INP1 MUX", "DEC1", "DEC1 MUX"},
1064 {"IIR2 INP1 MUX", "DEC2", "DEC2 MUX"},
1066 {"RX3 MIX1 INP3", "RX1", "I2S RX1"},
1067 {"RX3 MIX1 INP3", "RX2", "I2S RX2"},
1068 {"RX3 MIX1 INP3", "RX3", "I2S RX3"},
1072 static int msm8916_wcd_digital_startup(struct snd_pcm_substream
*substream
,
1073 struct snd_soc_dai
*dai
)
1075 struct snd_soc_component
*component
= dai
->component
;
1076 struct msm8916_wcd_digital_priv
*msm8916_wcd
;
1077 unsigned long mclk_rate
;
1079 msm8916_wcd
= snd_soc_component_get_drvdata(component
);
1080 snd_soc_component_update_bits(component
, LPASS_CDC_CLK_MCLK_CTL
,
1081 MCLK_CTL_MCLK_EN_MASK
,
1082 MCLK_CTL_MCLK_EN_ENABLE
);
1083 snd_soc_component_update_bits(component
, LPASS_CDC_CLK_PDM_CTL
,
1084 LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK
,
1085 LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_FB
);
1087 mclk_rate
= clk_get_rate(msm8916_wcd
->mclk
);
1088 switch (mclk_rate
) {
1090 snd_soc_component_update_bits(component
, LPASS_CDC_TOP_CTL
,
1091 TOP_CTL_DIG_MCLK_FREQ_MASK
,
1092 TOP_CTL_DIG_MCLK_FREQ_F_12_288MHZ
);
1095 snd_soc_component_update_bits(component
, LPASS_CDC_TOP_CTL
,
1096 TOP_CTL_DIG_MCLK_FREQ_MASK
,
1097 TOP_CTL_DIG_MCLK_FREQ_F_9_6MHZ
);
1100 dev_err(component
->dev
, "Invalid mclk rate %ld\n", mclk_rate
);
1106 static void msm8916_wcd_digital_shutdown(struct snd_pcm_substream
*substream
,
1107 struct snd_soc_dai
*dai
)
1109 snd_soc_component_update_bits(dai
->component
, LPASS_CDC_CLK_PDM_CTL
,
1110 LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK
, 0);
1113 static const struct snd_soc_dai_ops msm8916_wcd_digital_dai_ops
= {
1114 .startup
= msm8916_wcd_digital_startup
,
1115 .shutdown
= msm8916_wcd_digital_shutdown
,
1116 .hw_params
= msm8916_wcd_digital_hw_params
,
1119 static struct snd_soc_dai_driver msm8916_wcd_digital_dai
[] = {
1121 .name
= "msm8916_wcd_digital_i2s_rx1",
1124 .stream_name
= "AIF1 Playback",
1125 .rates
= MSM8916_WCD_DIGITAL_RATES
,
1126 .formats
= MSM8916_WCD_DIGITAL_FORMATS
,
1130 .ops
= &msm8916_wcd_digital_dai_ops
,
1133 .name
= "msm8916_wcd_digital_i2s_tx1",
1136 .stream_name
= "AIF1 Capture",
1137 .rates
= MSM8916_WCD_DIGITAL_RATES
,
1138 .formats
= MSM8916_WCD_DIGITAL_FORMATS
,
1142 .ops
= &msm8916_wcd_digital_dai_ops
,
1146 static const struct snd_soc_component_driver msm8916_wcd_digital
= {
1147 .probe
= msm8916_wcd_digital_component_probe
,
1148 .set_sysclk
= msm8916_wcd_digital_component_set_sysclk
,
1149 .controls
= msm8916_wcd_digital_snd_controls
,
1150 .num_controls
= ARRAY_SIZE(msm8916_wcd_digital_snd_controls
),
1151 .dapm_widgets
= msm8916_wcd_digital_dapm_widgets
,
1152 .num_dapm_widgets
= ARRAY_SIZE(msm8916_wcd_digital_dapm_widgets
),
1153 .dapm_routes
= msm8916_wcd_digital_audio_map
,
1154 .num_dapm_routes
= ARRAY_SIZE(msm8916_wcd_digital_audio_map
),
1156 .use_pmdown_time
= 1,
1158 .non_legacy_dai_naming
= 1,
1161 static const struct regmap_config msm8916_codec_regmap_config
= {
1165 .max_register
= LPASS_CDC_TX2_DMIC_CTL
,
1166 .cache_type
= REGCACHE_FLAT
,
1169 static int msm8916_wcd_digital_probe(struct platform_device
*pdev
)
1171 struct msm8916_wcd_digital_priv
*priv
;
1172 struct device
*dev
= &pdev
->dev
;
1174 struct regmap
*digital_map
;
1177 priv
= devm_kzalloc(dev
, sizeof(*priv
), GFP_KERNEL
);
1181 base
= devm_platform_ioremap_resource(pdev
, 0);
1183 return PTR_ERR(base
);
1186 devm_regmap_init_mmio(&pdev
->dev
, base
,
1187 &msm8916_codec_regmap_config
);
1188 if (IS_ERR(digital_map
))
1189 return PTR_ERR(digital_map
);
1191 ret
= msm8916_wcd_digital_get_clks(pdev
, priv
);
1195 ret
= clk_prepare_enable(priv
->ahbclk
);
1197 dev_err(dev
, "failed to enable ahbclk %d\n", ret
);
1201 ret
= clk_prepare_enable(priv
->mclk
);
1203 dev_err(dev
, "failed to enable mclk %d\n", ret
);
1207 dev_set_drvdata(dev
, priv
);
1209 return devm_snd_soc_register_component(dev
, &msm8916_wcd_digital
,
1210 msm8916_wcd_digital_dai
,
1211 ARRAY_SIZE(msm8916_wcd_digital_dai
));
1214 static int msm8916_wcd_digital_remove(struct platform_device
*pdev
)
1216 struct msm8916_wcd_digital_priv
*priv
= dev_get_drvdata(&pdev
->dev
);
1218 clk_disable_unprepare(priv
->mclk
);
1219 clk_disable_unprepare(priv
->ahbclk
);
1224 static const struct of_device_id msm8916_wcd_digital_match_table
[] = {
1225 { .compatible
= "qcom,msm8916-wcd-digital-codec" },
1229 MODULE_DEVICE_TABLE(of
, msm8916_wcd_digital_match_table
);
1231 static struct platform_driver msm8916_wcd_digital_driver
= {
1233 .name
= "msm8916-wcd-digital-codec",
1234 .of_match_table
= msm8916_wcd_digital_match_table
,
1236 .probe
= msm8916_wcd_digital_probe
,
1237 .remove
= msm8916_wcd_digital_remove
,
1240 module_platform_driver(msm8916_wcd_digital_driver
);
1242 MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");
1243 MODULE_DESCRIPTION("MSM8916 WCD Digital Codec driver");
1244 MODULE_LICENSE("GPL v2");