Linux Audio

Check our new training course

Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0
   2// Copyright (c) 2016, The Linux Foundation. All rights reserved.
 
 
 
 
 
 
 
 
 
   3
   4#include <linux/module.h>
   5#include <linux/err.h>
   6#include <linux/kernel.h>
   7#include <linux/delay.h>
   8#include <linux/types.h>
   9#include <linux/clk.h>
  10#include <linux/of.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>
  18
  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)
  32
  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
  55
  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
  70
  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)
 104
 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)
 159
 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
 170
 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
 182
 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)
 189
 190/* Codec supports 2 IIR filters */
 191enum {
 192	IIR1 = 0,
 193	IIR2,
 194	IIR_MAX,
 195};
 196
 197/* Codec supports 5 bands */
 198enum {
 199	BAND1 = 0,
 200	BAND2,
 201	BAND3,
 202	BAND4,
 203	BAND5,
 204	BAND_MAX,
 205};
 206
 207#define WCD_IIR_FILTER_SIZE	(sizeof(u32)*BAND_MAX)
 208
 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) { \
 215		.iir_idx = iidx, \
 216		.band_idx = bidx, \
 217		.bytes_ext = {.max = WCD_IIR_FILTER_SIZE, }, \
 218	} \
 219}
 220
 221struct wcd_iir_filter_ctl {
 222	unsigned int iir_idx;
 223	unsigned int band_idx;
 224	struct soc_bytes_ext bytes_ext;
 225};
 226
 227struct msm8916_wcd_digital_priv {
 228	struct clk *ahbclk, *mclk;
 229};
 230
 231static 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,
 235};
 236
 237static const unsigned long tx_gain_reg[] = {
 238	LPASS_CDC_TX1_VOL_CTL_GAIN,
 239	LPASS_CDC_TX2_VOL_CTL_GAIN,
 240};
 241
 242static const char *const rx_mix1_text[] = {
 243	"ZERO", "IIR1", "IIR2", "RX1", "RX2", "RX3"
 244};
 245
 246static const char * const rx_mix2_text[] = {
 247	"ZERO", "IIR1", "IIR2"
 248};
 249
 250static const char *const dec_mux_text[] = {
 251	"ZERO", "ADC1", "ADC2", "ADC3", "DMIC1", "DMIC2"
 252};
 253
 254static const char *const cic_mux_text[] = { "AMIC", "DMIC" };
 255
 256/* RX1 MIX1 */
 257static 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),
 261};
 262
 
 
 
 
 263/* RX2 MIX1 */
 264static 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),
 268};
 269
 
 
 
 
 270/* RX3 MIX1 */
 271static 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),
 275};
 276
 277/* RX1 MIX2 */
 278static const struct soc_enum rx_mix2_inp1_chain_enum =
 279	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B3_CTL,
 280		0, 3, rx_mix2_text);
 281
 282/* RX2 MIX2 */
 283static const struct soc_enum rx2_mix2_inp1_chain_enum =
 284	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B3_CTL,
 285		0, 3, rx_mix2_text);
 286
 287/* DEC */
 288static const struct soc_enum dec1_mux_enum = SOC_ENUM_SINGLE(
 289				LPASS_CDC_CONN_TX_B1_CTL, 0, 6, dec_mux_text);
 290static const struct soc_enum dec2_mux_enum = SOC_ENUM_SINGLE(
 291				LPASS_CDC_CONN_TX_B1_CTL, 3, 6, dec_mux_text);
 292
 293/* CIC */
 294static const struct soc_enum cic1_mux_enum = SOC_ENUM_SINGLE(
 295				LPASS_CDC_TX1_MUX_CTL, 0, 2, cic_mux_text);
 296static const struct soc_enum cic2_mux_enum = SOC_ENUM_SINGLE(
 297				LPASS_CDC_TX2_MUX_CTL, 0, 2, cic_mux_text);
 298
 299/* RDAC2 MUX */
 300static const struct snd_kcontrol_new dec1_mux = SOC_DAPM_ENUM(
 301				"DEC1 MUX Mux", dec1_mux_enum);
 302static const struct snd_kcontrol_new dec2_mux = SOC_DAPM_ENUM(
 303				"DEC2 MUX Mux",	dec2_mux_enum);
 304static const struct snd_kcontrol_new cic1_mux = SOC_DAPM_ENUM(
 305				"CIC1 MUX Mux", cic1_mux_enum);
 306static const struct snd_kcontrol_new cic2_mux = SOC_DAPM_ENUM(
 307				"CIC2 MUX Mux",	cic2_mux_enum);
 308static const struct snd_kcontrol_new rx_mix1_inp1_mux = SOC_DAPM_ENUM(
 309				"RX1 MIX1 INP1 Mux", rx_mix1_inp_enum[0]);
 310static const struct snd_kcontrol_new rx_mix1_inp2_mux = SOC_DAPM_ENUM(
 311				"RX1 MIX1 INP2 Mux", rx_mix1_inp_enum[1]);
 312static const struct snd_kcontrol_new rx_mix1_inp3_mux = SOC_DAPM_ENUM(
 313				"RX1 MIX1 INP3 Mux", rx_mix1_inp_enum[2]);
 314static const struct snd_kcontrol_new rx2_mix1_inp1_mux = SOC_DAPM_ENUM(
 315				"RX2 MIX1 INP1 Mux", rx2_mix1_inp_enum[0]);
 316static const struct snd_kcontrol_new rx2_mix1_inp2_mux = SOC_DAPM_ENUM(
 317				"RX2 MIX1 INP2 Mux", rx2_mix1_inp_enum[1]);
 318static const struct snd_kcontrol_new rx2_mix1_inp3_mux = SOC_DAPM_ENUM(
 319				"RX2 MIX1 INP3 Mux", rx2_mix1_inp_enum[2]);
 320static const struct snd_kcontrol_new rx3_mix1_inp1_mux = SOC_DAPM_ENUM(
 321				"RX3 MIX1 INP1 Mux", rx3_mix1_inp_enum[0]);
 322static const struct snd_kcontrol_new rx3_mix1_inp2_mux = SOC_DAPM_ENUM(
 323				"RX3 MIX1 INP2 Mux", rx3_mix1_inp_enum[1]);
 324static const struct snd_kcontrol_new rx3_mix1_inp3_mux = SOC_DAPM_ENUM(
 325				"RX3 MIX1 INP3 Mux", rx3_mix1_inp_enum[2]);
 326static const struct snd_kcontrol_new rx1_mix2_inp1_mux = SOC_DAPM_ENUM(
 327				"RX1 MIX2 INP1 Mux", rx_mix2_inp1_chain_enum);
 328static const struct snd_kcontrol_new rx2_mix2_inp1_mux = SOC_DAPM_ENUM(
 329				"RX2 MIX2 INP1 Mux", rx2_mix2_inp1_chain_enum);
 330
 331/* Digital Gain control -84 dB to +40 dB in 1 dB steps */
 332static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400);
 333
 334/* Cutoff Freq for High Pass Filter at -3dB */
 335static const char * const hpf_cutoff_text[] = {
 336	"4Hz", "75Hz", "150Hz",
 337};
 338
 339static SOC_ENUM_SINGLE_DECL(tx1_hpf_cutoff_enum, LPASS_CDC_TX1_MUX_CTL, 4,
 340			    hpf_cutoff_text);
 341static SOC_ENUM_SINGLE_DECL(tx2_hpf_cutoff_enum, LPASS_CDC_TX2_MUX_CTL, 4,
 342			    hpf_cutoff_text);
 343
 344/* cut off for dc blocker inside rx chain */
 345static const char * const dc_blocker_cutoff_text[] = {
 346	"4Hz", "75Hz", "150Hz",
 347};
 348
 349static SOC_ENUM_SINGLE_DECL(rx1_dcb_cutoff_enum, LPASS_CDC_RX1_B4_CTL, 0,
 350			    dc_blocker_cutoff_text);
 351static SOC_ENUM_SINGLE_DECL(rx2_dcb_cutoff_enum, LPASS_CDC_RX2_B4_CTL, 0,
 352			    dc_blocker_cutoff_text);
 353static SOC_ENUM_SINGLE_DECL(rx3_dcb_cutoff_enum, LPASS_CDC_RX3_B4_CTL, 0,
 354			    dc_blocker_cutoff_text);
 355
 356static int msm8x16_wcd_codec_set_iir_gain(struct snd_soc_dapm_widget *w,
 357		struct snd_kcontrol *kcontrol, int event)
 358{
 359	struct snd_soc_component *component =
 360			snd_soc_dapm_to_component(w->dapm);
 361	int value = 0, reg = 0;
 362
 363	switch (event) {
 364	case SND_SOC_DAPM_POST_PMU:
 365		if (w->shift == 0)
 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_read(component, reg);
 370		snd_soc_component_write(component, reg, value);
 371		break;
 372	default:
 373		break;
 374	}
 375	return 0;
 376}
 377
 378static uint32_t get_iir_band_coeff(struct snd_soc_component *component,
 379				   int iir_idx, int band_idx,
 380				   int coeff_idx)
 381{
 382	uint32_t value = 0;
 383
 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);
 389
 390	value |= snd_soc_component_read(component,
 391		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx));
 392
 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);
 397
 398	value |= (snd_soc_component_read(component,
 399		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx)) << 8);
 400
 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);
 405
 406	value |= (snd_soc_component_read(component,
 407		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx)) << 16);
 408
 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);
 413
 414	/* Mask bits top 2 bits since they are reserved */
 415	value |= ((snd_soc_component_read(component,
 416		 (LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx)) & 0x3f) << 24);
 417	return value;
 418
 419}
 420
 421static int msm8x16_wcd_get_iir_band_audio_mixer(
 422					struct snd_kcontrol *kcontrol,
 423					struct snd_ctl_elem_value *ucontrol)
 424{
 425
 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;
 433	u32 coeff[BAND_MAX];
 434
 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);
 440
 441	memcpy(ucontrol->value.bytes.data, &coeff[0], params->max);
 442
 443	return 0;
 444}
 445
 446static void set_iir_band_coeff(struct snd_soc_component *component,
 447				int iir_idx, int band_idx,
 448				uint32_t value)
 449{
 450	snd_soc_component_write(component,
 451		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
 452		(value & 0xFF));
 453
 454	snd_soc_component_write(component,
 455		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
 456		(value >> 8) & 0xFF);
 457
 458	snd_soc_component_write(component,
 459		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
 460		(value >> 16) & 0xFF);
 461
 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);
 466}
 467
 468static int msm8x16_wcd_put_iir_band_audio_mixer(
 469					struct snd_kcontrol *kcontrol,
 470					struct snd_ctl_elem_value *ucontrol)
 471{
 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;
 479	u32 coeff[BAND_MAX];
 480
 481	memcpy(&coeff[0], ucontrol->value.bytes.data, params->max);
 482
 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);
 488
 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]);
 494
 495	return 0;
 496}
 497
 498static int wcd_iir_filter_info(struct snd_kcontrol *kcontrol,
 499				struct snd_ctl_elem_info *ucontrol)
 500{
 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;
 504
 505	ucontrol->type = SNDRV_CTL_ELEM_TYPE_BYTES;
 506	ucontrol->count = params->max;
 507
 508	return 0;
 509}
 510
 511static 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			-84, 40, digital_gain),
 514	SOC_SINGLE_S8_TLV("RX2 Digital Volume", LPASS_CDC_RX2_VOL_CTL_B2_CTL,
 515			-84, 40, digital_gain),
 516	SOC_SINGLE_S8_TLV("RX3 Digital Volume", LPASS_CDC_RX3_VOL_CTL_B2_CTL,
 517			-84, 40, digital_gain),
 518	SOC_SINGLE_S8_TLV("TX1 Digital Volume", LPASS_CDC_TX1_VOL_CTL_GAIN,
 519			-84, 40, digital_gain),
 520	SOC_SINGLE_S8_TLV("TX2 Digital Volume", LPASS_CDC_TX2_VOL_CTL_GAIN,
 521			-84, 40, 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),
 535
 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_S8_TLV("IIR1 INP1 Volume", LPASS_CDC_IIR1_GAIN_B1_CTL,
 557			-84, 40, digital_gain),
 558	SOC_SINGLE_S8_TLV("IIR1 INP2 Volume", LPASS_CDC_IIR1_GAIN_B2_CTL,
 559			-84, 40, digital_gain),
 560	SOC_SINGLE_S8_TLV("IIR1 INP3 Volume", LPASS_CDC_IIR1_GAIN_B3_CTL,
 561			-84, 40, digital_gain),
 562	SOC_SINGLE_S8_TLV("IIR1 INP4 Volume", LPASS_CDC_IIR1_GAIN_B4_CTL,
 563			-84, 40, digital_gain),
 564	SOC_SINGLE_S8_TLV("IIR2 INP1 Volume", LPASS_CDC_IIR2_GAIN_B1_CTL,
 565			-84, 40, digital_gain),
 566	SOC_SINGLE_S8_TLV("IIR2 INP2 Volume", LPASS_CDC_IIR2_GAIN_B2_CTL,
 567			-84, 40, digital_gain),
 568	SOC_SINGLE_S8_TLV("IIR2 INP3 Volume", LPASS_CDC_IIR2_GAIN_B3_CTL,
 569			-84, 40, digital_gain),
 570	SOC_SINGLE_S8_TLV("IIR2 INP4 Volume", LPASS_CDC_IIR2_GAIN_B4_CTL,
 571			-84, 40, digital_gain),
 572
 573};
 574
 575static int msm8916_wcd_digital_enable_interpolator(
 576						struct snd_soc_dapm_widget *w,
 577						struct snd_kcontrol *kcontrol,
 578						int event)
 579{
 580	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 581
 582	switch (event) {
 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_read(component, rx_gain_reg[w->shift]));
 588		break;
 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,
 593					      1 << w->shift, 0x0);
 594		break;
 595	}
 596	return 0;
 597}
 598
 599static int msm8916_wcd_digital_enable_dec(struct snd_soc_dapm_widget *w,
 600					  struct snd_kcontrol *kcontrol,
 601					  int event)
 602{
 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;
 607
 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);
 611
 612	switch (event) {
 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_read(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);
 626		}
 627		break;
 628	case SND_SOC_DAPM_POST_PMU:
 629		/* enable HPF */
 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_read(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);
 638		break;
 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);
 646		break;
 647	case SND_SOC_DAPM_POST_PMD:
 648		snd_soc_component_update_bits(component, dec_reset_reg, 1 << w->shift,
 649				    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);
 656		break;
 657	}
 658
 659	return 0;
 660}
 661
 662static int msm8916_wcd_digital_enable_dmic(struct snd_soc_dapm_widget *w,
 663					   struct snd_kcontrol *kcontrol,
 664					   int event)
 665{
 666	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 667	unsigned int dmic;
 668	int ret;
 669	/* get dmic number out of widget name */
 670	char *dmic_num = strpbrk(w->name, "12");
 671
 672	if (dmic_num == NULL) {
 673		dev_err(component->dev, "Invalid DMIC\n");
 674		return -EINVAL;
 675	}
 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");
 679		return -EINVAL;
 680	}
 681
 682	switch (event) {
 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);
 687		switch (dmic) {
 688		case 1:
 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);
 692			break;
 693		case 2:
 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);
 697			break;
 698		}
 699		break;
 700	}
 701
 702	return 0;
 703}
 704
 705static const char * const iir_inp1_text[] = {
 706	"ZERO", "DEC1", "DEC2", "RX1", "RX2", "RX3"
 707};
 708
 709static const struct soc_enum iir1_inp1_mux_enum =
 710	SOC_ENUM_SINGLE(LPASS_CDC_CONN_EQ1_B1_CTL,
 711		0, 6, iir_inp1_text);
 712
 713static const struct soc_enum iir2_inp1_mux_enum =
 714	SOC_ENUM_SINGLE(LPASS_CDC_CONN_EQ2_B1_CTL,
 715		0, 6, iir_inp1_text);
 716
 717static const struct snd_kcontrol_new iir1_inp1_mux =
 718	SOC_DAPM_ENUM("IIR1 INP1 Mux", iir1_inp1_mux_enum);
 719
 720static const struct snd_kcontrol_new iir2_inp1_mux =
 721	SOC_DAPM_ENUM("IIR2 INP1 Mux", iir2_inp1_mux_enum);
 722
 723static const struct snd_soc_dapm_widget msm8916_wcd_digital_dapm_widgets[] = {
 724	/*RX stuff */
 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),
 728
 729	SND_SOC_DAPM_OUTPUT("PDM_RX1"),
 730	SND_SOC_DAPM_OUTPUT("PDM_RX2"),
 731	SND_SOC_DAPM_OUTPUT("PDM_RX3"),
 732
 733	SND_SOC_DAPM_INPUT("LPASS_PDM_TX"),
 734
 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),
 738
 739	/* Interpolator */
 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,
 750			 &rx_mix1_inp1_mux),
 751	SND_SOC_DAPM_MUX("RX1 MIX1 INP2", SND_SOC_NOPM, 0, 0,
 752			 &rx_mix1_inp2_mux),
 753	SND_SOC_DAPM_MUX("RX1 MIX1 INP3", SND_SOC_NOPM, 0, 0,
 754			 &rx_mix1_inp3_mux),
 755	SND_SOC_DAPM_MUX("RX2 MIX1 INP1", SND_SOC_NOPM, 0, 0,
 756			 &rx2_mix1_inp1_mux),
 757	SND_SOC_DAPM_MUX("RX2 MIX1 INP2", SND_SOC_NOPM, 0, 0,
 758			 &rx2_mix1_inp2_mux),
 759	SND_SOC_DAPM_MUX("RX2 MIX1 INP3", SND_SOC_NOPM, 0, 0,
 760			 &rx2_mix1_inp3_mux),
 761	SND_SOC_DAPM_MUX("RX3 MIX1 INP1", SND_SOC_NOPM, 0, 0,
 762			 &rx3_mix1_inp1_mux),
 763	SND_SOC_DAPM_MUX("RX3 MIX1 INP2", SND_SOC_NOPM, 0, 0,
 764			 &rx3_mix1_inp2_mux),
 765	SND_SOC_DAPM_MUX("RX3 MIX1 INP3", SND_SOC_NOPM, 0, 0,
 766			 &rx3_mix1_inp3_mux),
 767	SND_SOC_DAPM_MUX("RX1 MIX2 INP1", SND_SOC_NOPM, 0, 0,
 768			 &rx1_mix2_inp1_mux),
 769	SND_SOC_DAPM_MUX("RX2 MIX2 INP1", SND_SOC_NOPM, 0, 0,
 770			 &rx2_mix2_inp1_mux),
 771
 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),
 774	/* TX */
 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),
 778
 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),
 790
 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,
 799			    NULL, 0),
 800	SND_SOC_DAPM_SUPPLY("RX_I2S_CLK", LPASS_CDC_CLK_RX_I2S_CTL,
 801			    4, 0, NULL, 0),
 802	SND_SOC_DAPM_SUPPLY("TX_I2S_CLK", LPASS_CDC_CLK_TX_I2S_CTL, 4, 0,
 803			    NULL, 0),
 804
 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,
 809			      NULL, 0),
 810	SND_SOC_DAPM_MIC("Digital Mic1", NULL),
 811	SND_SOC_DAPM_MIC("Digital Mic2", NULL),
 812
 813	/* Sidetone */
 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),
 817
 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),
 821
 822};
 823
 824static int msm8916_wcd_digital_get_clks(struct platform_device *pdev,
 825					struct msm8916_wcd_digital_priv	*priv)
 826{
 827	struct device *dev = &pdev->dev;
 828
 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);
 833	}
 834
 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);
 839	}
 840
 841	return 0;
 842}
 843
 844static int msm8916_wcd_digital_component_probe(struct snd_soc_component *component)
 845{
 846	struct msm8916_wcd_digital_priv *priv = dev_get_drvdata(component->dev);
 847
 848	snd_soc_component_set_drvdata(component, priv);
 849
 850	return 0;
 851}
 852
 853static int msm8916_wcd_digital_component_set_sysclk(struct snd_soc_component *component,
 854						int clk_id, int source,
 855						unsigned int freq, int dir)
 856{
 857	struct msm8916_wcd_digital_priv *p = dev_get_drvdata(component->dev);
 858
 859	return clk_set_rate(p->mclk, freq);
 860}
 861
 862static int msm8916_wcd_digital_hw_params(struct snd_pcm_substream *substream,
 863					 struct snd_pcm_hw_params *params,
 864					 struct snd_soc_dai *dai)
 865{
 866	u8 tx_fs_rate;
 867	u8 rx_fs_rate;
 868
 869	switch (params_rate(params)) {
 870	case 8000:
 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;
 873		break;
 874	case 16000:
 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;
 877		break;
 878	case 32000:
 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;
 881		break;
 882	case 48000:
 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;
 885		break;
 886	default:
 887		dev_err(dai->component->dev, "Invalid sampling rate %d\n",
 888			params_rate(params));
 889		return -EINVAL;
 890	}
 891
 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);
 896		break;
 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);
 900		break;
 901	default:
 902		return -EINVAL;
 903	}
 904
 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);
 913		break;
 914
 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);
 922		break;
 923	default:
 924		dev_err(dai->dev, "%s: wrong format selected\n", __func__);
 925		return -EINVAL;
 926	}
 927
 928	return 0;
 929}
 930
 931static const struct snd_soc_dapm_route msm8916_wcd_digital_audio_map[] = {
 932
 933	{"I2S RX1",  NULL, "AIF1 Playback"},
 934	{"I2S RX2",  NULL, "AIF1 Playback"},
 935	{"I2S RX3",  NULL, "AIF1 Playback"},
 936
 937	{"AIF1 Capture", NULL, "I2S TX1"},
 938	{"AIF1 Capture", NULL, "I2S TX2"},
 939	{"AIF1 Capture", NULL, "I2S TX3"},
 940
 941	{"CIC1 MUX", "DMIC", "DEC1 MUX"},
 942	{"CIC1 MUX", "AMIC", "DEC1 MUX"},
 943	{"CIC2 MUX", "DMIC", "DEC2 MUX"},
 944	{"CIC2 MUX", "AMIC", "DEC2 MUX"},
 945
 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"},
 953
 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"},
 960
 961	{"DMIC1", NULL, "DMIC_CLK"},
 962	{"DMIC2", NULL, "DMIC_CLK"},
 963
 964	{"I2S TX1", NULL, "CIC1 MUX"},
 965	{"I2S TX2", NULL, "CIC2 MUX"},
 966
 967	{"I2S TX1", NULL, "TX_I2S_CLK"},
 968	{"I2S TX2", NULL, "TX_I2S_CLK"},
 969
 970	{"TX_I2S_CLK", NULL, "MCLK"},
 971	{"TX_I2S_CLK", NULL, "PDM_CLK"},
 972
 973	{"ADC1", NULL, "LPASS_PDM_TX"},
 974	{"ADC2", NULL, "LPASS_PDM_TX"},
 975	{"ADC3", NULL, "LPASS_PDM_TX"},
 976
 977	{"I2S RX1", NULL, "RX_I2S_CLK"},
 978	{"I2S RX2", NULL, "RX_I2S_CLK"},
 979	{"I2S RX3", NULL, "RX_I2S_CLK"},
 980
 981	{"RX_I2S_CLK", NULL, "PDM_CLK"},
 982	{"RX_I2S_CLK", NULL, "MCLK"},
 983	{"RX_I2S_CLK", NULL, "CDC_CONN"},
 984
 985	/* RX1 PATH.. */
 986	{"PDM_RX1", NULL, "RX1 INT"},
 987	{"RX1 INT", NULL, "RX1 MIX1"},
 988
 989	{"RX1 MIX1", NULL, "RX1 MIX1 INP1"},
 990	{"RX1 MIX1", NULL, "RX1 MIX1 INP2"},
 991	{"RX1 MIX1", NULL, "RX1 MIX1 INP3"},
 992
 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"},
 998
 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"},
1004
1005	{"RX1 MIX1 INP3", "RX1", "I2S RX1"},
1006	{"RX1 MIX1 INP3", "RX2", "I2S RX2"},
1007	{"RX1 MIX1 INP3", "RX3", "I2S RX3"},
1008
1009	/* RX2 PATH */
1010	{"PDM_RX2", NULL, "RX2 INT"},
1011	{"RX2 INT", NULL, "RX2 MIX1"},
1012
1013	{"RX2 MIX1", NULL, "RX2 MIX1 INP1"},
1014	{"RX2 MIX1", NULL, "RX2 MIX1 INP2"},
1015	{"RX2 MIX1", NULL, "RX2 MIX1 INP3"},
1016
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"},
1022
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"},
1028
1029	{"RX2 MIX1 INP3", "RX1", "I2S RX1"},
1030	{"RX2 MIX1 INP3", "RX2", "I2S RX2"},
1031	{"RX2 MIX1 INP3", "RX3", "I2S RX3"},
1032
1033	/* RX3 PATH */
1034	{"PDM_RX3", NULL, "RX3 INT"},
1035	{"RX3 INT", NULL, "RX3 MIX1"},
1036
1037	{"RX3 MIX1", NULL, "RX3 MIX1 INP1"},
1038	{"RX3 MIX1", NULL, "RX3 MIX1 INP2"},
1039	{"RX3 MIX1", NULL, "RX3 MIX1 INP3"},
1040
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"},
1046
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"},
1052
1053	{"RX1 MIX2 INP1", "IIR1", "IIR1"},
1054	{"RX2 MIX2 INP1", "IIR1", "IIR1"},
1055	{"RX1 MIX2 INP1", "IIR2", "IIR2"},
1056	{"RX2 MIX2 INP1", "IIR2", "IIR2"},
1057
1058	{"IIR1", NULL, "IIR1 INP1 MUX"},
1059	{"IIR1 INP1 MUX", "DEC1", "DEC1 MUX"},
1060	{"IIR1 INP1 MUX", "DEC2", "DEC2 MUX"},
1061
1062	{"IIR2", NULL, "IIR2 INP1 MUX"},
1063	{"IIR2 INP1 MUX", "DEC1", "DEC1 MUX"},
1064	{"IIR2 INP1 MUX", "DEC2", "DEC2 MUX"},
1065
1066	{"RX3 MIX1 INP3", "RX1", "I2S RX1"},
1067	{"RX3 MIX1 INP3", "RX2", "I2S RX2"},
1068	{"RX3 MIX1 INP3", "RX3", "I2S RX3"},
1069
1070};
1071
1072static int msm8916_wcd_digital_startup(struct snd_pcm_substream *substream,
1073				       struct snd_soc_dai *dai)
1074{
1075	struct snd_soc_component *component = dai->component;
1076	struct msm8916_wcd_digital_priv *msm8916_wcd;
1077	unsigned long mclk_rate;
1078
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);
1086
1087	mclk_rate = clk_get_rate(msm8916_wcd->mclk);
1088	switch (mclk_rate) {
1089	case 12288000:
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);
1093		break;
1094	case 9600000:
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);
1098		break;
1099	default:
1100		dev_err(component->dev, "Invalid mclk rate %ld\n", mclk_rate);
1101		break;
1102	}
1103	return 0;
1104}
1105
1106static void msm8916_wcd_digital_shutdown(struct snd_pcm_substream *substream,
1107					 struct snd_soc_dai *dai)
1108{
1109	snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_PDM_CTL,
1110			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK, 0);
1111}
1112
1113static 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,
1117};
1118
1119static struct snd_soc_dai_driver msm8916_wcd_digital_dai[] = {
1120	[0] = {
1121	       .name = "msm8916_wcd_digital_i2s_rx1",
1122	       .id = 0,
1123	       .playback = {
1124			    .stream_name = "AIF1 Playback",
1125			    .rates = MSM8916_WCD_DIGITAL_RATES,
1126			    .formats = MSM8916_WCD_DIGITAL_FORMATS,
1127			    .channels_min = 1,
1128			    .channels_max = 3,
1129			    },
1130	       .ops = &msm8916_wcd_digital_dai_ops,
1131	       },
1132	[1] = {
1133	       .name = "msm8916_wcd_digital_i2s_tx1",
1134	       .id = 1,
1135	       .capture = {
1136			   .stream_name = "AIF1 Capture",
1137			   .rates = MSM8916_WCD_DIGITAL_RATES,
1138			   .formats = MSM8916_WCD_DIGITAL_FORMATS,
1139			   .channels_min = 1,
1140			   .channels_max = 4,
1141			   },
1142	       .ops = &msm8916_wcd_digital_dai_ops,
1143	       },
1144};
1145
1146static 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),
1155	.idle_bias_on		= 1,
1156	.use_pmdown_time	= 1,
1157	.endianness		= 1,
1158};
1159
1160static const struct regmap_config msm8916_codec_regmap_config = {
1161	.reg_bits = 32,
1162	.reg_stride = 4,
1163	.val_bits = 32,
1164	.max_register = LPASS_CDC_TX2_DMIC_CTL,
1165	.cache_type = REGCACHE_FLAT,
1166};
1167
1168static int msm8916_wcd_digital_probe(struct platform_device *pdev)
1169{
1170	struct msm8916_wcd_digital_priv *priv;
1171	struct device *dev = &pdev->dev;
1172	void __iomem *base;
 
1173	struct regmap *digital_map;
1174	int ret;
1175
1176	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1177	if (!priv)
1178		return -ENOMEM;
1179
1180	base = devm_platform_ioremap_resource(pdev, 0);
 
1181	if (IS_ERR(base))
1182		return PTR_ERR(base);
1183
1184	digital_map =
1185	    devm_regmap_init_mmio(&pdev->dev, base,
1186				  &msm8916_codec_regmap_config);
1187	if (IS_ERR(digital_map))
1188		return PTR_ERR(digital_map);
1189
1190	ret = msm8916_wcd_digital_get_clks(pdev, priv);
1191	if (ret < 0)
1192		return ret;
1193
1194	ret = clk_prepare_enable(priv->ahbclk);
1195	if (ret < 0) {
1196		dev_err(dev, "failed to enable ahbclk %d\n", ret);
1197		return ret;
1198	}
1199
1200	ret = clk_prepare_enable(priv->mclk);
1201	if (ret < 0) {
1202		dev_err(dev, "failed to enable mclk %d\n", ret);
1203		goto err_clk;
1204	}
1205
1206	dev_set_drvdata(dev, priv);
1207
1208	ret = devm_snd_soc_register_component(dev, &msm8916_wcd_digital,
1209				      msm8916_wcd_digital_dai,
1210				      ARRAY_SIZE(msm8916_wcd_digital_dai));
1211	if (ret)
1212		goto err_mclk;
1213
1214	return 0;
1215
1216err_mclk:
1217	clk_disable_unprepare(priv->mclk);
1218err_clk:
1219	clk_disable_unprepare(priv->ahbclk);
1220	return ret;
1221}
1222
1223static void msm8916_wcd_digital_remove(struct platform_device *pdev)
1224{
1225	struct msm8916_wcd_digital_priv *priv = dev_get_drvdata(&pdev->dev);
1226
 
1227	clk_disable_unprepare(priv->mclk);
1228	clk_disable_unprepare(priv->ahbclk);
 
 
1229}
1230
1231static const struct of_device_id msm8916_wcd_digital_match_table[] = {
1232	{ .compatible = "qcom,msm8916-wcd-digital-codec" },
1233	{ }
1234};
1235
1236MODULE_DEVICE_TABLE(of, msm8916_wcd_digital_match_table);
1237
1238static struct platform_driver msm8916_wcd_digital_driver = {
1239	.driver = {
1240		   .name = "msm8916-wcd-digital-codec",
1241		   .of_match_table = msm8916_wcd_digital_match_table,
1242	},
1243	.probe = msm8916_wcd_digital_probe,
1244	.remove = msm8916_wcd_digital_remove,
1245};
1246
1247module_platform_driver(msm8916_wcd_digital_driver);
1248
1249MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");
1250MODULE_DESCRIPTION("MSM8916 WCD Digital Codec driver");
1251MODULE_LICENSE("GPL v2");
v4.10.11
  1/* Copyright (c) 2016, The Linux Foundation. All rights reserved.
  2 *
  3 * This program is free software; you can redistribute it and/or modify
  4 * it under the terms of the GNU General Public License version 2 and
  5 * only version 2 as published by the Free Software Foundation.
  6 *
  7 * This program is distributed in the hope that it will be useful,
  8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 10 * GNU General Public License for more details.
 11 */
 12
 13#include <linux/module.h>
 14#include <linux/err.h>
 15#include <linux/kernel.h>
 16#include <linux/delay.h>
 17#include <linux/types.h>
 18#include <linux/clk.h>
 19#include <linux/of.h>
 20#include <linux/platform_device.h>
 21#include <linux/regmap.h>
 22#include <linux/mfd/syscon.h>
 23#include <sound/soc.h>
 24#include <sound/pcm.h>
 25#include <sound/pcm_params.h>
 26#include <sound/tlv.h>
 27
 28#define LPASS_CDC_CLK_RX_RESET_CTL		(0x000)
 29#define LPASS_CDC_CLK_TX_RESET_B1_CTL		(0x004)
 30#define CLK_RX_RESET_B1_CTL_TX1_RESET_MASK	BIT(0)
 31#define CLK_RX_RESET_B1_CTL_TX2_RESET_MASK	BIT(1)
 32#define LPASS_CDC_CLK_DMIC_B1_CTL		(0x008)
 33#define DMIC_B1_CTL_DMIC0_CLK_SEL_MASK		GENMASK(3, 1)
 34#define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV2		(0x0 << 1)
 35#define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV3		(0x1 << 1)
 36#define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV4		(0x2 << 1)
 37#define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV6		(0x3 << 1)
 38#define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV16		(0x4 << 1)
 39#define DMIC_B1_CTL_DMIC0_CLK_EN_MASK		BIT(0)
 40#define DMIC_B1_CTL_DMIC0_CLK_EN_ENABLE		BIT(0)
 41
 42#define LPASS_CDC_CLK_RX_I2S_CTL		(0x00C)
 43#define RX_I2S_CTL_RX_I2S_MODE_MASK		BIT(5)
 44#define RX_I2S_CTL_RX_I2S_MODE_16		BIT(5)
 45#define RX_I2S_CTL_RX_I2S_MODE_32		0
 46#define RX_I2S_CTL_RX_I2S_FS_RATE_MASK		GENMASK(2, 0)
 47#define RX_I2S_CTL_RX_I2S_FS_RATE_F_8_KHZ	0x0
 48#define RX_I2S_CTL_RX_I2S_FS_RATE_F_16_KHZ	0x1
 49#define RX_I2S_CTL_RX_I2S_FS_RATE_F_32_KHZ	0x2
 50#define RX_I2S_CTL_RX_I2S_FS_RATE_F_48_KHZ	0x3
 51#define RX_I2S_CTL_RX_I2S_FS_RATE_F_96_KHZ	0x4
 52#define RX_I2S_CTL_RX_I2S_FS_RATE_F_192_KHZ	0x5
 53#define LPASS_CDC_CLK_TX_I2S_CTL		(0x010)
 54#define TX_I2S_CTL_TX_I2S_MODE_MASK		BIT(5)
 55#define TX_I2S_CTL_TX_I2S_MODE_16		BIT(5)
 56#define TX_I2S_CTL_TX_I2S_MODE_32		0
 57#define TX_I2S_CTL_TX_I2S_FS_RATE_MASK		GENMASK(2, 0)
 58#define TX_I2S_CTL_TX_I2S_FS_RATE_F_8_KHZ	0x0
 59#define TX_I2S_CTL_TX_I2S_FS_RATE_F_16_KHZ	0x1
 60#define TX_I2S_CTL_TX_I2S_FS_RATE_F_32_KHZ	0x2
 61#define TX_I2S_CTL_TX_I2S_FS_RATE_F_48_KHZ	0x3
 62#define TX_I2S_CTL_TX_I2S_FS_RATE_F_96_KHZ	0x4
 63#define TX_I2S_CTL_TX_I2S_FS_RATE_F_192_KHZ	0x5
 64
 65#define LPASS_CDC_CLK_OTHR_RESET_B1_CTL		(0x014)
 66#define LPASS_CDC_CLK_TX_CLK_EN_B1_CTL		(0x018)
 67#define LPASS_CDC_CLK_OTHR_CTL			(0x01C)
 68#define LPASS_CDC_CLK_RX_B1_CTL			(0x020)
 69#define LPASS_CDC_CLK_MCLK_CTL			(0x024)
 70#define MCLK_CTL_MCLK_EN_MASK			BIT(0)
 71#define MCLK_CTL_MCLK_EN_ENABLE			BIT(0)
 72#define MCLK_CTL_MCLK_EN_DISABLE		0
 73#define LPASS_CDC_CLK_PDM_CTL			(0x028)
 74#define LPASS_CDC_CLK_PDM_CTL_PDM_EN_MASK	BIT(0)
 75#define LPASS_CDC_CLK_PDM_CTL_PDM_EN		BIT(0)
 76#define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK	BIT(1)
 77#define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_FB	BIT(1)
 78#define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_PDM_CLK	0
 79
 80#define LPASS_CDC_CLK_SD_CTL			(0x02C)
 81#define LPASS_CDC_RX1_B1_CTL			(0x040)
 82#define LPASS_CDC_RX2_B1_CTL			(0x060)
 83#define LPASS_CDC_RX3_B1_CTL			(0x080)
 84#define LPASS_CDC_RX1_B2_CTL			(0x044)
 85#define LPASS_CDC_RX2_B2_CTL			(0x064)
 86#define LPASS_CDC_RX3_B2_CTL			(0x084)
 87#define LPASS_CDC_RX1_B3_CTL			(0x048)
 88#define LPASS_CDC_RX2_B3_CTL			(0x068)
 89#define LPASS_CDC_RX3_B3_CTL			(0x088)
 90#define LPASS_CDC_RX1_B4_CTL			(0x04C)
 91#define LPASS_CDC_RX2_B4_CTL			(0x06C)
 92#define LPASS_CDC_RX3_B4_CTL			(0x08C)
 93#define LPASS_CDC_RX1_B5_CTL			(0x050)
 94#define LPASS_CDC_RX2_B5_CTL			(0x070)
 95#define LPASS_CDC_RX3_B5_CTL			(0x090)
 96#define LPASS_CDC_RX1_B6_CTL			(0x054)
 97#define RXn_B6_CTL_MUTE_MASK			BIT(0)
 98#define RXn_B6_CTL_MUTE_ENABLE			BIT(0)
 99#define RXn_B6_CTL_MUTE_DISABLE			0
