// SPDX-License-Identifier: GPL-2.0-or-later /* * CVITEK CV181X ADC driver * * Copyright 2020 CVITEK Inc. * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "cv1835_ioctl.h" #include "../codecs/cv181xadac.h" #include "cv1835_i2s_subsys.h" static DEFINE_MUTEX(cv181xadc_mutex); static int adc_vol_list[25] = { ADC_VOL_GAIN_0, ADC_VOL_GAIN_1, ADC_VOL_GAIN_2, ADC_VOL_GAIN_3, ADC_VOL_GAIN_4, ADC_VOL_GAIN_5, ADC_VOL_GAIN_6, ADC_VOL_GAIN_7, ADC_VOL_GAIN_8, ADC_VOL_GAIN_9, ADC_VOL_GAIN_10, ADC_VOL_GAIN_11, ADC_VOL_GAIN_12, ADC_VOL_GAIN_13, ADC_VOL_GAIN_14, ADC_VOL_GAIN_15, ADC_VOL_GAIN_16, ADC_VOL_GAIN_17, ADC_VOL_GAIN_18, ADC_VOL_GAIN_19, ADC_VOL_GAIN_20, ADC_VOL_GAIN_21, ADC_VOL_GAIN_22, ADC_VOL_GAIN_23, ADC_VOL_GAIN_24 }; u32 old_adc_voll; u32 old_adc_volr; static int adc_open(struct inode *inode, struct file *file) { if (mutex_lock_interruptible(&cv181xadc_mutex)) return -EINTR; mutex_unlock(&cv181xadc_mutex); pr_debug("%s\n", __func__); return 0; } static int adc_close(struct inode *inode, struct file *file) { if (mutex_lock_interruptible(&cv181xadc_mutex)) return -EINTR; mutex_unlock(&cv181xadc_mutex); pr_debug("%s\n", __func__); return 0; } static inline void adc_write_reg(void __iomem *io_base, int reg, u32 val) { writel(val, io_base + reg); } static inline u32 adc_read_reg(void __iomem *io_base, int reg) { return readl(io_base + reg); } static void cv181xadc_clk_on(struct cv181xadc *adc) { u32 clk_ctrl0; mutex_lock(&cv181xadc_mutex); clk_ctrl0 = readl(adc->mclk_source + CVI_I2S_CLK_CTRL0); if (!(clk_ctrl0 & CVI_I2S_AU_EN_MASK)) { dev_info(adc->dev, "turn I2S3 aud_en on\n"); clk_ctrl0 |= CVI_I2S_AU_EN; } if (!(clk_ctrl0 & CVI_I2S_MCLK_OUT_EN_MASK)) { dev_info(adc->dev, "turn I2S3 mclk_out_en on\n"); clk_ctrl0 |= CVI_I2S_MCLK_OUT_EN; } writel(clk_ctrl0, adc->mclk_source + CVI_I2S_CLK_CTRL0); dev_info(adc->dev, "adc_clk_on, I2S3 clk_ctrl0 = 0x%x\n", readl(adc->mclk_source + CVI_I2S_CLK_CTRL0)); mutex_unlock(&cv181xadc_mutex); } static void cv181xadc_set_mclk(struct cv181xadc *adc, u32 rate) { u32 clk_ctrl1, audio_clk; mutex_lock(&cv181xadc_mutex); clk_ctrl1 = readl(adc->mclk_source + CVI_I2S_CLK_CTRL1) & ~CVI_I2S_MCLK_MASK; dev_dbg(adc->dev, "adc_set_mclk, I2S3 ctrl1=0x%x\n", clk_ctrl1); switch (rate) { case 11025: case 22050: case 44100: case 88200: audio_clk = CVI_22579_MHZ; break; case 8000: case 16000: case 32000: audio_clk = CVI_16384_MHZ; break; case 12000: case 24000: case 48000: case 96000: case 192000: audio_clk = CVI_24576_MHZ; break; default: dev_err(adc->dev, "Warning!!! this sample rate is not supported\n"); return; } dev_dbg(adc->dev, "Audio system clk=%d, sample rate=%d\n", audio_clk, rate); cv1835_set_mclk(audio_clk); /* cv182xa internal adc codec need dynamic MCLK frequency input */ switch (rate) { case 8000: case 16000: case 32000: clk_ctrl1 |= CVI_I2S_MCLK_DIV(1); break; case 11025: case 22050: case 44100: case 48000: clk_ctrl1 |= CVI_I2S_MCLK_DIV(2); break; default: dev_err(adc->dev, "adc_set_mclk doesn't support this sample rate\n"); break; } writel(clk_ctrl1, adc->mclk_source + CVI_I2S_CLK_CTRL1); dev_dbg(adc->dev, "adc_set_mclk I2S3 clk_ctrl1 = 0x%x\n", readl(adc->mclk_source + CVI_I2S_CLK_CTRL1)); mutex_unlock(&cv181xadc_mutex); } static void cv181xadc_clk_off(struct cv181xadc *adc) { u32 i2s_en; u32 clk_ctrl0; mutex_lock(&cv181xadc_mutex); i2s_en = readl(adc->mclk_source + CVI_I2S_EN); clk_ctrl0 = readl(adc->mclk_source + CVI_I2S_CLK_CTRL0); if (!i2s_en) { if ((clk_ctrl0 & CVI_I2S_AU_EN_MASK)) { dev_info(adc->dev, "turn I2S3 aud_en off\n"); clk_ctrl0 &= CVI_I2S_AU_OFF; } } if (!(clk_ctrl0 & CVI_I2S_MCLK_OUT_EN_MASK)) { dev_info(adc->dev, "turn I2S3 mclk_out_en on\n"); clk_ctrl0 &= CVI_I2S_MCLK_OUT_OFF; } writel(clk_ctrl0, adc->mclk_source + CVI_I2S_CLK_CTRL0); dev_info(adc->dev, "adc_clk_off, I2S3 clk_ctrl0 = 0x%x\n", readl(adc->mclk_source + CVI_I2S_CLK_CTRL0)); mutex_unlock(&cv181xadc_mutex); } static int cv181xadc_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt) { struct cv181xadc *adc = snd_soc_dai_get_drvdata(dai); if (!adc->dev) dev_err(adc->dev, "dev is NULL\n"); switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { case SND_SOC_DAIFMT_CBM_CFM: dev_dbg(adc->dev, "Set ADC to MASTER mode\n"); break; case SND_SOC_DAIFMT_CBS_CFS: dev_err(adc->dev, "Cannot set DAC to SLAVE mode, only support MASTER mode\n"); break; default: dev_err(adc->dev, "Cannot support this role mode\n"); return -EINVAL; } switch (fmt & SND_SOC_DAIFMT_INV_MASK) { case SND_SOC_DAIFMT_NB_IF: dev_dbg(adc->dev, "set codec to NB_IF\n"); break; case SND_SOC_DAIFMT_IB_NF: dev_dbg(adc->dev, "set codec to IB_NF\n"); break; case SND_SOC_DAIFMT_IB_IF: dev_dbg(adc->dev, "set codec to IB_IF\n"); break; case SND_SOC_DAIFMT_NB_NF: dev_dbg(adc->dev, "set codec to NB_NF\n"); break; default: dev_err(adc->dev, "Cannot support this format\n"); break; } switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { case SND_SOC_DAIFMT_I2S: dev_dbg(adc->dev, "set codec to I2S mode\n"); break; case SND_SOC_DAIFMT_LEFT_J: dev_dbg(adc->dev, "set codec to LEFT-JUSTIFY mode\n"); break; default: dev_err(adc->dev, "Cannot support this mode\n"); break; } return 0; } static int cv181xadc_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) { struct cv181xadc *adc = snd_soc_dai_get_drvdata(dai); int rate; u32 ctrl1 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1) & ~AUDIO_PHY_REG_RXADC_CIC_OPT_MASK; u32 ana3 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA3) & ~AUDIO_PHY_REG_CTUNE_RXADC_MASK; u32 ana0; u32 clk = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CLK) & ~(AUDIO_RXADC_SCK_DIV_MASK | AUDIO_RXADC_DLYEN_MASK); void __iomem *dac; /* ECO function, register naming is not corrected, use ioremap to access register of DAC */ dac = ioremap(0x0300A000, 0x30); ana0 = readl(dac + AUDIO_PHY_TXDAC_ANA0) & ~AUDIO_PHY_REG_ADDI_TXDAC_MASK; rate = params_rate(params); if (rate >= 8000 && rate <= 48000) { dev_info(adc->dev, "adc_hw_params, set rate to %d\n", rate); cv181xadc_set_mclk(adc, rate); switch (rate) { case 8000: ctrl1 |= RXADC_CIC_DS_512; ana3 |= RXADC_CTUNE_MCLK_16384; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(32) | RXADC_DLYEN(0x21); /* 16384 / 8 / 32 / 2 */ break; case 11025: ctrl1 |= RXADC_CIC_DS_256; ana3 |= RXADC_CTUNE_MCLK_11298; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(16) | RXADC_DLYEN(0x17); /* 112896 / 11.025 / 32 / 2 */ break; case 16000: ctrl1 |= RXADC_CIC_DS_256; ana3 |= RXADC_CTUNE_MCLK_16384; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(16) | RXADC_DLYEN(0x21); /* 16384 / 16 / 32 / 2 */ break; case 22050: ctrl1 |= RXADC_CIC_DS_128; ana3 |= RXADC_CTUNE_MCLK_11298; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(8) | RXADC_DLYEN(0x17); /* 112896 / 22.05 / 32 / 2 */ break; case 32000: ctrl1 |= RXADC_CIC_DS_128; ana3 |= RXADC_CTUNE_MCLK_16384; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(8) | RXADC_DLYEN(0x21); /* 16384 / 32 / 32 / 2 */ break; case 44100: ctrl1 &= RXADC_CIC_DS_64; ana3 |= RXADC_CTUNE_MCLK_11298; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(4) | RXADC_DLYEN(0x17); /* 112896 / 44.1 / 32 / 2 */ break; case 48000: ctrl1 &= RXADC_CIC_DS_64; ana3 |= RXADC_CTUNE_MCLK_12288; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(4) | RXADC_DLYEN(0x19); /* 16384 / 16 / 32 / 2 */ break; default: ctrl1 |= RXADC_CIC_DS_256; ana3 |= RXADC_CTUNE_MCLK_16384; ana0 &= ADDI_TXDAC_GAIN_RATIO_1; clk |= RXADC_SCK_DIV(16) | RXADC_DLYEN(0x21); /* 16384 / 16 / 32 / 2 */ dev_dbg(adc->dev, "adc_hw_params, unsupported sample rate. Set with default 16KHz\n"); break; } adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1, ctrl1); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA3, ana3); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CLK, clk); writel(ana0, dac + AUDIO_PHY_TXDAC_ANA0); iounmap(dac); } else { dev_err(adc->dev, "adc_hw_params, unsupported sample rate\n"); return 0; } if (params_width(params) != 16) { dev_err(adc->dev, "Only support I2S channel width with 16 bits\n"); dev_err(adc->dev, "Set I2S channel width with 16bits\n"); return 0; } return 0; } static int cv181xadc_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) { struct cv181xadc *adc = snd_soc_dai_get_drvdata(dai); dev_dbg(adc->dev, "adc_startup\n"); cv181xadc_clk_on(adc); return 0; } static void cv181xadc_on(struct cv181xadc *adc) { u32 val = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); dev_info(adc->dev, "adc_on, before rxadc reg val=0x%08x\n", adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0)); if ((val & AUDIO_PHY_REG_RXADC_EN_ON) | (val & AUDIO_PHY_REG_I2S_TX_EN_ON)) dev_info(adc->dev, "ADC or I2S TX already switched ON!!, val=0x%08x\n", val); val |= AUDIO_PHY_REG_RXADC_EN_ON | AUDIO_PHY_REG_I2S_TX_EN_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, val); dev_info(adc->dev, "adc_on, after rxadc reg val=0x%08x\n", adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0)); } static void cv181xadc_off(struct cv181xadc *adc) { u32 val = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); val &= AUDIO_PHY_REG_RXADC_EN_OFF & AUDIO_PHY_REG_I2S_TX_EN_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, val); dev_dbg(adc->dev, "adc_off, after rxadc reg val=0x%08x\n", adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0)); } static void cv181xadc_shutdown(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) { struct cv181xadc *adc = snd_soc_dai_get_drvdata(dai); dev_dbg(adc->dev, "adc_shutdown\n"); cv181xadc_off(adc); cv182xa_reset_adc(); cv181xadc_clk_off(adc); } static int cv181xadc_trigger(struct snd_pcm_substream *substream, int cmd, struct snd_soc_dai *dai) { struct cv181xadc *adc = snd_soc_dai_get_drvdata(dai); int ret = 0; dev_dbg(adc->dev, "adc_trigger, cmd=%d\n", cmd); switch (cmd) { case SNDRV_PCM_TRIGGER_START: case SNDRV_PCM_TRIGGER_RESUME: case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: //cv182xaadc_on(adc);//move to prepare function to meet adc on(clock out) before i2s reset break; case SNDRV_PCM_TRIGGER_STOP: case SNDRV_PCM_TRIGGER_SUSPEND: case SNDRV_PCM_TRIGGER_PAUSE_PUSH: //cv182xaadc_off(adc);//move to shutdown function as adc on move to prepare break; default: ret = -EINVAL; break; } return ret; } static int cv181xadc_prepare(struct snd_pcm_substream *substream, struct snd_soc_dai *dai) { struct cv181xadc *adc = snd_soc_dai_get_drvdata(dai); u32 val; //need to rewrite the register if called cv182xa_reset_adc val = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, val); val = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, val); cv181xadc_on(adc); #ifdef CONFIG_CVI_ADC_OV_MOD // chang overflow mode to bypass val = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1); val &= ~AUDIO_PHY_REG_RXADC_DCB_OPT_MASK; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1, val); #endif return 0; } static struct cv181xadc *file_adc_dev(struct file *file) { return container_of(file->private_data, struct cv181xadc, miscdev); } static long adc_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { unsigned int __user *argp = (unsigned int __user *)arg; struct cv181xadc *adc = file_adc_dev(file); struct cvi_vol_ctrl vol; u32 val, val2; u32 temp; if (argp != NULL) { if (!copy_from_user(&val, argp, sizeof(val))) { if (mutex_lock_interruptible(&cv181xadc_mutex)) { pr_debug("cvitekaadc: signal arrives while waiting for lock\n"); return -EINTR; } } else return -EFAULT; } pr_debug("%s, received cmd=%u, val=%d\n", __func__, cmd, val); switch (cmd) { case ACODEC_SOFT_RESET_CTRL: cv182xa_reset_adc(); break; case ACODEC_SET_INPUT_VOL: pr_debug("adc: ACODEC_SET_INPUT_VOL\n"); if ((val < 0) | (val > 24)) pr_err("Only support range 0 [0dB] ~ 24 [48dB]\n"); else if (val == 0) { /* set mute */ temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) | AUDIO_PHY_REG_MUTEL_ON | AUDIO_PHY_REG_MUTER_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); temp = (adc_vol_list[val] | (adc_vol_list[val] << 16)); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, temp); } else { val2 = (adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & AUDIO_PHY_REG_ADC_VOLL_MASK); for (temp = 0; temp < 25; temp++) { if (val2 == adc_vol_list[temp]) break; } if (temp == 0) { /* unmute */ temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTEL_OFF & AUDIO_PHY_REG_MUTEL_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); } temp = (adc_vol_list[val] | (adc_vol_list[val] << 16)); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, temp); } break; case ACODEC_GET_INPUT_VOL: pr_debug("adc: ACODEC_GET_INPUT_VOL\n"); val = (adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & AUDIO_PHY_REG_ADC_VOLL_MASK); for (temp = 0; temp < 25; temp++) { if (val == adc_vol_list[temp]) break; } if (temp == 25) pr_info("adc: cannot find, out of range\n"); if (copy_to_user(argp, &temp, sizeof(temp))) pr_err("adc, failed to return input vol\n"); break; case ACODEC_SET_I2S1_FS: pr_info("adc: ACODEC_SET_I2S1_FS is not support\n"); break; case ACODEC_SET_MIXER_MIC: pr_info("ACODEC_SET_MIXER_MIC is not support\n"); break; case ACODEC_SET_GAIN_MICL: pr_debug("adc: ACODEC_SET_GAIN_MICL\n"); if ((val < 0) | (val > 24)) pr_err("Only support range 0 [0dB] ~ 24 [48dB]\n"); else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & ~AUDIO_PHY_REG_ADC_VOLL_MASK; temp |= adc_vol_list[val]; old_adc_voll = val; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, temp); } break; case ACODEC_SET_GAIN_MICR: pr_debug("adc: ACODEC_SET_GAIN_MICR\n"); if ((val < 0) | (val > 24)) pr_err("Only support range 0 [0dB] ~ 24 [48dB]\n"); else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & ~AUDIO_PHY_REG_ADC_VOLR_MASK; temp |= (adc_vol_list[val] << 16); old_adc_volr = val; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, temp); } break; case ACODEC_SET_ADCL_VOL: if (copy_from_user(&vol, argp, sizeof(vol))) { if (mutex_is_locked(&cv181xadc_mutex)) mutex_unlock(&cv181xadc_mutex); return -EFAULT; } pr_info("adc: ACODEC_SET_ADCL_VOL to %d, mute=%d\n", vol.vol_ctrl, vol.vol_ctrl_mute); if (vol.vol_ctrl_mute == 1) { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) | AUDIO_PHY_REG_MUTEL_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); } else if ((vol.vol_ctrl < 0) | (vol.vol_ctrl > 24)) pr_err("adc-L: Only support range 0 [0dB] ~ 24 [48dB]\n"); else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & ~AUDIO_PHY_REG_ADC_VOLL_MASK; temp |= adc_vol_list[val]; old_adc_voll = val; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, temp); temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTEL_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); } break; case ACODEC_SET_ADCR_VOL: if (copy_from_user(&vol, argp, sizeof(vol))) { if (mutex_is_locked(&cv181xadc_mutex)) mutex_unlock(&cv181xadc_mutex); return -EFAULT; } pr_debug("adc: ACODEC_SET_ADCR_VOL to %d, mute=%d\n", vol.vol_ctrl, vol.vol_ctrl_mute); if (vol.vol_ctrl_mute == 1) { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) | AUDIO_PHY_REG_MUTER_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); } else if ((vol.vol_ctrl < 0) | (vol.vol_ctrl > 24)) pr_err("adc-R: Only support range 0 [0dB] ~ 24 [48dB]\n"); else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & ~AUDIO_PHY_REG_ADC_VOLR_MASK; temp |= (adc_vol_list[val] << 16); old_adc_volr = val; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, temp); temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTER_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); } break; case ACODEC_SET_MICL_MUTE: pr_debug("adc: ACODEC_SET_MICL_MUTE\n"); if (val == 0) temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTEL_OFF; else temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) | AUDIO_PHY_REG_MUTEL_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); break; case ACODEC_SET_MICR_MUTE: pr_debug("adc: ACODEC_SET_MICR_MUTE\n"); if (val == 0) temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTER_OFF; else temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) | AUDIO_PHY_REG_MUTER_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, temp); break; case ACODEC_GET_GAIN_MICL: pr_debug("adc: ACODEC_GET_GAIN_MICL\n"); val = (adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & AUDIO_PHY_REG_ADC_VOLL_MASK); for (temp = 0; temp < 25; temp++) { if (val == adc_vol_list[temp]) break; } if (copy_to_user(argp, &temp, sizeof(temp))) pr_err("failed to return MICL gain\n"); break; case ACODEC_GET_GAIN_MICR: pr_debug("adc: ACODEC_GET_GAIN_MICR\n"); val = (adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & AUDIO_PHY_REG_ADC_VOLR_MASK) >> 16; for (temp = 0; temp < 25; temp++) { if (val == adc_vol_list[temp]) break; } if (copy_to_user(argp, &temp, sizeof(temp))) pr_err("failed to return MICR gain\n"); break; case ACODEC_GET_ADCL_VOL: pr_debug("adc: ACODEC_GET_ADCL_VOL\n"); val = (adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & AUDIO_PHY_REG_ADC_VOLL_MASK); for (temp = 0; temp < 25; temp++) { if (val == adc_vol_list[temp]) break; } vol.vol_ctrl = temp; vol.vol_ctrl_mute = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTEL_RXPGA_MASK; if (copy_to_user(argp, &vol, sizeof(vol))) pr_err("failed to return ADCL vol\n"); break; case ACODEC_GET_ADCR_VOL: pr_debug("adc: ACODEC_GET_ADCR_VOL\n"); val = (adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0) & AUDIO_PHY_REG_ADC_VOLR_MASK) >> 16; for (temp = 0; temp < 25; temp++) { if (val == adc_vol_list[temp]) break; } vol.vol_ctrl = temp; vol.vol_ctrl_mute = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2) & AUDIO_PHY_REG_MUTER_RXPGA_MASK; if (copy_to_user(argp, &vol, sizeof(vol))) pr_err("failed to return ADCR vol\n"); break; case ACODEC_SET_PD_ADCL: pr_debug("adc: ACODEC_SET_PD_ADCL, val=%d\n", val); if (val == 0) { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp |= AUDIO_PHY_REG_RXADC_EN_ON | AUDIO_PHY_REG_I2S_TX_EN_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp &= AUDIO_PHY_REG_RXADC_EN_OFF & AUDIO_PHY_REG_I2S_TX_EN_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } break; case ACODEC_SET_PD_ADCR: pr_debug("adc: ACODEC_SET_PD_ADCR, val=%d\n", val); if (val == 0) { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp |= AUDIO_PHY_REG_RXADC_EN_ON | AUDIO_PHY_REG_I2S_TX_EN_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp &= AUDIO_PHY_REG_RXADC_EN_OFF & AUDIO_PHY_REG_I2S_TX_EN_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } break; case ACODEC_SET_PD_LINEINL: pr_debug("adc: ACODEC_SET_PD_LINEINL, val=%d\n", val); if (val == 0) { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp |= AUDIO_PHY_REG_RXADC_EN_ON | AUDIO_PHY_REG_I2S_TX_EN_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp &= AUDIO_PHY_REG_RXADC_EN_OFF & AUDIO_PHY_REG_I2S_TX_EN_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } break; case ACODEC_SET_PD_LINEINR: pr_debug("adc: ACODEC_SET_PD_LINEINR, val=%d\n", val); if (val == 0) { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp |= AUDIO_PHY_REG_RXADC_EN_ON | AUDIO_PHY_REG_I2S_TX_EN_ON; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } else { temp = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); temp &= AUDIO_PHY_REG_RXADC_EN_OFF & AUDIO_PHY_REG_I2S_TX_EN_OFF; adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, temp); } break; case ACODEC_SET_ADC_HP_FILTER: pr_info("adc: ACODEC_SET_ADC_HP_FILTER is not support\n"); break; default: pr_info("%s, received unsupport cmd=%u\n", __func__, cmd); break; } if (mutex_is_locked(&cv181xadc_mutex)) mutex_unlock(&cv181xadc_mutex); return 0; } static const struct snd_soc_dai_ops cv181xadc_dai_ops = { .hw_params = cv181xadc_hw_params, .set_fmt = cv181xadc_set_dai_fmt, .startup = cv181xadc_startup, .shutdown = cv181xadc_shutdown, .trigger = cv181xadc_trigger, .prepare = cv181xadc_prepare, }; static struct snd_soc_dai_driver cv181xadc_dai = { .name = "cvitekaadc", .capture = { .stream_name = "Capture", .channels_min = 1, .channels_max = 2, .rates = SNDRV_PCM_RATE_8000_48000, .formats = SNDRV_PCM_FMTBIT_S16_LE, }, .ops = &cv181xadc_dai_ops, }; static const struct snd_kcontrol_new cv181xadc_controls[] = { SOC_DOUBLE("ADC Power", AUDIO_PHY_RXADC_CTRL0, 0, 1, 1, 0), SOC_DOUBLE("ADC Capture Volume", AUDIO_PHY_RXADC_ANA0, 0, 16, 24, 0), SOC_DOUBLE("ADC Capture Mute", AUDIO_PHY_RXADC_ANA2, 0, 1, 1, 0), }; unsigned int cv181xadc_reg_read(struct snd_soc_component *codec, unsigned int reg) { int ret, lidx, ridx; struct cv181xadc *adc = dev_get_drvdata(codec->dev); ret = adc_read_reg(adc->adc_base, reg); if (reg == AUDIO_PHY_RXADC_ANA0) { for (lidx = 0; lidx < 25; lidx++) if ((ret & 0xffff) == adc_vol_list[lidx]) break; for (ridx = 0; ridx < 25; ridx++) if (((ret>>16) & 0xffff) == adc_vol_list[ridx]) break; dev_info(adc->dev, "ADC get Vol, reg:%d,ret:%#x, idx=%d.\n", reg, ret, lidx); ret = (lidx << 16) | ridx; } dev_dbg(adc->dev, "adc_reg_read reg:%d,ret:%#x.\n", reg, ret); return ret; } int cv181xadc_reg_write(struct snd_soc_component *codec, unsigned int reg, unsigned int value) { struct cv181xadc *adc = dev_get_drvdata(codec->dev); u32 temp_lval; u32 temp_rval; if (reg == AUDIO_PHY_RXADC_ANA0) { temp_lval = value & 0xffff; temp_rval = (value >> 16) & 0xffff; if (temp_lval > 24) temp_lval = 24; if (temp_rval > 24) temp_rval = 24; value = (adc_vol_list[temp_rval]<<16) | adc_vol_list[temp_lval]; dev_info(adc->dev, "Set ADC Vol, get input val=%d, output val=0x%x\n", value, temp_lval); } adc_write_reg(adc->adc_base, reg, value); dev_dbg(adc->dev, "adc_reg_write reg:%d,value:%#x.\n", reg, value); return 0; } static const struct snd_soc_component_driver soc_component_dev_cv181xadc = { .controls = cv181xadc_controls, .num_controls = ARRAY_SIZE(cv181xadc_controls), .read = cv181xadc_reg_read, .write = cv181xadc_reg_write, }; static const struct file_operations adc_fops = { .owner = THIS_MODULE, .open = adc_open, .release = adc_close, .unlocked_ioctl = adc_ioctl, .compat_ioctl = adc_ioctl, }; static int adc_device_register(struct cv181xadc *adc) { struct miscdevice *miscdev = &adc->miscdev; int ret; miscdev->minor = MISC_DYNAMIC_MINOR; miscdev->name = "cvitekaadc"; miscdev->fops = &adc_fops; miscdev->parent = NULL; ret = misc_register(miscdev); if (ret) { pr_err("adc: failed to register misc device.\n"); return ret; } return 0; } static int cv181xadc_probe(struct platform_device *pdev) { struct cv181xadc *adc; struct resource *res; u32 mclk_source_addr = 0x0; u32 ctrl1; int ret; dev_info(&pdev->dev, "cvitekaadc_probe\n"); adc = devm_kzalloc(&pdev->dev, sizeof(*adc), GFP_KERNEL); if (!adc) return -ENOMEM; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); adc->adc_base = devm_ioremap_resource(&pdev->dev, res); dev_dbg(&pdev->dev, "cvitekaadc get adc_base=0x%p\n", adc->adc_base); if (IS_ERR(adc->adc_base)) return PTR_ERR(adc->adc_base); dev_set_drvdata(&pdev->dev, adc); adc->dev = &pdev->dev; ret = adc_device_register(adc); if (ret < 0) { pr_err("adc: register device error\n"); return ret; } of_property_read_u32(pdev->dev.of_node, "clk_source", &mclk_source_addr); if (mclk_source_addr) adc->mclk_source = ioremap(mclk_source_addr, 0x100); else dev_err(&pdev->dev, "get MCLK source failed !!\n"); /* set default input vol gain to maxmum 48dB, vol range is 0~24 */ ctrl1 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1, ctrl1 | AUDIO_ADC_IGR_INIT_EN); return devm_snd_soc_register_component(&pdev->dev, &soc_component_dev_cv181xadc, &cv181xadc_dai, 1); } static int cv181xadc_remove(struct platform_device *pdev) { struct cv181xadc *adc = dev_get_drvdata(&pdev->dev); dev_dbg(&pdev->dev, "cvitekaadc_remove\n"); iounmap(adc->mclk_source); return 0; } #ifdef CONFIG_OF static const struct of_device_id cvitek_adc_of_match[] = { { .compatible = "cvitek,cv182xaadc", }, {}, }; MODULE_DEVICE_TABLE(of, cvitek_adc_of_match); #endif #ifdef CONFIG_PM_SLEEP static int cv181xadc_suspend(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct cv181xadc *adc = platform_get_drvdata(pdev); if (!adc->reg_ctx) { adc->reg_ctx = devm_kzalloc(adc->dev, sizeof(struct cv181xadc_context), GFP_KERNEL); if (!adc->reg_ctx) return -ENOMEM; } adc->reg_ctx->ctl0 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0); adc->reg_ctx->ctl1 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1); adc->reg_ctx->status = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_STATUS); adc->reg_ctx->ana0 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0); adc->reg_ctx->ana2 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2); adc->reg_ctx->ana3 = adc_read_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA3); return 0; } static int cv181xadc_resume(struct device *dev) { struct platform_device *pdev = to_platform_device(dev); struct cv181xadc *adc = platform_get_drvdata(pdev); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL0, adc->reg_ctx->ctl0); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_CTRL1, adc->reg_ctx->ctl1); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_STATUS, adc->reg_ctx->status); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA0, adc->reg_ctx->ana0); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA2, adc->reg_ctx->ana2); adc_write_reg(adc->adc_base, AUDIO_PHY_RXADC_ANA3, adc->reg_ctx->ana3); return 0; } static SIMPLE_DEV_PM_OPS(cv181xadc_pm_ops, cv181xadc_suspend, cv181xadc_resume); #endif static struct platform_driver cv181xadc_platform_driver = { .probe = cv181xadc_probe, .remove = cv181xadc_remove, .driver = { .name = "cvitekaadc", .of_match_table = of_match_ptr(cvitek_adc_of_match), #ifdef CONFIG_PM_SLEEP .pm = &cv181xadc_pm_ops, #endif }, }; module_platform_driver(cv181xadc_platform_driver); MODULE_DESCRIPTION("ASoC CVITEK cvitekaADC driver"); MODULE_AUTHOR("Ethan Chen "); MODULE_LICENSE("GPL v2"); MODULE_ALIAS("platform:cvitekaadc");