100#define LPASS_CDC_RX2_B6_CTL			(0x074)
101#define LPASS_CDC_RX3_B6_CTL			(0x094)
102#define LPASS_CDC_RX1_VOL_CTL_B1_CTL		(0x058)
103#define LPASS_CDC_RX2_VOL_CTL_B1_CTL		(0x078)
104#define LPASS_CDC_RX3_VOL_CTL_B1_CTL		(0x098)
105#define LPASS_CDC_RX1_VOL_CTL_B2_CTL		(0x05C)
106#define LPASS_CDC_RX2_VOL_CTL_B2_CTL		(0x07C)
107#define LPASS_CDC_RX3_VOL_CTL_B2_CTL		(0x09C)
108#define LPASS_CDC_TOP_GAIN_UPDATE		(0x0A0)
109#define LPASS_CDC_TOP_CTL			(0x0A4)
110#define TOP_CTL_DIG_MCLK_FREQ_MASK		BIT(0)
111#define TOP_CTL_DIG_MCLK_FREQ_F_12_288MHZ	0
112#define TOP_CTL_DIG_MCLK_FREQ_F_9_6MHZ		BIT(0)
113
114#define LPASS_CDC_DEBUG_DESER1_CTL		(0x0E0)
115#define LPASS_CDC_DEBUG_DESER2_CTL		(0x0E4)
116#define LPASS_CDC_DEBUG_B1_CTL_CFG		(0x0E8)
117#define LPASS_CDC_DEBUG_B2_CTL_CFG		(0x0EC)
118#define LPASS_CDC_DEBUG_B3_CTL_CFG		(0x0F0)
119#define LPASS_CDC_IIR1_GAIN_B1_CTL		(0x100)
120#define LPASS_CDC_IIR2_GAIN_B1_CTL		(0x140)
121#define LPASS_CDC_IIR1_GAIN_B2_CTL		(0x104)
122#define LPASS_CDC_IIR2_GAIN_B2_CTL		(0x144)
123#define LPASS_CDC_IIR1_GAIN_B3_CTL		(0x108)
124#define LPASS_CDC_IIR2_GAIN_B3_CTL		(0x148)
125#define LPASS_CDC_IIR1_GAIN_B4_CTL		(0x10C)
126#define LPASS_CDC_IIR2_GAIN_B4_CTL		(0x14C)
127#define LPASS_CDC_IIR1_GAIN_B5_CTL		(0x110)
128#define LPASS_CDC_IIR2_GAIN_B5_CTL		(0x150)
129#define LPASS_CDC_IIR1_GAIN_B6_CTL		(0x114)
130#define LPASS_CDC_IIR2_GAIN_B6_CTL		(0x154)
131#define LPASS_CDC_IIR1_GAIN_B7_CTL		(0x118)
132#define LPASS_CDC_IIR2_GAIN_B7_CTL		(0x158)
133#define LPASS_CDC_IIR1_GAIN_B8_CTL		(0x11C)
134#define LPASS_CDC_IIR2_GAIN_B8_CTL		(0x15C)
135#define LPASS_CDC_IIR1_CTL			(0x120)
136#define LPASS_CDC_IIR2_CTL			(0x160)
137#define LPASS_CDC_IIR1_GAIN_TIMER_CTL		(0x124)
138#define LPASS_CDC_IIR2_GAIN_TIMER_CTL		(0x164)
139#define LPASS_CDC_IIR1_COEF_B1_CTL		(0x128)
140#define LPASS_CDC_IIR2_COEF_B1_CTL		(0x168)
141#define LPASS_CDC_IIR1_COEF_B2_CTL		(0x12C)
142#define LPASS_CDC_IIR2_COEF_B2_CTL		(0x16C)
143#define LPASS_CDC_CONN_RX1_B1_CTL		(0x180)
144#define LPASS_CDC_CONN_RX1_B2_CTL		(0x184)
145#define LPASS_CDC_CONN_RX1_B3_CTL		(0x188)
146#define LPASS_CDC_CONN_RX2_B1_CTL		(0x18C)
147#define LPASS_CDC_CONN_RX2_B2_CTL		(0x190)
148#define LPASS_CDC_CONN_RX2_B3_CTL		(0x194)
149#define LPASS_CDC_CONN_RX3_B1_CTL		(0x198)
150#define LPASS_CDC_CONN_RX3_B2_CTL		(0x19C)
151#define LPASS_CDC_CONN_TX_B1_CTL		(0x1A0)
152#define LPASS_CDC_CONN_EQ1_B1_CTL		(0x1A8)
153#define LPASS_CDC_CONN_EQ1_B2_CTL		(0x1AC)
154#define LPASS_CDC_CONN_EQ1_B3_CTL		(0x1B0)
155#define LPASS_CDC_CONN_EQ1_B4_CTL		(0x1B4)
156#define LPASS_CDC_CONN_EQ2_B1_CTL		(0x1B8)
157#define LPASS_CDC_CONN_EQ2_B2_CTL		(0x1BC)
158#define LPASS_CDC_CONN_EQ2_B3_CTL		(0x1C0)
159#define LPASS_CDC_CONN_EQ2_B4_CTL		(0x1C4)
160#define LPASS_CDC_CONN_TX_I2S_SD1_CTL		(0x1C8)
161#define LPASS_CDC_TX1_VOL_CTL_TIMER		(0x280)
162#define LPASS_CDC_TX2_VOL_CTL_TIMER		(0x2A0)
163#define LPASS_CDC_TX1_VOL_CTL_GAIN		(0x284)
164#define LPASS_CDC_TX2_VOL_CTL_GAIN		(0x2A4)
165#define LPASS_CDC_TX1_VOL_CTL_CFG		(0x288)
166#define TX_VOL_CTL_CFG_MUTE_EN_MASK		BIT(0)
167#define TX_VOL_CTL_CFG_MUTE_EN_ENABLE		BIT(0)
168
169#define LPASS_CDC_TX2_VOL_CTL_CFG		(0x2A8)
170#define LPASS_CDC_TX1_MUX_CTL			(0x28C)
171#define TX_MUX_CTL_CUT_OFF_FREQ_MASK		GENMASK(5, 4)
172#define TX_MUX_CTL_CUT_OFF_FREQ_SHIFT		4
173#define TX_MUX_CTL_CF_NEG_3DB_4HZ		(0x0 << 4)
174#define TX_MUX_CTL_CF_NEG_3DB_75HZ		(0x1 << 4)
175#define TX_MUX_CTL_CF_NEG_3DB_150HZ		(0x2 << 4)
176#define TX_MUX_CTL_HPF_BP_SEL_MASK		BIT(3)
177#define TX_MUX_CTL_HPF_BP_SEL_BYPASS		BIT(3)
178#define TX_MUX_CTL_HPF_BP_SEL_NO_BYPASS		0
179
180#define LPASS_CDC_TX2_MUX_CTL			(0x2AC)
181#define LPASS_CDC_TX1_CLK_FS_CTL		(0x290)
182#define LPASS_CDC_TX2_CLK_FS_CTL		(0x2B0)
183#define LPASS_CDC_TX1_DMIC_CTL			(0x294)
184#define LPASS_CDC_TX2_DMIC_CTL			(0x2B4)
185#define TXN_DMIC_CTL_CLK_SEL_MASK		GENMASK(2, 0)
186#define TXN_DMIC_CTL_CLK_SEL_DIV2		0x0
187#define TXN_DMIC_CTL_CLK_SEL_DIV3		0x1
188#define TXN_DMIC_CTL_CLK_SEL_DIV4		0x2
189#define TXN_DMIC_CTL_CLK_SEL_DIV6		0x3
190#define TXN_DMIC_CTL_CLK_SEL_DIV16		0x4
191
192#define MSM8916_WCD_DIGITAL_RATES (SNDRV_PCM_RATE_8000 | \
193				   SNDRV_PCM_RATE_16000 | \
194				   SNDRV_PCM_RATE_32000 | \
195				   SNDRV_PCM_RATE_48000)
196#define MSM8916_WCD_DIGITAL_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
197				     SNDRV_PCM_FMTBIT_S24_LE)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
198
199struct msm8916_wcd_digital_priv {
200	struct clk *ahbclk, *mclk;
201};
202
203static const unsigned long rx_gain_reg[] = {
204	LPASS_CDC_RX1_VOL_CTL_B2_CTL,
205	LPASS_CDC_RX2_VOL_CTL_B2_CTL,
206	LPASS_CDC_RX3_VOL_CTL_B2_CTL,
207};
208
209static const unsigned long tx_gain_reg[] = {
210	LPASS_CDC_TX1_VOL_CTL_GAIN,
211	LPASS_CDC_TX2_VOL_CTL_GAIN,
212};
213
214static const char *const rx_mix1_text[] = {
215	"ZERO", "IIR1", "IIR2", "RX1", "RX2", "RX3"
216};
217
 
 
 
 
218static const char *const dec_mux_text[] = {
219	"ZERO", "ADC1", "ADC2", "ADC3", "DMIC1", "DMIC2"
220};
221static const char *const rx_mix2_text[] = { "ZERO", "IIR1", "IIR2" };
222static const char *const adc2_mux_text[] = { "ZERO", "INP2", "INP3" };
223
224/* RX1 MIX1 */
225static const struct soc_enum rx_mix1_inp_enum[] = {
226	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B1_CTL, 0, 6, rx_mix1_text),
227	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B1_CTL, 3, 6, rx_mix1_text),
228	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B2_CTL, 0, 6, rx_mix1_text),
229};
230
231/* RX1 MIX2 */
232static const struct soc_enum rx_mix2_inp1_chain_enum = SOC_ENUM_SINGLE(
233				LPASS_CDC_CONN_RX1_B3_CTL, 0, 3, rx_mix2_text);
234
235/* RX2 MIX1 */
236static const struct soc_enum rx2_mix1_inp_enum[] = {
237	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL, 0, 6, rx_mix1_text),
238	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL, 3, 6, rx_mix1_text),
239	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL, 0, 6, rx_mix1_text),
240};
241
242/* RX2 MIX2 */
243static const struct soc_enum rx2_mix2_inp1_chain_enum = SOC_ENUM_SINGLE(
244				LPASS_CDC_CONN_RX2_B3_CTL, 0, 3, rx_mix2_text);
245
246/* RX3 MIX1 */
247static const struct soc_enum rx3_mix1_inp_enum[] = {
248	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL, 0, 6, rx_mix1_text),
249	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL, 3, 6, rx_mix1_text),
250	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL, 0, 6, rx_mix1_text),
251};
252
 
 
 
 
 
 
 
 
 
 
253/* DEC */
254static const struct soc_enum dec1_mux_enum = SOC_ENUM_SINGLE(
255				LPASS_CDC_CONN_TX_B1_CTL, 0, 6, dec_mux_text);
256static const struct soc_enum dec2_mux_enum = SOC_ENUM_SINGLE(
257				LPASS_CDC_CONN_TX_B1_CTL, 3, 6, dec_mux_text);
258
 
 
 
 
 
 
259/* RDAC2 MUX */
260static const struct snd_kcontrol_new dec1_mux = SOC_DAPM_ENUM(
261				"DEC1 MUX Mux", dec1_mux_enum);
262static const struct snd_kcontrol_new dec2_mux = SOC_DAPM_ENUM(
263				"DEC2 MUX Mux",	dec2_mux_enum);
 
 
 
 
264static const struct snd_kcontrol_new rx_mix1_inp1_mux = SOC_DAPM_ENUM(
265				"RX1 MIX1 INP1 Mux", rx_mix1_inp_enum[0]);
266static const struct snd_kcontrol_new rx_mix1_inp2_mux = SOC_DAPM_ENUM(
267				"RX1 MIX1 INP2 Mux", rx_mix1_inp_enum[1]);
268static const struct snd_kcontrol_new rx_mix1_inp3_mux = SOC_DAPM_ENUM(
269				"RX1 MIX1 INP3 Mux", rx_mix1_inp_enum[2]);
270static const struct snd_kcontrol_new rx2_mix1_inp1_mux = SOC_DAPM_ENUM(
271				"RX2 MIX1 INP1 Mux", rx2_mix1_inp_enum[0]);
272static const struct snd_kcontrol_new rx2_mix1_inp2_mux = SOC_DAPM_ENUM(
273				"RX2 MIX1 INP2 Mux", rx2_mix1_inp_enum[1]);
274static const struct snd_kcontrol_new rx2_mix1_inp3_mux = SOC_DAPM_ENUM(
275				"RX2 MIX1 INP3 Mux", rx2_mix1_inp_enum[2]);
276static const struct snd_kcontrol_new rx3_mix1_inp1_mux = SOC_DAPM_ENUM(
277				"RX3 MIX1 INP1 Mux", rx3_mix1_inp_enum[0]);
278static const struct snd_kcontrol_new rx3_mix1_inp2_mux = SOC_DAPM_ENUM(
279				"RX3 MIX1 INP2 Mux", rx3_mix1_inp_enum[1]);
280static const struct snd_kcontrol_new rx3_mix1_inp3_mux = SOC_DAPM_ENUM(
281				"RX3 MIX1 INP3 Mux", rx3_mix1_inp_enum[2]);
 
 
 
 
282
283/* Digital Gain control -38.4 dB to +38.4 dB in 0.3 dB steps */
284static const DECLARE_TLV_DB_SCALE(digital_gain, -3840, 30, 0);
285
286/* Cutoff Freq for High Pass Filter at -3dB */
287static const char * const hpf_cutoff_text[] = {
288	"4Hz", "75Hz", "150Hz",
289};
290
291static SOC_ENUM_SINGLE_DECL(tx1_hpf_cutoff_enum, LPASS_CDC_TX1_MUX_CTL, 4,
292			    hpf_cutoff_text);
293static SOC_ENUM_SINGLE_DECL(tx2_hpf_cutoff_enum, LPASS_CDC_TX2_MUX_CTL, 4,
294			    hpf_cutoff_text);
295
296/* cut off for dc blocker inside rx chain */
297static const char * const dc_blocker_cutoff_text[] = {
298	"4Hz", "75Hz", "150Hz",
299};
300
301static SOC_ENUM_SINGLE_DECL(rx1_dcb_cutoff_enum, LPASS_CDC_RX1_B4_CTL, 0,
302			    dc_blocker_cutoff_text);
303static SOC_ENUM_SINGLE_DECL(rx2_dcb_cutoff_enum, LPASS_CDC_RX2_B4_CTL, 0,
304			    dc_blocker_cutoff_text);
305static SOC_ENUM_SINGLE_DECL(rx3_dcb_cutoff_enum, LPASS_CDC_RX3_B4_CTL, 0,
306			    dc_blocker_cutoff_text);
307
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
308static const struct snd_kcontrol_new msm8916_wcd_digital_snd_controls[] = {
309	SOC_SINGLE_S8_TLV("RX1 Digital Volume", LPASS_CDC_RX1_VOL_CTL_B2_CTL,
310			  -128, 127, digital_gain),
311	SOC_SINGLE_S8_TLV("RX2 Digital Volume", LPASS_CDC_RX2_VOL_CTL_B2_CTL,
312			  -128, 127, digital_gain),
313	SOC_SINGLE_S8_TLV("RX3 Digital Volume", LPASS_CDC_RX3_VOL_CTL_B2_CTL,
314			  -128, 127, digital_gain),
315	SOC_SINGLE_S8_TLV("TX1 Digital Volume", LPASS_CDC_TX1_VOL_CTL_GAIN,
316			  -128, 127, digital_gain),
317	SOC_SINGLE_S8_TLV("TX2 Digital Volume", LPASS_CDC_TX2_VOL_CTL_GAIN,
318			  -128, 127, digital_gain),
319	SOC_ENUM("TX1 HPF Cutoff", tx1_hpf_cutoff_enum),
320	SOC_ENUM("TX2 HPF Cutoff", tx2_hpf_cutoff_enum),
321	SOC_SINGLE("TX1 HPF Switch", LPASS_CDC_TX1_MUX_CTL, 3, 1, 0),
322	SOC_SINGLE("TX2 HPF Switch", LPASS_CDC_TX2_MUX_CTL, 3, 1, 0),
323	SOC_ENUM("RX1 DCB Cutoff", rx1_dcb_cutoff_enum),
324	SOC_ENUM("RX2 DCB Cutoff", rx2_dcb_cutoff_enum),
325	SOC_ENUM("RX3 DCB Cutoff", rx3_dcb_cutoff_enum),
326	SOC_SINGLE("RX1 DCB Switch", LPASS_CDC_RX1_B5_CTL, 2, 1, 0),
327	SOC_SINGLE("RX2 DCB Switch", LPASS_CDC_RX2_B5_CTL, 2, 1, 0),
328	SOC_SINGLE("RX3 DCB Switch", LPASS_CDC_RX3_B5_CTL, 2, 1, 0),
329	SOC_SINGLE("RX1 Mute Switch", LPASS_CDC_RX1_B6_CTL, 0, 1, 0),
330	SOC_SINGLE("RX2 Mute Switch", LPASS_CDC_RX2_B6_CTL, 0, 1, 0),
331	SOC_SINGLE("RX3 Mute Switch", LPASS_CDC_RX3_B6_CTL, 0, 1, 0),
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
332};
333
334static int msm8916_wcd_digital_enable_interpolator(
335						struct snd_soc_dapm_widget *w,
336						struct snd_kcontrol *kcontrol,
337						int event)
338{
339	struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
340
341	switch (event) {
342	case SND_SOC_DAPM_POST_PMU:
343		/* apply the digital gain after the interpolator is enabled */
344		usleep_range(10000, 10100);
345		snd_soc_write(codec, rx_gain_reg[w->shift],
346			      snd_soc_read(codec, rx_gain_reg[w->shift]));
 
 
 
 
 
 
347		break;
348	}
349	return 0;
350}
351
352static int msm8916_wcd_digital_enable_dec(struct snd_soc_dapm_widget *w,
353					  struct snd_kcontrol *kcontrol,
354					  int event)
355{
356	struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
357	unsigned int decimator = w->shift + 1;
358	u16 dec_reset_reg, tx_vol_ctl_reg, tx_mux_ctl_reg;
359	u8 dec_hpf_cut_of_freq;
360
361	dec_reset_reg = LPASS_CDC_CLK_TX_RESET_B1_CTL;
362	tx_vol_ctl_reg = LPASS_CDC_TX1_VOL_CTL_CFG + 32 * (decimator - 1);
363	tx_mux_ctl_reg = LPASS_CDC_TX1_MUX_CTL + 32 * (decimator - 1);
364
365	switch (event) {
366	case SND_SOC_DAPM_PRE_PMU:
367		/* Enable TX digital mute */
368		snd_soc_update_bits(codec, tx_vol_ctl_reg,
369				    TX_VOL_CTL_CFG_MUTE_EN_MASK,
370				    TX_VOL_CTL_CFG_MUTE_EN_ENABLE);
371		dec_hpf_cut_of_freq = snd_soc_read(codec, tx_mux_ctl_reg) &
372					TX_MUX_CTL_CUT_OFF_FREQ_MASK;
373		dec_hpf_cut_of_freq >>= TX_MUX_CTL_CUT_OFF_FREQ_SHIFT;
374		if (dec_hpf_cut_of_freq != TX_MUX_CTL_CF_NEG_3DB_150HZ) {
375			/* set cut of freq to CF_MIN_3DB_150HZ (0x1) */
376			snd_soc_update_bits(codec, tx_mux_ctl_reg,
377					    TX_MUX_CTL_CUT_OFF_FREQ_MASK,
378					    TX_MUX_CTL_CF_NEG_3DB_150HZ);
379		}
380		break;
381	case SND_SOC_DAPM_POST_PMU:
382		/* enable HPF */
383		snd_soc_update_bits(codec, tx_mux_ctl_reg,
384				    TX_MUX_CTL_HPF_BP_SEL_MASK,
385				    TX_MUX_CTL_HPF_BP_SEL_NO_BYPASS);
386		/* apply the digital gain after the decimator is enabled */
387		snd_soc_write(codec, tx_gain_reg[w->shift],
388			      snd_soc_read(codec, tx_gain_reg[w->shift]));
389		snd_soc_update_bits(codec, tx_vol_ctl_reg,
390				    TX_VOL_CTL_CFG_MUTE_EN_MASK, 0);
391		break;
392	case SND_SOC_DAPM_PRE_PMD:
393		snd_soc_update_bits(codec, tx_vol_ctl_reg,
394				    TX_VOL_CTL_CFG_MUTE_EN_MASK,
395				    TX_VOL_CTL_CFG_MUTE_EN_ENABLE);
396		snd_soc_update_bits(codec, tx_mux_ctl_reg,
397				    TX_MUX_CTL_HPF_BP_SEL_MASK,
398				    TX_MUX_CTL_HPF_BP_SEL_BYPASS);
399		break;
400	case SND_SOC_DAPM_POST_PMD:
401		snd_soc_update_bits(codec, dec_reset_reg, 1 << w->shift,
402				    1 << w->shift);
403		snd_soc_update_bits(codec, dec_reset_reg, 1 << w->shift, 0x0);
404		snd_soc_update_bits(codec, tx_mux_ctl_reg,
405				    TX_MUX_CTL_HPF_BP_SEL_MASK,
406				    TX_MUX_CTL_HPF_BP_SEL_BYPASS);
407		snd_soc_update_bits(codec, tx_vol_ctl_reg,
408				    TX_VOL_CTL_CFG_MUTE_EN_MASK, 0);
409		break;
410	}
411
412	return 0;
413}
414
415static int msm8916_wcd_digital_enable_dmic(struct snd_soc_dapm_widget *w,
416					   struct snd_kcontrol *kcontrol,
417					   int event)
418{
419	struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
420	unsigned int dmic;
421	int ret;
422	/* get dmic number out of widget name */
423	char *dmic_num = strpbrk(w->name, "12");
424
425	if (dmic_num == NULL) {
426		dev_err(codec->dev, "Invalid DMIC\n");
427		return -EINVAL;
428	}
429	ret = kstrtouint(dmic_num, 10, &dmic);
430	if (ret < 0 || dmic > 2) {
431		dev_err(codec->dev, "Invalid DMIC line on the codec\n");
432		return -EINVAL;
433	}
434
435	switch (event) {
436	case SND_SOC_DAPM_PRE_PMU:
437		snd_soc_update_bits(codec, LPASS_CDC_CLK_DMIC_B1_CTL,
438				    DMIC_B1_CTL_DMIC0_CLK_SEL_MASK,
439				    DMIC_B1_CTL_DMIC0_CLK_SEL_DIV3);
440		switch (dmic) {
441		case 1:
442			snd_soc_update_bits(codec, LPASS_CDC_TX1_DMIC_CTL,
443					    TXN_DMIC_CTL_CLK_SEL_MASK,
444					    TXN_DMIC_CTL_CLK_SEL_DIV3);
445			break;
446		case 2:
447			snd_soc_update_bits(codec, LPASS_CDC_TX2_DMIC_CTL,
448					    TXN_DMIC_CTL_CLK_SEL_MASK,
449					    TXN_DMIC_CTL_CLK_SEL_DIV3);
450			break;
451		}
452		break;
453	}
454
455	return 0;
456}
457
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
458static const struct snd_soc_dapm_widget msm8916_wcd_digital_dapm_widgets[] = {
459	/*RX stuff */
460	SND_SOC_DAPM_AIF_IN("I2S RX1", NULL, 0, SND_SOC_NOPM, 0, 0),
461	SND_SOC_DAPM_AIF_IN("I2S RX2", NULL, 0, SND_SOC_NOPM, 0, 0),
462	SND_SOC_DAPM_AIF_IN("I2S RX3", NULL, 0, SND_SOC_NOPM, 0, 0),
463
464	SND_SOC_DAPM_OUTPUT("PDM_RX1"),
465	SND_SOC_DAPM_OUTPUT("PDM_RX2"),
466	SND_SOC_DAPM_OUTPUT("PDM_RX3"),
467
468	SND_SOC_DAPM_INPUT("LPASS_PDM_TX"),
469
470	SND_SOC_DAPM_MIXER("RX1 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
471	SND_SOC_DAPM_MIXER("RX2 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
472	SND_SOC_DAPM_MIXER("RX3 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
473
474	/* Interpolator */
475	SND_SOC_DAPM_MIXER_E("RX1 INT", LPASS_CDC_CLK_RX_B1_CTL, 0, 0, NULL,
476			     0, msm8916_wcd_digital_enable_interpolator,
477			     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
478	SND_SOC_DAPM_MIXER_E("RX2 INT", LPASS_CDC_CLK_RX_B1_CTL, 1, 0, NULL,
479			     0, msm8916_wcd_digital_enable_interpolator,
480			     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
481	SND_SOC_DAPM_MIXER_E("RX3 INT", LPASS_CDC_CLK_RX_B1_CTL, 2, 0, NULL,
482			     0, msm8916_wcd_digital_enable_interpolator,
483			     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
484	SND_SOC_DAPM_MUX("RX1 MIX1 INP1", SND_SOC_NOPM, 0, 0,
485			 &rx_mix1_inp1_mux),
486	SND_SOC_DAPM_MUX("RX1 MIX1 INP2", SND_SOC_NOPM, 0, 0,
487			 &rx_mix1_inp2_mux),
488	SND_SOC_DAPM_MUX("RX1 MIX1 INP3", SND_SOC_NOPM, 0, 0,
489			 &rx_mix1_inp3_mux),
490	SND_SOC_DAPM_MUX("RX2 MIX1 INP1", SND_SOC_NOPM, 0, 0,
491			 &rx2_mix1_inp1_mux),
492	SND_SOC_DAPM_MUX("RX2 MIX1 INP2", SND_SOC_NOPM, 0, 0,
493			 &rx2_mix1_inp2_mux),
494	SND_SOC_DAPM_MUX("RX2 MIX1 INP3", SND_SOC_NOPM, 0, 0,
495			 &rx2_mix1_inp3_mux),
496	SND_SOC_DAPM_MUX("RX3 MIX1 INP1", SND_SOC_NOPM, 0, 0,
497			 &rx3_mix1_inp1_mux),
498	SND_SOC_DAPM_MUX("RX3 MIX1 INP2", SND_SOC_NOPM, 0, 0,
499			 &rx3_mix1_inp2_mux),
500	SND_SOC_DAPM_MUX("RX3 MIX1 INP3", SND_SOC_NOPM, 0, 0,
501			 &rx3_mix1_inp3_mux),
 
 
 
 
502
 
 
503	/* TX */
504	SND_SOC_DAPM_MIXER("ADC1", SND_SOC_NOPM, 0, 0, NULL, 0),
505	SND_SOC_DAPM_MIXER("ADC2", SND_SOC_NOPM, 0, 0, NULL, 0),
506	SND_SOC_DAPM_MIXER("ADC3", SND_SOC_NOPM, 0, 0, NULL, 0),
507
508	SND_SOC_DAPM_MUX_E("DEC1 MUX", LPASS_CDC_CLK_TX_CLK_EN_B1_CTL, 0, 0,
509			   &dec1_mux, msm8916_wcd_digital_enable_dec,
510			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
511			   SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
512	SND_SOC_DAPM_MUX_E("DEC2 MUX", LPASS_CDC_CLK_TX_CLK_EN_B1_CTL, 1, 0,
513			   &dec2_mux, msm8916_wcd_digital_enable_dec,
514			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
515			   SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
516	SND_SOC_DAPM_AIF_OUT("I2S TX1", NULL, 0, SND_SOC_NOPM, 0, 0),
517	SND_SOC_DAPM_AIF_OUT("I2S TX2", NULL, 0, SND_SOC_NOPM, 0, 0),
518	SND_SOC_DAPM_AIF_OUT("I2S TX3", NULL, 0, SND_SOC_NOPM, 0, 0),
519
520	/* Digital Mic Inputs */
521	SND_SOC_DAPM_ADC_E("DMIC1", NULL, SND_SOC_NOPM, 0, 0,
522			   msm8916_wcd_digital_enable_dmic,
523			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
524	SND_SOC_DAPM_ADC_E("DMIC2", NULL, SND_SOC_NOPM, 0, 0,
525			   msm8916_wcd_digital_enable_dmic,
526			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
527	SND_SOC_DAPM_SUPPLY("DMIC_CLK", LPASS_CDC_CLK_DMIC_B1_CTL, 0, 0,
528			    NULL, 0),
529	SND_SOC_DAPM_SUPPLY("RX_I2S_CLK", LPASS_CDC_CLK_RX_I2S_CTL,
530			    4, 0, NULL, 0),
531	SND_SOC_DAPM_SUPPLY("TX_I2S_CLK", LPASS_CDC_CLK_TX_I2S_CTL, 4, 0,
532			    NULL, 0),
533
534	SND_SOC_DAPM_SUPPLY("MCLK", SND_SOC_NOPM, 0, 0, NULL, 0),
535	SND_SOC_DAPM_SUPPLY("PDM_CLK", LPASS_CDC_CLK_PDM_CTL, 0, 0, NULL, 0),
536	/* Connectivity Clock */
537	SND_SOC_DAPM_SUPPLY_S("CDC_CONN", -2, LPASS_CDC_CLK_OTHR_CTL, 2, 0,
538			      NULL, 0),
 
 
 
 
 
 
 
 
 
 
 
539
540};
541
542static int msm8916_wcd_digital_get_clks(struct platform_device *pdev,
543					struct msm8916_wcd_digital_priv	*priv)
544{
545	struct device *dev = &pdev->dev;
546
547	priv->ahbclk = devm_clk_get(dev, "ahbix-clk");
548	if (IS_ERR(priv->ahbclk)) {
549		dev_err(dev, "failed to get ahbix clk\n");
550		return PTR_ERR(priv->ahbclk);
551	}
552
553	priv->mclk = devm_clk_get(dev, "mclk");
554	if (IS_ERR(priv->mclk)) {
555		dev_err(dev, "failed to get mclk\n");
556		return PTR_ERR(priv->mclk);
557	}
558
559	return 0;
560}
561
562static int msm8916_wcd_digital_codec_probe(struct snd_soc_codec *codec)
563{
564	struct msm8916_wcd_digital_priv *priv = dev_get_drvdata(codec->dev);
565
566	snd_soc_codec_set_drvdata(codec, priv);
567
568	return 0;
569}
570
 
 
 
 
 
 
 
 
 
571static int msm8916_wcd_digital_hw_params(struct snd_pcm_substream *substream,
572					 struct snd_pcm_hw_params *params,
573					 struct snd_soc_dai *dai)
574{
575	u8 tx_fs_rate;
576	u8 rx_fs_rate;
577
578	switch (params_rate(params)) {
579	case 8000:
580		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_8_KHZ;
581		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_8_KHZ;
582		break;
583	case 16000:
584		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_16_KHZ;
585		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_16_KHZ;
586		break;
587	case 32000:
588		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_32_KHZ;
589		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_32_KHZ;
590		break;
591	case 48000:
592		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_48_KHZ;
593		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_48_KHZ;
594		break;
595	default:
596		dev_err(dai->codec->dev, "Invalid sampling rate %d\n",
597			params_rate(params));
598		return -EINVAL;
599	}
600
601	switch (substream->stream) {
602	case SNDRV_PCM_STREAM_CAPTURE:
603		snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_TX_I2S_CTL,
604				    TX_I2S_CTL_TX_I2S_FS_RATE_MASK, tx_fs_rate);
605		break;
606	case SNDRV_PCM_STREAM_PLAYBACK:
607		snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_RX_I2S_CTL,
608				    RX_I2S_CTL_RX_I2S_FS_RATE_MASK, rx_fs_rate);
609		break;
610	default:
611		return -EINVAL;
612	}
613
614	switch (params_format(params)) {
615	case SNDRV_PCM_FORMAT_S16_LE:
616		snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_TX_I2S_CTL,
617				    TX_I2S_CTL_TX_I2S_MODE_MASK,
618				    TX_I2S_CTL_TX_I2S_MODE_16);
619		snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_RX_I2S_CTL,
620				    RX_I2S_CTL_RX_I2S_MODE_MASK,
621				    RX_I2S_CTL_RX_I2S_MODE_16);
622		break;
623	case SNDRV_PCM_FORMAT_S24_LE:
624		snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_TX_I2S_CTL,
 
625				    TX_I2S_CTL_TX_I2S_MODE_MASK,
626				    TX_I2S_CTL_TX_I2S_MODE_32);
627		snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_RX_I2S_CTL,
628				    RX_I2S_CTL_RX_I2S_MODE_MASK,
629				    RX_I2S_CTL_RX_I2S_MODE_32);
630		break;
631	default:
632		dev_err(dai->dev, "%s: wrong format selected\n", __func__);
633		return -EINVAL;
634	}
635
636	return 0;
637}
638
639static const struct snd_soc_dapm_route msm8916_wcd_digital_audio_map[] = {
640
641	{"I2S RX1",  NULL, "AIF1 Playback"},
642	{"I2S RX2",  NULL, "AIF1 Playback"},
643	{"I2S RX3",  NULL, "AIF1 Playback"},
644
645	{"AIF1 Capture", NULL, "I2S TX1"},
646	{"AIF1 Capture", NULL, "I2S TX2"},
647	{"AIF1 Capture", NULL, "I2S TX3"},
648
 
 
 
 
 
649	/* Decimator Inputs */
650	{"DEC1 MUX", "DMIC1", "DMIC1"},
651	{"DEC1 MUX", "DMIC2", "DMIC2"},
652	{"DEC1 MUX", "ADC1", "ADC1"},
653	{"DEC1 MUX", "ADC2", "ADC2"},
654	{"DEC1 MUX", "ADC3", "ADC3"},
655	{"DEC1 MUX", NULL, "CDC_CONN"},
656
657	{"DEC2 MUX", "DMIC1", "DMIC1"},
658	{"DEC2 MUX", "DMIC2", "DMIC2"},
659	{"DEC2 MUX", "ADC1", "ADC1"},
660	{"DEC2 MUX", "ADC2", "ADC2"},
661	{"DEC2 MUX", "ADC3", "ADC3"},
662	{"DEC2 MUX", NULL, "CDC_CONN"},
663
664	{"DMIC1", NULL, "DMIC_CLK"},
665	{"DMIC2", NULL, "DMIC_CLK"},
666
667	{"I2S TX1", NULL, "DEC1 MUX"},
668	{"I2S TX2", NULL, "DEC2 MUX"},
669
670	{"I2S TX1", NULL, "TX_I2S_CLK"},
671	{"I2S TX2", NULL, "TX_I2S_CLK"},
672
673	{"TX_I2S_CLK", NULL, "MCLK"},
674	{"TX_I2S_CLK", NULL, "PDM_CLK"},
675
676	{"ADC1", NULL, "LPASS_PDM_TX"},
677	{"ADC2", NULL, "LPASS_PDM_TX"},
678	{"ADC3", NULL, "LPASS_PDM_TX"},
679
680	{"I2S RX1", NULL, "RX_I2S_CLK"},
681	{"I2S RX2", NULL, "RX_I2S_CLK"},
682	{"I2S RX3", NULL, "RX_I2S_CLK"},
683
684	{"RX_I2S_CLK", NULL, "PDM_CLK"},
685	{"RX_I2S_CLK", NULL, "MCLK"},
686	{"RX_I2S_CLK", NULL, "CDC_CONN"},
687
688	/* RX1 PATH.. */
689	{"PDM_RX1", NULL, "RX1 INT"},
690	{"RX1 INT", NULL, "RX1 MIX1"},
691
692	{"RX1 MIX1", NULL, "RX1 MIX1 INP1"},
693	{"RX1 MIX1", NULL, "RX1 MIX1 INP2"},
694	{"RX1 MIX1", NULL, "RX1 MIX1 INP3"},
695
696	{"RX1 MIX1 INP1", "RX1", "I2S RX1"},
697	{"RX1 MIX1 INP1", "RX2", "I2S RX2"},
698	{"RX1 MIX1 INP1", "RX3", "I2S RX3"},
 
 
699
700	{"RX1 MIX1 INP2", "RX1", "I2S RX1"},
701	{"RX1 MIX1 INP2", "RX2", "I2S RX2"},
702	{"RX1 MIX1 INP2", "RX3", "I2S RX3"},
 
 
703
704	{"RX1 MIX1 INP3", "RX1", "I2S RX1"},
705	{"RX1 MIX1 INP3", "RX2", "I2S RX2"},
706	{"RX1 MIX1 INP3", "RX3", "I2S RX3"},
707
708	/* RX2 PATH */
709	{"PDM_RX2", NULL, "RX2 INT"},
710	{"RX2 INT", NULL, "RX2 MIX1"},
711
712	{"RX2 MIX1", NULL, "RX2 MIX1 INP1"},
713	{"RX2 MIX1", NULL, "RX2 MIX1 INP2"},
714	{"RX2 MIX1", NULL, "RX2 MIX1 INP3"},
715
716	{"RX2 MIX1 INP1", "RX1", "I2S RX1"},
717	{"RX2 MIX1 INP1", "RX2", "I2S RX2"},
718	{"RX2 MIX1 INP1", "RX3", "I2S RX3"},
 
 
719
720	{"RX2 MIX1 INP2", "RX1", "I2S RX1"},
721	{"RX2 MIX1 INP2", "RX2", "I2S RX2"},
722	{"RX2 MIX1 INP2", "RX3", "I2S RX3"},
 
 
723
724	{"RX2 MIX1 INP3", "RX1", "I2S RX1"},
725	{"RX2 MIX1 INP3", "RX2", "I2S RX2"},
726	{"RX2 MIX1 INP3", "RX3", "I2S RX3"},
727
728	/* RX3 PATH */
729	{"PDM_RX3", NULL, "RX3 INT"},
730	{"RX3 INT", NULL, "RX3 MIX1"},
731
732	{"RX3 MIX1", NULL, "RX3 MIX1 INP1"},
733	{"RX3 MIX1", NULL, "RX3 MIX1 INP2"},
734	{"RX3 MIX1", NULL, "RX3 MIX1 INP3"},
735
736	{"RX3 MIX1 INP1", "RX1", "I2S RX1"},
737	{"RX3 MIX1 INP1", "RX2", "I2S RX2"},
738	{"RX3 MIX1 INP1", "RX3", "I2S RX3"},
 
 
739
740	{"RX3 MIX1 INP2", "RX1", "I2S RX1"},
741	{"RX3 MIX1 INP2", "RX2", "I2S RX2"},
742	{"RX3 MIX1 INP2", "RX3", "I2S RX3"},
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
743
744	{"RX3 MIX1 INP3", "RX1", "I2S RX1"},
745	{"RX3 MIX1 INP3", "RX2", "I2S RX2"},
746	{"RX3 MIX1 INP3", "RX3", "I2S RX3"},
747
748};
749
750static int msm8916_wcd_digital_startup(struct snd_pcm_substream *substream,
751				       struct snd_soc_dai *dai)
752{
753	struct snd_soc_codec *codec = dai->codec;
754	struct msm8916_wcd_digital_priv *msm8916_wcd;
755	unsigned long mclk_rate;
756
757	msm8916_wcd = snd_soc_codec_get_drvdata(codec);
758	snd_soc_update_bits(codec, LPASS_CDC_CLK_MCLK_CTL,
759			    MCLK_CTL_MCLK_EN_MASK,
760			    MCLK_CTL_MCLK_EN_ENABLE);
761	snd_soc_update_bits(codec, LPASS_CDC_CLK_PDM_CTL,
762			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK,
763			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_FB);
764
765	mclk_rate = clk_get_rate(msm8916_wcd->mclk);
766	switch (mclk_rate) {
767	case 12288000:
768		snd_soc_update_bits(codec, LPASS_CDC_TOP_CTL,
769				    TOP_CTL_DIG_MCLK_FREQ_MASK,
770				    TOP_CTL_DIG_MCLK_FREQ_F_12_288MHZ);
771		break;
772	case 9600000:
773		snd_soc_update_bits(codec, LPASS_CDC_TOP_CTL,
774				    TOP_CTL_DIG_MCLK_FREQ_MASK,
775				    TOP_CTL_DIG_MCLK_FREQ_F_9_6MHZ);
776		break;
777	default:
778		dev_err(codec->dev, "Invalid mclk rate %ld\n", mclk_rate);
779		break;
780	}
781	return 0;
782}
783
784static void msm8916_wcd_digital_shutdown(struct snd_pcm_substream *substream,
785					 struct snd_soc_dai *dai)
786{
787	snd_soc_update_bits(dai->codec, LPASS_CDC_CLK_PDM_CTL,
788			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK, 0);
789}
790
791static struct snd_soc_dai_ops msm8916_wcd_digital_dai_ops = {
792	.startup = msm8916_wcd_digital_startup,
793	.shutdown = msm8916_wcd_digital_shutdown,
794	.hw_params = msm8916_wcd_digital_hw_params,
795};
796
797static struct snd_soc_dai_driver msm8916_wcd_digital_dai[] = {
798	[0] = {
799	       .name = "msm8916_wcd_digital_i2s_rx1",
800	       .id = 0,
801	       .playback = {
802			    .stream_name = "AIF1 Playback",
803			    .rates = MSM8916_WCD_DIGITAL_RATES,
804			    .formats = MSM8916_WCD_DIGITAL_FORMATS,
805			    .channels_min = 1,
806			    .channels_max = 3,
807			    },
808	       .ops = &msm8916_wcd_digital_dai_ops,
809	       },
810	[1] = {
811	       .name = "msm8916_wcd_digital_i2s_tx1",
812	       .id = 1,
813	       .capture = {
814			   .stream_name = "AIF1 Capture",
815			   .rates = MSM8916_WCD_DIGITAL_RATES,
816			   .formats = MSM8916_WCD_DIGITAL_FORMATS,
817			   .channels_min = 1,
818			   .channels_max = 4,
819			   },
820	       .ops = &msm8916_wcd_digital_dai_ops,
821	       },
822};
823
824static struct snd_soc_codec_driver msm8916_wcd_digital = {
825	.probe = msm8916_wcd_digital_codec_probe,
826	.component_driver = {
827		.controls = msm8916_wcd_digital_snd_controls,
828		.num_controls = ARRAY_SIZE(msm8916_wcd_digital_snd_controls),
829		.dapm_widgets = msm8916_wcd_digital_dapm_widgets,
830		.num_dapm_widgets =
831				 ARRAY_SIZE(msm8916_wcd_digital_dapm_widgets),
832		.dapm_routes = msm8916_wcd_digital_audio_map,
833		.num_dapm_routes = ARRAY_SIZE(msm8916_wcd_digital_audio_map),
834	},
 
835};
836
837static const struct regmap_config msm8916_codec_regmap_config = {
838	.reg_bits = 32,
839	.reg_stride = 4,
840	.val_bits = 32,
841	.max_register = LPASS_CDC_TX2_DMIC_CTL,
842	.cache_type = REGCACHE_FLAT,
843};
844
845static int msm8916_wcd_digital_probe(struct platform_device *pdev)
846{
847	struct msm8916_wcd_digital_priv *priv;
848	struct device *dev = &pdev->dev;
849	void __iomem *base;
850	struct resource *mem_res;
851	struct regmap *digital_map;
852	int ret;
853
854	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
855	if (!priv)
856		return -ENOMEM;
857
858	mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
859	base = devm_ioremap_resource(&pdev->dev, mem_res);
860	if (IS_ERR(base))
861		return PTR_ERR(base);
862
863	digital_map =
864	    devm_regmap_init_mmio(&pdev->dev, base,
865				  &msm8916_codec_regmap_config);
866	if (IS_ERR(digital_map))
867		return PTR_ERR(digital_map);
868
869	ret = msm8916_wcd_digital_get_clks(pdev, priv);
870	if (ret < 0)
871		return ret;
872
873	ret = clk_prepare_enable(priv->ahbclk);
874	if (ret < 0) {
875		dev_err(dev, "failed to enable ahbclk %d\n", ret);
876		return ret;
877	}
878
879	ret = clk_prepare_enable(priv->mclk);
880	if (ret < 0) {
881		dev_err(dev, "failed to enable mclk %d\n", ret);
882		return ret;
883	}
884
885	dev_set_drvdata(dev, priv);
886
887	return snd_soc_register_codec(dev, &msm8916_wcd_digital,
888				      msm8916_wcd_digital_dai,
889				      ARRAY_SIZE(msm8916_wcd_digital_dai));
 
 
 
 
 
 
 
 
 
 
890}
891
892static int msm8916_wcd_digital_remove(struct platform_device *pdev)
893{
894	struct msm8916_wcd_digital_priv *priv = dev_get_drvdata(&pdev->dev);
895
896	snd_soc_unregister_codec(&pdev->dev);
897	clk_disable_unprepare(priv->mclk);
898	clk_disable_unprepare(priv->ahbclk);
899
900	return 0;
901}
902
903static const struct of_device_id msm8916_wcd_digital_match_table[] = {
904	{ .compatible = "qcom,msm8916-wcd-digital-codec" },
905	{ }
906};
907
908MODULE_DEVICE_TABLE(of, msm8916_wcd_digital_match_table);
909
910static struct platform_driver msm8916_wcd_digital_driver = {
911	.driver = {
912		   .name = "msm8916-wcd-digital-codec",
913		   .of_match_table = msm8916_wcd_digital_match_table,
914	},
915	.probe = msm8916_wcd_digital_probe,
916	.remove = msm8916_wcd_digital_remove,
917};
918
919module_platform_driver(msm8916_wcd_digital_driver);
920
921MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");
922MODULE_DESCRIPTION("MSM8916 WCD Digital Codec driver");
923MODULE_LICENSE("GPL v2");