[alsa-devel] [PATCH] ASoC: Add MediaTek MT6660 Speaker Amp Driver
The MT6660 is a boosted BTL class-D amplifier with V/I sensing. A built-in DC-DC step-up converter is used to provide efficient power for class-D amplifier with multi-level class-G operation. The digital audio interface supports I2S, left-justified, right-justified, TDM and DSP A/B format for audio in with a data out used for chip information like voltage sense and current sense, which are able to be monitored via DATAO through proper --- sound/soc/codecs/Kconfig | 14 + sound/soc/codecs/Makefile | 2 + sound/soc/codecs/mt6660.c | 1063 +++++++++++++++++++++++++++++++++++++++++++++ sound/soc/codecs/mt6660.h | 95 ++++ 4 files changed, 1174 insertions(+) create mode 100644 sound/soc/codecs/mt6660.c create mode 100644 sound/soc/codecs/mt6660.h
diff --git a/sound/soc/codecs/Kconfig b/sound/soc/codecs/Kconfig index 229cc89..806cd03 100644 --- a/sound/soc/codecs/Kconfig +++ b/sound/soc/codecs/Kconfig @@ -122,6 +122,7 @@ config SND_SOC_ALL_CODECS select SND_SOC_ML26124 if I2C select SND_SOC_MT6351 if MTK_PMIC_WRAP select SND_SOC_MT6358 if MTK_PMIC_WRAP + select SND_SOC_MT6660 if I2C select SND_SOC_NAU8540 if I2C select SND_SOC_NAU8810 if I2C select SND_SOC_NAU8822 if I2C @@ -1465,6 +1466,19 @@ config SND_SOC_MT6358 Enable support for the platform which uses MT6358 as external codec device.
+config SND_SOC_MT6660 + tristate "Mediatek MT6660 Speaker Amplifier" + depends on I2C + select CRC32 + select CRYPTO_SHA256 + select CRYTO_RSA + help + MediaTek MT6660 is a smart power amplifier which contain + speaker protection, multi-band DRC, equalizer functions. + Select N if you don't have MT6660 on board. + Select M to build this as module. + + config SND_SOC_NAU8540 tristate "Nuvoton Technology Corporation NAU85L40 CODEC" depends on I2C diff --git a/sound/soc/codecs/Makefile b/sound/soc/codecs/Makefile index c498373..2b6814c 100644 --- a/sound/soc/codecs/Makefile +++ b/sound/soc/codecs/Makefile @@ -119,6 +119,7 @@ snd-soc-msm8916-analog-objs := msm8916-wcd-analog.o snd-soc-msm8916-digital-objs := msm8916-wcd-digital.o snd-soc-mt6351-objs := mt6351.o snd-soc-mt6358-objs := mt6358.o +snd-soc-mt6660-objs := mt6660.o snd-soc-nau8540-objs := nau8540.o snd-soc-nau8810-objs := nau8810.o snd-soc-nau8822-objs := nau8822.o @@ -403,6 +404,7 @@ obj-$(CONFIG_SND_SOC_MSM8916_WCD_ANALOG) +=snd-soc-msm8916-analog.o obj-$(CONFIG_SND_SOC_MSM8916_WCD_DIGITAL) +=snd-soc-msm8916-digital.o obj-$(CONFIG_SND_SOC_MT6351) += snd-soc-mt6351.o obj-$(CONFIG_SND_SOC_MT6358) += snd-soc-mt6358.o +obj-$(CONFIG_SND_SOC_MT6660) += snd-soc-mt6660.o obj-$(CONFIG_SND_SOC_NAU8540) += snd-soc-nau8540.o obj-$(CONFIG_SND_SOC_NAU8810) += snd-soc-nau8810.o obj-$(CONFIG_SND_SOC_NAU8822) += snd-soc-nau8822.o diff --git a/sound/soc/codecs/mt6660.c b/sound/soc/codecs/mt6660.c new file mode 100644 index 0000000..5ba8ec5 --- /dev/null +++ b/sound/soc/codecs/mt6660.c @@ -0,0 +1,1063 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (c) 2019 MediaTek Inc. + */ + +#include <linux/module.h> +#include <linux/kernel.h> +#include <linux/version.h> +#include <linux/err.h> +#include <linux/i2c.h> +#include <linux/pm_runtime.h> +#include <linux/delay.h> +#include <sound/soc.h> +#include <sound/tlv.h> +#include <sound/pcm_params.h> +#include <linux/debugfs.h> + +#include "mt6660.h" + +struct codec_reg_val { + u32 addr; + u32 mask; + u32 data; +}; + +struct reg_size_table { + u32 addr; + u8 size; +}; + +static const struct reg_size_table mt6660_reg_size_table[] = { + { MT6660_REG_HPF1_COEF, 4 }, + { MT6660_REG_HPF2_COEF, 4 }, + { MT6660_REG_TDM_CFG3, 2 }, + { MT6660_REG_RESV17, 2 }, + { MT6660_REG_RESV23, 2 }, + { MT6660_REG_SIGMAX, 2 }, + { MT6660_REG_DEVID, 2}, + { MT6660_REG_TDM_CFG3, 2}, + { MT6660_REG_HCLIP_CTRL, 2}, + { MT6660_REG_DA_GAIN, 2}, +}; + +static int mt6660_get_reg_size(uint32_t addr) +{ + int i = 0; + + for (i = 0; i < ARRAY_SIZE(mt6660_reg_size_table); i++) { + if (mt6660_reg_size_table[i].addr == addr) + return mt6660_reg_size_table[i].size; + } + return 1; +} + +#if GENERIC_DEBUGFS +static int mt6660_dbg_io_read(void *drvdata, u16 reg, void *val, u16 size) +{ + struct mt6660_chip *chip = (struct mt6660_chip *)drvdata; + int ret = 0, i = 0; + unsigned int data; + u8 *_val = val; + + if (size != 1 && size != 2 && size != 4) { + dev_err(chip->dev, "%s size not match\n", __func__); + return -EINVAL; + } + ret = regmap_read(chip->regmap, reg, &data); + if (reg < 0) + return ret; + + for (i = 0; i < size; i++) + _val[size-i-1] = (data >> (8*i))&0xff; + + return 0; +} + +static int mt6660_dbg_io_write(void *drvdata, u16 reg, + const void *val, u16 size) +{ + struct mt6660_chip *chip = (struct mt6660_chip *)drvdata; + int reg_size = mt6660_get_reg_size(reg); + int i = 0; + unsigned int regval = 0; + u8 *_val = (u8 *)val; + + if (size != reg_size) { + dev_err(chip->dev, + "%s size not match reg_size(%d), size(%d)\n", + __func__, reg_size, size); + return -EINVAL; + } + + for (i = 0; i < size; i++) { + regval <<= 8; + regval |= _val[i]; + } + + return regmap_write(chip->regmap, reg, regval); +} +#endif /* GENERIC_DEBUGFS */ + +static int mt6660_reg_write(void *context, unsigned int reg, unsigned int val) +{ + struct mt6660_chip *chip = context; + int size = mt6660_get_reg_size(reg); + u8 reg_data[4] = {0}; + int i = 0; + + for (i = 0; i < size; i++) + reg_data[size - i - 1] = (val >> (8 * i)) & 0xff; + + return i2c_smbus_write_i2c_block_data(chip->i2c, reg, size, reg_data); +} + +static int mt6660_reg_read(void *context, unsigned int reg, unsigned int *val) +{ + struct mt6660_chip *chip = context; + int size = mt6660_get_reg_size(reg); + int i = 0, ret = 0; + u8 data[4] = {0}; + u32 reg_data = 0; + + ret = i2c_smbus_read_i2c_block_data(chip->i2c, reg, size, data); + if (ret < 0) + return ret; + for (i = 0; i < size; i++) { + reg_data <<= 8; + reg_data |= data[i]; + } + *val = reg_data; + + return ret; +} + +static bool mt6660_volatile_reg(struct device *dev, unsigned int reg) +{ + return true; +} + +static struct regmap_config mt6660_regmap_config = { + .reg_bits = 8, + .val_bits = 32, + .reg_write = mt6660_reg_write, + .reg_read = mt6660_reg_read, + .volatile_reg = mt6660_volatile_reg, +}; + +static unsigned int mt6660_component_io_read( + struct snd_soc_component *component, unsigned int reg) +{ + struct mt6660_chip *chip = snd_soc_component_get_drvdata(component); + unsigned int val; + int ret; + + ret = regmap_read(chip->regmap, reg, &val); + if (ret < 0) /* ret success -> >= 0, fail -> < - */ + return ret; + pr_err("%s val = 0x%x\n", __func__, val); + return val; +} + +static int mt6660_component_io_write(struct snd_soc_component *component, + unsigned int reg, unsigned int data) +{ + struct mt6660_chip *chip = snd_soc_component_get_drvdata(component); + + pr_err("%s data = 0x%x\n", __func__, data); + return regmap_write(chip->regmap, reg, data); +} + +static const int mt6660_dump_table[] = { + MT6660_REG_DEVID, + MT6660_REG_SYSTEM_CTRL, + MT6660_REG_IRQ_STATUS1, + MT6660_REG_ADDA_CLOCK, + MT6660_REG_SERIAL_CFG1, + MT6660_REG_DATAO_SEL, + MT6660_REG_TDM_CFG3, + MT6660_REG_HPF_CTRL, + MT6660_REG_HPF1_COEF, + MT6660_REG_HPF2_COEF, + MT6660_REG_PATH_BYPASS, + MT6660_REG_WDT_CTRL, + MT6660_REG_HCLIP_CTRL, + MT6660_REG_VOL_CTRL, + MT6660_REG_SPS_CTRL, + MT6660_REG_SIGMAX, + MT6660_REG_CALI_T0, + MT6660_REG_BST_CTRL, + MT6660_REG_PROTECTION_CFG, + MT6660_REG_DA_GAIN, + MT6660_REG_AUDIO_IN2_SEL, + MT6660_REG_SIG_GAIN, + MT6660_REG_PLL_CFG1, + MT6660_REG_DRE_CTRL, + MT6660_REG_DRE_THDMODE, + MT6660_REG_DRE_CORASE, + MT6660_REG_PWM_CTRL, + MT6660_REG_DC_PROTECT_CTRL, + MT6660_REG_ADC_USB_MODE, + MT6660_REG_INTERNAL_CFG, + MT6660_REG_RESV0, + MT6660_REG_RESV1, + MT6660_REG_RESV2, + MT6660_REG_RESV3, + MT6660_REG_RESV7, + MT6660_REG_RESV10, + MT6660_REG_RESV11, + MT6660_REG_RESV16, + MT6660_REG_RESV17, + MT6660_REG_RESV19, + MT6660_REG_RESV21, + MT6660_REG_RESV23, + MT6660_REG_RESV31, + MT6660_REG_RESV40, +}; + +#if GENERIC_DEBUGFS +#ifdef CONFIG_DEBUG_FS +/* reg/size/data/bustype */ +#define PREALLOC_RBUFFER_SIZE (32) +#define PREALLOC_WBUFFER_SIZE (1000) + +static int data_debug_show(struct seq_file *s, void *data) +{ + struct dbg_info *di = s->private; + struct dbg_internal *d = &di->internal; + void *buffer; + u8 *pdata; + int i, ret; + + if (d->data_buffer_size < d->size) { + buffer = kzalloc(d->size, GFP_KERNEL); + if (!buffer) + return -ENOMEM; + kfree(d->data_buffer); + d->data_buffer = buffer; + d->data_buffer_size = d->size; + } + /* read transfer */ + if (!di->io_read) + return -EPERM; + ret = di->io_read(di->io_drvdata, d->reg, d->data_buffer, d->size); + if (ret < 0) + return ret; + pdata = d->data_buffer; + seq_printf(s, "0x"); + for (i = 0; i < d->size; i++) + seq_printf(s, "%02x,", *(pdata + i)); + seq_printf(s, "\n"); + return 0; +} + +static int data_debug_open(struct inode *inode, struct file *file) +{ + if (file->f_mode & FMODE_READ) + return single_open(file, data_debug_show, inode->i_private); + return simple_open(inode, file); +} + +static ssize_t data_debug_write(struct file *file, + const char __user *user_buf, + size_t cnt, loff_t *loff) +{ + struct dbg_info *di = file->private_data; + struct dbg_internal *d = &di->internal; + void *buffer; + u8 *pdata; + char buf[PREALLOC_WBUFFER_SIZE + 1], *token, *cur; + int val_cnt = 0, ret; + + if (cnt > PREALLOC_WBUFFER_SIZE) + return -ENOMEM; + if (copy_from_user(buf, user_buf, cnt)) + return -EFAULT; + buf[cnt] = 0; + /* buffer size check */ + if (d->data_buffer_size < d->size) { + buffer = kzalloc(d->size, GFP_KERNEL); + if (!buffer) + return -ENOMEM; + kfree(d->data_buffer); + d->data_buffer = buffer; + d->data_buffer_size = d->size; + } + /* data parsing */ + cur = buf; + pdata = d->data_buffer; + while ((token = strsep(&cur, ",\n")) != NULL) { + if (!*token) + break; + if (val_cnt++ >= d->size) + break; + if (kstrtou8(token, 16, pdata++)) + return -EINVAL; + } + if (val_cnt != d->size) + return -EINVAL; + /* write transfer */ + if (!di->io_write) + return -EPERM; + ret = di->io_write(di->io_drvdata, d->reg, d->data_buffer, d->size); + return (ret < 0) ? ret : cnt; +} + +static int data_debug_release(struct inode *inode, struct file *file) +{ + if (file->f_mode & FMODE_READ) + return single_release(inode, file); + return 0; +} + +static const struct file_operations data_debug_fops = { + .open = data_debug_open, + .read = seq_read, + .write = data_debug_write, + .llseek = seq_lseek, + .release = data_debug_release, +}; + +static int type_debug_show(struct seq_file *s, void *data) +{ + struct dbg_info *di = s->private; + + seq_printf(s, "%s,%s\n", di->typestr, di->devname); + return 0; +} + +static int type_debug_open(struct inode *inode, struct file *file) +{ + return single_open(file, type_debug_show, inode->i_private); +} + +static const struct file_operations type_debug_fops = { + .open = type_debug_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static int dump_debug_show(struct seq_file *s, void *data) +{ + struct dbg_info *di = s->private; + struct mt6660_chip *chip = + container_of(di, struct mt6660_chip, dbg_info); + int i = 0, j = 0, ret = 0; + unsigned int val; + int size = 0; + + if (!chip) { + pr_err("%s chip is null\n", __func__); + return -ENODEV; + } + + for (i = 0; i < ARRAY_SIZE(mt6660_dump_table); i++) { + ret = regmap_read(chip->regmap, mt6660_dump_table[i], &val); + size = mt6660_get_reg_size(mt6660_dump_table[i]); + seq_printf(s, "reg0x%02x:0x", mt6660_dump_table[i]); + for (j = size - 1; j >= 0; j--) + seq_printf(s, "%x,", (val >> 8*j)&0xff); + seq_printf(s, "\n"); + } + return 0; +} + +static int dump_debug_open(struct inode *inode, struct file *file) +{ + return single_open(file, dump_debug_show, inode->i_private); +} + +static const struct file_operations dump_debug_fops = { + .open = dump_debug_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; + +static ssize_t lock_debug_read(struct file *file, + char __user *user_buf, size_t cnt, loff_t *loff) +{ + struct dbg_info *di = file->private_data; + struct dbg_internal *d = &di->internal; + char buf[10]; + + snprintf(buf, sizeof(buf), "%d\n", mutex_is_locked(&d->io_lock)); + return simple_read_from_buffer(user_buf, cnt, loff, buf, strlen(buf)); +} + +static ssize_t lock_debug_write(struct file *file, + const char __user *user_buf, + size_t cnt, loff_t *loff) +{ + struct dbg_info *di = file->private_data; + struct dbg_internal *d = &di->internal; + u32 lock; + int ret; + + ret = kstrtou32_from_user(user_buf, cnt, 0, &lock); + if (ret < 0) + return ret; + lock ? mutex_lock(&d->io_lock) : mutex_unlock(&d->io_lock); + return cnt; +} + +static const struct file_operations lock_debug_fops = { + .open = simple_open, + .read = lock_debug_read, + .write = lock_debug_write, +}; + +static int generic_debugfs_init(struct dbg_info *di) +{ + struct dbg_internal *d = &di->internal; + + /* valid check */ + if (!di->dirname || !di->devname || !di->typestr) + return -EINVAL; + d->data_buffer_size = PREALLOC_RBUFFER_SIZE; + d->data_buffer = kzalloc(PREALLOC_RBUFFER_SIZE, GFP_KERNEL); + if (!d->data_buffer) + return -ENOMEM; + /* create debugfs */ + d->rt_root = debugfs_lookup("ext_dev_io", NULL); + if (!d->rt_root) { + d->rt_root = debugfs_create_dir("ext_dev_io", NULL); + if (!d->rt_root) + return -ENODEV; + d->rt_dir_create = true; + } + d->ic_root = debugfs_create_dir(di->dirname, d->rt_root); + if (!d->ic_root) + goto err_cleanup_rt; + if (!debugfs_create_u16("reg", 0644, d->ic_root, &d->reg)) + goto err_cleanup_ic; + if (!debugfs_create_u16("size", 0644, d->ic_root, &d->size)) + goto err_cleanup_ic; + if (!debugfs_create_file("data", 0644, + d->ic_root, di, &data_debug_fops)) + goto err_cleanup_ic; + if (!debugfs_create_file("type", 0444, + d->ic_root, di, &type_debug_fops)) + goto err_cleanup_ic; + if (!debugfs_create_file("lock", 0644, + d->ic_root, di, &lock_debug_fops)) + goto err_cleanup_ic; + if (!debugfs_create_file("dumps", 0444, + d->ic_root, di, &dump_debug_fops)) + goto err_cleanup_ic; + mutex_init(&d->io_lock); + return 0; +err_cleanup_ic: + debugfs_remove_recursive(d->ic_root); +err_cleanup_rt: + if (d->rt_dir_create) + debugfs_remove_recursive(d->rt_root); + kfree(d->data_buffer); + return -ENODEV; +} + +static void generic_debugfs_exit(struct dbg_info *di) +{ + struct dbg_internal *d = &di->internal; + + mutex_destroy(&d->io_lock); + debugfs_remove_recursive(d->ic_root); + if (d->rt_dir_create) + debugfs_remove_recursive(d->rt_root); + kfree(d->data_buffer); +} +#else +static inline int generic_debugfs_init(struct dbg_info *di) +{ + return 0; +} + +static inline void generic_debugfs_exit(struct dbg_info *di) {} +#endif /* CONFIG_DEBUG_FS */ +#endif /* GENERIC_DEBUGFS */ + +/* + * MT6660 Generic Setting make this chip work normally. + * it is tuned by Richtek RDs. + */ +static const struct codec_reg_val generic_reg_inits[] = { + { MT6660_REG_WDT_CTRL, 0x80, 0x00 }, + { MT6660_REG_SPS_CTRL, 0x01, 0x00 }, + { MT6660_REG_AUDIO_IN2_SEL, 0x1c, 0x04 }, + { MT6660_REG_RESV11, 0x0c, 0x00 }, + { MT6660_REG_RESV31, 0x03, 0x03 }, + { MT6660_REG_RESV40, 0x01, 0x00 }, + { MT6660_REG_RESV0, 0x44, 0x04 }, + { MT6660_REG_RESV19, 0xff, 0x82 }, + { MT6660_REG_RESV17, 0x7777, 0x7273 }, + { MT6660_REG_RESV16, 0x07, 0x03 }, + { MT6660_REG_DRE_CORASE, 0xe0, 0x20 }, + { MT6660_REG_ADDA_CLOCK, 0xff, 0x70 }, + { MT6660_REG_RESV21, 0xff, 0x20 }, + { MT6660_REG_DRE_THDMODE, 0xff, 0x40 }, + { MT6660_REG_RESV23, 0xffff, 0x17f8 }, + { MT6660_REG_PWM_CTRL, 0xff, 0x15 }, + { MT6660_REG_ADC_USB_MODE, 0xff, 0x00 }, + { MT6660_REG_PROTECTION_CFG, 0xff, 0x1d }, + { MT6660_REG_HPF1_COEF, 0xffffffff, 0x7fdb7ffe }, + { MT6660_REG_HPF2_COEF, 0xffffffff, 0x7fdb7ffe }, + { MT6660_REG_SIG_GAIN, 0xff, 0x58 }, + { MT6660_REG_RESV6, 0xff, 0xce }, + { MT6660_REG_SIGMAX, 0xffff, 0x7fff }, + { MT6660_REG_DA_GAIN, 0xffff, 0x0116 }, + { MT6660_REG_TDM_CFG3, 0x1800, 0x0800 }, + { MT6660_REG_DRE_CTRL, 0x1f, 0x07 }, +}; + +static int mt6660_component_init_setting(struct snd_soc_component *component) +{ + int i, len, ret; + const struct codec_reg_val *init_table; + + pr_info("%s start\n", __func__); + init_table = generic_reg_inits; + len = ARRAY_SIZE(generic_reg_inits); + + for (i = 0; i < len; i++) { + ret = snd_soc_component_update_bits(component, + init_table[i].addr, + init_table[i].mask, init_table[i].data); + if (ret < 0) + return ret; + } + pr_info("%s end\n", __func__); + return 0; +} + +static int mt6660_component_set_bias_level(struct snd_soc_component *component, + enum snd_soc_bias_level level) +{ + struct snd_soc_dapm_context *dapm = + snd_soc_component_get_dapm(component); + struct mt6660_chip *chip = snd_soc_component_get_drvdata(component); + unsigned int val; + int ret = 0; + + switch (level) { + case SND_SOC_BIAS_OFF: + ret = regmap_read(chip->regmap, MT6660_REG_IRQ_STATUS1, &val); + dev_info(component->dev, + "%s reg0x05 = 0x%x\n", __func__, val); + break; + case SND_SOC_BIAS_ON: + case SND_SOC_BIAS_PREPARE: + /* Fall Through */ + case SND_SOC_BIAS_STANDBY: + default: + break; + } + dapm->bias_level = level; + dev_dbg(component->dev, "c bias_level = %d\n", level); + return 0; +} + +static int mt6660_codec_dac_event(struct snd_soc_dapm_widget *w, + struct snd_kcontrol *kcontrol, int event) +{ + switch (event) { + case SND_SOC_DAPM_POST_PMU: + usleep_range(1000, 1100); + break; + } + return 0; +} + +static int mt6660_codec_classd_event(struct snd_soc_dapm_widget *w, + struct snd_kcontrol *kcontrol, int event) +{ + struct snd_soc_component *component = + snd_soc_dapm_to_component(w->dapm); + int ret = 0; + + switch (event) { + case SND_SOC_DAPM_PRE_PMU: + dev_dbg(component->dev, + "%s: before classd turn on\n", __func__); + /* config to adaptive mode */ + ret = snd_soc_component_update_bits(component, + MT6660_REG_BST_CTRL, 0x03, 0x03); + if (ret < 0) { + dev_err(component->dev, "config mode adaptive fail\n"); + return ret; + } + break; + case SND_SOC_DAPM_POST_PMU: + /* voltage sensing enable */ + ret = snd_soc_component_update_bits(component, + MT6660_REG_RESV7, 0x04, 0x04); + if (ret < 0) { + dev_err(component->dev, + "enable voltage sensing fail\n"); + return ret; + } + break; + case SND_SOC_DAPM_PRE_PMD: + /* voltage sensing disable */ + ret = snd_soc_component_update_bits(component, + MT6660_REG_RESV7, 0x04, 0x00); + if (ret < 0) { + dev_err(component->dev, + "disable voltage sensing fail\n"); + return ret; + } + /* pop-noise improvement 1 */ + ret = snd_soc_component_update_bits(component, + MT6660_REG_RESV10, 0x10, 0x10); + if (ret < 0) { + dev_err(component->dev, + "pop-noise improvement 1 fail\n"); + return ret; + } + break; + case SND_SOC_DAPM_POST_PMD: + dev_dbg(component->dev, + "%s: after classd turn off\n", __func__); + /* pop-noise improvement 2 */ + ret = snd_soc_component_update_bits(component, + MT6660_REG_RESV10, 0x10, 0x00); + if (ret < 0) { + dev_err(component->dev, + "pop-noise improvement 2 fail\n"); + return ret; + } + /* config to off mode */ + ret = snd_soc_component_update_bits(component, + MT6660_REG_BST_CTRL, 0x03, 0x00); + if (ret < 0) { + dev_err(component->dev, "config mode off fail\n"); + return ret; + } + break; + } + return 0; +} + +static const struct snd_soc_dapm_widget mt6660_component_dapm_widgets[] = { + SND_SOC_DAPM_DAC_E("DAC", NULL, MT6660_REG_PLL_CFG1, + 0, 1, mt6660_codec_dac_event, SND_SOC_DAPM_POST_PMU), + SND_SOC_DAPM_ADC("VI ADC", NULL, SND_SOC_NOPM, 0, 0), + SND_SOC_DAPM_PGA("PGA", SND_SOC_NOPM, 0, 0, NULL, 0), + SND_SOC_DAPM_OUT_DRV_E("ClassD", MT6660_REG_SYSTEM_CTRL, 2, 0, + NULL, 0, mt6660_codec_classd_event, + SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | + SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), + SND_SOC_DAPM_OUTPUT("OUTP"), + SND_SOC_DAPM_OUTPUT("OUTN"), +}; + +static const struct snd_soc_dapm_route mt6660_component_dapm_routes[] = { + { "DAC", NULL, "aif_playback"}, + { "PGA", NULL, "DAC"}, + { "ClassD", NULL, "PGA"}, + { "OUTP", NULL, "ClassD"}, + { "OUTN", NULL, "ClassD"}, + { "VI ADC", NULL, "ClassD"}, + { "aif_capture", NULL, "VI ADC"}, +}; + +static int mt6660_component_put_volsw(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = + snd_soc_kcontrol_component(kcontrol); + int put_ret = 0; + + pm_runtime_get_sync(component->dev); + put_ret = snd_soc_put_volsw(kcontrol, ucontrol); + if (put_ret < 0) + return put_ret; + pm_runtime_put(component->dev); + return put_ret; +} + +static int mt6660_component_get_volsw(struct snd_kcontrol *kcontrol, + struct snd_ctl_elem_value *ucontrol) +{ + struct snd_soc_component *component = + snd_soc_kcontrol_component(kcontrol); + struct mt6660_chip *chip = (struct mt6660_chip *) + snd_soc_component_get_drvdata(component); + int ret = -EINVAL; + + if (!strcmp(kcontrol->id.name, "Chip_Rev")) { + ucontrol->value.integer.value[0] = chip->chip_rev & 0x0f; + ret = 0; + } + return ret; +} + +static const DECLARE_TLV_DB_SCALE(vol_ctl_tlv, -1155, 5, 0); + +static const struct snd_kcontrol_new mt6660_component_snd_controls[] = { + SOC_SINGLE_EXT_TLV("Digital Volume", MT6660_REG_VOL_CTRL, 0, 255, + 1, snd_soc_get_volsw, mt6660_component_put_volsw, + vol_ctl_tlv), + SOC_SINGLE_EXT("WDT Switch", MT6660_REG_WDT_CTRL, 7, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("Hard Clip Switch", MT6660_REG_HCLIP_CTRL, 8, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("Clip Switch", MT6660_REG_SPS_CTRL, 0, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("BoostMode", MT6660_REG_BST_CTRL, 0, 3, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("DRE Switch", MT6660_REG_DRE_CTRL, 0, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("DC_Protect Switch", + MT6660_REG_DC_PROTECT_CTRL, 3, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("audio input selection", MT6660_REG_DATAO_SEL, 6, 3, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("Data Output Left Channel Selection", + MT6660_REG_DATAO_SEL, 3, 7, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("Data Output Right Channel Selection", + MT6660_REG_DATAO_SEL, 0, 7, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + /* for debug purpose */ + SOC_SINGLE_EXT("HPF AUD IN Switch", MT6660_REG_HPF_CTRL, 0, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("AUD LOOP BACK Switch", MT6660_REG_PATH_BYPASS, 4, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("Mute Switch", MT6660_REG_SYSTEM_CTRL, 1, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("Bypass CS Comp Switch", MT6660_REG_PATH_BYPASS, 2, 1, 0, + snd_soc_get_volsw, mt6660_component_put_volsw), + SOC_SINGLE_EXT("T0 SEL", MT6660_REG_CALI_T0, 0, 7, 0, + snd_soc_get_volsw, NULL), + SOC_SINGLE_EXT("Chip Rev", SND_SOC_NOPM, 0, 16, 0, + mt6660_component_get_volsw, NULL), +}; + +static int mt6660_component_probe(struct snd_soc_component *component) +{ + struct mt6660_chip *chip = snd_soc_component_get_drvdata(component); + int ret = 0; + + pr_info("%s\n", __func__); + //snd_soc_component_init_regmap(component, chip->regmap); + + /* init chip setting */ + ret = mt6660_component_init_setting(component); + if (ret < 0) + dev_err(chip->dev, "chip i2c init setting fail\n"); + + return ret; +} + +static void mt6660_component_remove(struct snd_soc_component *component) +{ + pr_info("%s\n", __func__); + snd_soc_component_exit_regmap(component); +} + +static const struct snd_soc_component_driver mt6660_component_driver = { + .probe = mt6660_component_probe, + .remove = mt6660_component_remove, + .read = mt6660_component_io_read, + .write = mt6660_component_io_write, + + .controls = mt6660_component_snd_controls, + .num_controls = ARRAY_SIZE(mt6660_component_snd_controls), + .dapm_widgets = mt6660_component_dapm_widgets, + .num_dapm_widgets = ARRAY_SIZE(mt6660_component_dapm_widgets), + .dapm_routes = mt6660_component_dapm_routes, + .num_dapm_routes = ARRAY_SIZE(mt6660_component_dapm_routes), + + .set_bias_level = mt6660_component_set_bias_level, + .idle_bias_on = false, /* idle_bias_off = true */ +}; + +static int mt6660_component_aif_hw_params(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai) +{ + int word_len = params_physical_width(hw_params); + int aud_bit = params_width(hw_params); + u16 reg_data = 0; + int ret = 0; + + dev_dbg(dai->dev, "%s: ++\n", __func__); + dev_dbg(dai->dev, "format: 0x%08x\n", params_format(hw_params)); + dev_dbg(dai->dev, "rate: 0x%08x\n", params_rate(hw_params)); + dev_dbg(dai->dev, "word_len: %d, aud_bit: %d\n", word_len, aud_bit); + if (word_len > 32 || word_len < 16) { + dev_err(dai->dev, "not supported word length\n"); + return -ENOTSUPP; + } + switch (aud_bit) { + case 16: + reg_data = 3; + break; + case 18: + reg_data = 2; + break; + case 20: + reg_data = 1; + break; + case 24: + case 32: + reg_data = 0; + break; + default: + return -ENOTSUPP; + } + ret = snd_soc_component_update_bits(dai->component, + MT6660_REG_SERIAL_CFG1, 0xc0, (reg_data << 6)); + if (ret < 0) { + dev_err(dai->dev, "config aud bit fail\n"); + return ret; + } + ret = snd_soc_component_update_bits(dai->component, + MT6660_REG_TDM_CFG3, 0x3f0, word_len << 4); + if (ret < 0) { + dev_err(dai->dev, "config word len fail\n"); + return ret; + } + dev_dbg(dai->dev, "%s: --\n", __func__); + return 0; +} + +static const struct snd_soc_dai_ops mt6660_component_aif_ops = { + .hw_params = mt6660_component_aif_hw_params, +}; + +#define STUB_RATES SNDRV_PCM_RATE_8000_192000 +#define STUB_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ + SNDRV_PCM_FMTBIT_U16_LE | \ + SNDRV_PCM_FMTBIT_S24_LE | \ + SNDRV_PCM_FMTBIT_U24_LE | \ + SNDRV_PCM_FMTBIT_S32_LE | \ + SNDRV_PCM_FMTBIT_U32_LE) + +static struct snd_soc_dai_driver mt6660_codec_dai = { + .name = "mt6660-aif", + .playback = { + .stream_name = "aif_playback", + .channels_min = 1, + .channels_max = 2, + .rates = STUB_RATES, + .formats = STUB_FORMATS, + }, + .capture = { + .stream_name = "aif_capture", + .channels_min = 1, + .channels_max = 2, + .rates = STUB_RATES, + .formats = STUB_FORMATS, + }, + /* dai properties */ + .symmetric_rates = 1, + .symmetric_channels = 1, + .symmetric_samplebits = 1, + /* dai operations */ + .ops = &mt6660_component_aif_ops, +}; + +static inline int _mt6660_chip_id_check(struct mt6660_chip *chip) +{ + u8 id[2] = {0}; + int ret = 0; + + ret = i2c_smbus_read_i2c_block_data(chip->i2c, MT6660_REG_DEVID, 2, id); + if (ret < 0) + return ret; + ret = (id[0] << 8) + id[1]; + ret &= 0x0ff0; + if (ret != 0x00e0 && ret != 0x01e0) + return -ENODEV; + return ret; +} + +static inline int _mt6660_chip_sw_reset(struct mt6660_chip *chip) +{ + int ret; + + /* turn on main pll first, then trigger reset */ + ret = regmap_write(chip->regmap, 0x03, 0x00); + if (ret < 0) + return ret; + ret = regmap_write(chip->regmap, MT6660_REG_SYSTEM_CTRL, 0x80); + msleep(30); + return 0; +} + +static inline int _mt6660_chip_power_on(struct mt6660_chip *chip, int on_off) +{ + u8 reg_data = 0; + int ret = 0; + + ret = i2c_smbus_read_byte_data(chip->i2c, MT6660_REG_SYSTEM_CTRL); + if (ret < 0) + return ret; + reg_data = (u8)ret; + if (on_off) + reg_data &= (~0x01); + else + reg_data |= 0x01; + return regmap_write(chip->regmap, MT6660_REG_SYSTEM_CTRL, reg_data); +} + +static inline int _mt6660_read_chip_revision(struct mt6660_chip *chip) +{ + u8 reg_data[2] = {0}; + int ret = 0; + + ret = i2c_smbus_read_i2c_block_data( + chip->i2c, MT6660_REG_DEVID, 2, reg_data); + if (ret < 0) { + dev_err(chip->dev, "get chip revision fail\n"); + return ret; + } + chip->chip_rev = reg_data[1]; + return 0; +} + +static int mt6660_i2c_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + struct mt6660_chip *chip = NULL; + int ret = 0; + + pr_info("%s start\n", __func__); + chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL); + if (!chip) + return -ENOMEM; + chip->i2c = client; + chip->dev = &client->dev; + mutex_init(&chip->io_lock); + i2c_set_clientdata(client, chip); + + chip->regmap = devm_regmap_init(&client->dev, + NULL, chip, &mt6660_regmap_config); + if (IS_ERR(chip->regmap)) { + ret = PTR_ERR(chip->regmap); + dev_err(&client->dev, "failed to initialise regmap: %d\n", ret); + return ret; + } + +#if GENERIC_DEBUGFS + /* debugfs interface */ + chip->dbg_info.dirname = devm_kasprintf(&client->dev, + GFP_KERNEL, "MT6660.%s", + dev_name(&client->dev)); + chip->dbg_info.devname = dev_name(&client->dev); + chip->dbg_info.typestr = devm_kasprintf(&client->dev, + GFP_KERNEL, "I2C,MT6660"); + chip->dbg_info.io_drvdata = chip; + chip->dbg_info.io_read = mt6660_dbg_io_read; + chip->dbg_info.io_write = mt6660_dbg_io_write; + + ret = generic_debugfs_init(&chip->dbg_info); + if (ret < 0) { + dev_err(&client->dev, "generic dbg init fail\n"); + return -EINVAL; + } +#endif /* GENERIC_DEBUGFS */ + + /* chip reset first */ + ret = _mt6660_chip_sw_reset(chip); + if (ret < 0) { + dev_err(chip->dev, "chip reset fail\n"); + goto probe_fail; + } + /* chip power on */ + ret = _mt6660_chip_power_on(chip, 1); + if (ret < 0) { + dev_err(chip->dev, "chip power on 2 fail\n"); + goto probe_fail; + } + /* chip devid check */ + ret = _mt6660_chip_id_check(chip); + if (ret < 0) { + dev_err(chip->dev, "chip id check fail\n"); + goto probe_fail; + } + /* chip revision get */ + ret = _mt6660_read_chip_revision(chip); + if (ret < 0) { + dev_err(chip->dev, "read chip revision fail\n"); + goto probe_fail; + } + pm_runtime_set_active(chip->dev); + pm_runtime_enable(chip->dev); + + ret = devm_snd_soc_register_component(chip->dev, + &mt6660_component_driver, + &mt6660_codec_dai, 1); + pr_info("%s end, ret = %d\n", __func__, ret); + return ret; +probe_fail: + _mt6660_chip_power_on(chip, 0); + mutex_destroy(&chip->io_lock); + return ret; +} + +static int mt6660_i2c_remove(struct i2c_client *client) +{ + struct mt6660_chip *chip = i2c_get_clientdata(client); + + pm_runtime_disable(chip->dev); + pm_runtime_set_suspended(chip->dev); +#if GENERIC_DEBUGFS + generic_debugfs_exit(&chip->dbg_info); +#endif /* GENERIC_DEBUGFS */ + mutex_destroy(&chip->io_lock); + return 0; +} + +static int __maybe_unused mt6660_i2c_runtime_suspend(struct device *dev) +{ + struct mt6660_chip *chip = dev_get_drvdata(dev); + + dev_dbg(dev, "enter low power mode\n"); + return regmap_update_bits(chip->regmap, + MT6660_REG_SYSTEM_CTRL, 0x01, 0x01); +} + +static int __maybe_unused mt6660_i2c_runtime_resume(struct device *dev) +{ + struct mt6660_chip *chip = dev_get_drvdata(dev); + + dev_dbg(dev, "exit low power mode\n"); + return regmap_update_bits(chip->regmap, + MT6660_REG_SYSTEM_CTRL, 0x01, 0x00); +} + +static const struct dev_pm_ops mt6660_dev_pm_ops = { + SET_RUNTIME_PM_OPS(mt6660_i2c_runtime_suspend, + mt6660_i2c_runtime_resume, NULL) +}; + +static const struct of_device_id __maybe_unused mt6660_of_id[] = { + { .compatible = "mediatek,mt6660",}, + {}, +}; +MODULE_DEVICE_TABLE(of, mt6660_of_id); + +static const struct i2c_device_id mt6660_i2c_id[] = { + {"mt6660", 0 }, + {}, +}; +MODULE_DEVICE_TABLE(i2c, mt6660_i2c_id); + +static struct i2c_driver mt6660_i2c_driver = { + .driver = { + .name = "mt6660", + .of_match_table = of_match_ptr(mt6660_of_id), + .pm = &mt6660_dev_pm_ops, + }, + .probe = mt6660_i2c_probe, + .remove = mt6660_i2c_remove, + .id_table = mt6660_i2c_id, +}; +module_i2c_driver(mt6660_i2c_driver); + +MODULE_AUTHOR("Jeff Chang jeff_chang@richtek.com"); +MODULE_DESCRIPTION("MT6660 SPKAMP Driver"); +MODULE_LICENSE("GPL"); +MODULE_VERSION("1.0.7_G"); diff --git a/sound/soc/codecs/mt6660.h b/sound/soc/codecs/mt6660.h new file mode 100644 index 0000000..9e62dcc --- /dev/null +++ b/sound/soc/codecs/mt6660.h @@ -0,0 +1,95 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Copyright (c) 2019 MediaTek Inc. + */ + +#ifndef __SND_SOC_MT6660_H +#define __SND_SOC_MT6660_H + +#include <linux/mutex.h> +#include <linux/regmap.h> + +#define GENERIC_DEBUGFS 0 + +#if GENERIC_DEBUGFS +struct dbg_internal { + struct dentry *rt_root; + struct dentry *ic_root; + bool rt_dir_create; + struct mutex io_lock; + u16 reg; + u16 size; + u16 data_buffer_size; + void *data_buffer; +}; + +struct dbg_info { + const char *dirname; + const char *devname; + const char *typestr; + void *io_drvdata; + int (*io_read)(void *drvdata, u16 reg, void *val, u16 size); + int (*io_write)(void *drvdata, u16 reg, const void *val, u16 size); + struct dbg_internal internal; +}; +#endif /* GENERIC_DEBUGFS */ + +struct mt6660_chip { + struct i2c_client *i2c; + struct device *dev; + struct platform_device *param_dev; + struct mutex io_lock; +#if GENERIC_DEBUGFS + struct dbg_info dbg_info; +#endif /* GENERIC_DEBUGFS */ + struct regmap *regmap; + u16 chip_rev; +}; + +#define MT6660_REG_DEVID (0x00) +#define MT6660_REG_SYSTEM_CTRL (0x03) +#define MT6660_REG_IRQ_STATUS1 (0x05) +#define MT6660_REG_ADDA_CLOCK (0x07) +#define MT6660_REG_SERIAL_CFG1 (0x10) +#define MT6660_REG_DATAO_SEL (0x12) +#define MT6660_REG_TDM_CFG3 (0x15) +#define MT6660_REG_HPF_CTRL (0x18) +#define MT6660_REG_HPF1_COEF (0x1A) +#define MT6660_REG_HPF2_COEF (0x1B) +#define MT6660_REG_PATH_BYPASS (0x1E) +#define MT6660_REG_WDT_CTRL (0x20) +#define MT6660_REG_HCLIP_CTRL (0x24) +#define MT6660_REG_VOL_CTRL (0x29) +#define MT6660_REG_SPS_CTRL (0x30) +#define MT6660_REG_SIGMAX (0x33) +#define MT6660_REG_CALI_T0 (0x3F) +#define MT6660_REG_BST_CTRL (0x40) +#define MT6660_REG_PROTECTION_CFG (0x46) +#define MT6660_REG_DA_GAIN (0x4c) +#define MT6660_REG_AUDIO_IN2_SEL (0x50) +#define MT6660_REG_SIG_GAIN (0x51) +#define MT6660_REG_PLL_CFG1 (0x60) +#define MT6660_REG_DRE_CTRL (0x68) +#define MT6660_REG_DRE_THDMODE (0x69) +#define MT6660_REG_DRE_CORASE (0x6B) +#define MT6660_REG_PWM_CTRL (0x70) +#define MT6660_REG_DC_PROTECT_CTRL (0x74) +#define MT6660_REG_ADC_USB_MODE (0x7c) +#define MT6660_REG_INTERNAL_CFG (0x88) +#define MT6660_REG_RESV0 (0x98) +#define MT6660_REG_RESV1 (0x99) +#define MT6660_REG_RESV2 (0x9A) +#define MT6660_REG_RESV3 (0x9B) +#define MT6660_REG_RESV6 (0xA2) +#define MT6660_REG_RESV7 (0xA3) +#define MT6660_REG_RESV10 (0xB0) +#define MT6660_REG_RESV11 (0xB1) +#define MT6660_REG_RESV16 (0xB6) +#define MT6660_REG_RESV17 (0xB7) +#define MT6660_REG_RESV19 (0xB9) +#define MT6660_REG_RESV21 (0xBB) +#define MT6660_REG_RESV23 (0xBD) +#define MT6660_REG_RESV31 (0xD3) +#define MT6660_REG_RESV40 (0xE0) + +#endif /* __SND_SOC_MT6660_H */
On 12/12/2019 12:08, Jeff Chang wrote:
The MT6660 is a boosted BTL class-D amplifier with V/I sensing. A built-in DC-DC step-up converter is used to provide efficient power for class-D amplifier with multi-level class-G operation. The digital audio interface supports I2S, left-justified, right-justified, TDM and DSP A/B format for audio in with a data out used for chip information like voltage sense and current sense, which are able to be monitored via DATAO through proper
^^^ why are there spaces here?
If you send a new version of the patch then please send it with prefix [PATCH v2], [PATCH v3] etc so that everybody knows about it.
Also normally you should provide a changelog to older versions which goes below the line "---".
This will help reviewers to understand quickly what you fixed.
Regards, Matthias
sound/soc/codecs/Kconfig | 14 + sound/soc/codecs/Makefile | 2 + sound/soc/codecs/mt6660.c | 1063 +++++++++++++++++++++++++++++++++++++++++++++ sound/soc/codecs/mt6660.h | 95 ++++ 4 files changed, 1174 insertions(+) create mode 100644 sound/soc/codecs/mt6660.c create mode 100644 sound/soc/codecs/mt6660.h
diff --git a/sound/soc/codecs/Kconfig b/sound/soc/codecs/Kconfig index 229cc89..806cd03 100644 --- a/sound/soc/codecs/Kconfig +++ b/sound/soc/codecs/Kconfig @@ -122,6 +122,7 @@ config SND_SOC_ALL_CODECS select SND_SOC_ML26124 if I2C select SND_SOC_MT6351 if MTK_PMIC_WRAP select SND_SOC_MT6358 if MTK_PMIC_WRAP
- select SND_SOC_MT6660 if I2C select SND_SOC_NAU8540 if I2C select SND_SOC_NAU8810 if I2C select SND_SOC_NAU8822 if I2C
@@ -1465,6 +1466,19 @@ config SND_SOC_MT6358 Enable support for the platform which uses MT6358 as external codec device.
+config SND_SOC_MT6660
- tristate "Mediatek MT6660 Speaker Amplifier"
- depends on I2C
- select CRC32
- select CRYPTO_SHA256
- select CRYTO_RSA
- help
MediaTek MT6660 is a smart power amplifier which contain
speaker protection, multi-band DRC, equalizer functions.
Select N if you don't have MT6660 on board.
Select M to build this as module.
config SND_SOC_NAU8540 tristate "Nuvoton Technology Corporation NAU85L40 CODEC" depends on I2C diff --git a/sound/soc/codecs/Makefile b/sound/soc/codecs/Makefile index c498373..2b6814c 100644 --- a/sound/soc/codecs/Makefile +++ b/sound/soc/codecs/Makefile @@ -119,6 +119,7 @@ snd-soc-msm8916-analog-objs := msm8916-wcd-analog.o snd-soc-msm8916-digital-objs := msm8916-wcd-digital.o snd-soc-mt6351-objs := mt6351.o snd-soc-mt6358-objs := mt6358.o +snd-soc-mt6660-objs := mt6660.o snd-soc-nau8540-objs := nau8540.o snd-soc-nau8810-objs := nau8810.o snd-soc-nau8822-objs := nau8822.o @@ -403,6 +404,7 @@ obj-$(CONFIG_SND_SOC_MSM8916_WCD_ANALOG) +=snd-soc-msm8916-analog.o obj-$(CONFIG_SND_SOC_MSM8916_WCD_DIGITAL) +=snd-soc-msm8916-digital.o obj-$(CONFIG_SND_SOC_MT6351) += snd-soc-mt6351.o obj-$(CONFIG_SND_SOC_MT6358) += snd-soc-mt6358.o +obj-$(CONFIG_SND_SOC_MT6660) += snd-soc-mt6660.o obj-$(CONFIG_SND_SOC_NAU8540) += snd-soc-nau8540.o obj-$(CONFIG_SND_SOC_NAU8810) += snd-soc-nau8810.o obj-$(CONFIG_SND_SOC_NAU8822) += snd-soc-nau8822.o diff --git a/sound/soc/codecs/mt6660.c b/sound/soc/codecs/mt6660.c new file mode 100644 index 0000000..5ba8ec5 --- /dev/null +++ b/sound/soc/codecs/mt6660.c @@ -0,0 +1,1063 @@ +// SPDX-License-Identifier: GPL-2.0 +/*
- Copyright (c) 2019 MediaTek Inc.
- */
+#include <linux/module.h> +#include <linux/kernel.h> +#include <linux/version.h> +#include <linux/err.h> +#include <linux/i2c.h> +#include <linux/pm_runtime.h> +#include <linux/delay.h> +#include <sound/soc.h> +#include <sound/tlv.h> +#include <sound/pcm_params.h> +#include <linux/debugfs.h>
+#include "mt6660.h"
+struct codec_reg_val {
- u32 addr;
- u32 mask;
- u32 data;
+};
+struct reg_size_table {
- u32 addr;
- u8 size;
+};
+static const struct reg_size_table mt6660_reg_size_table[] = {
- { MT6660_REG_HPF1_COEF, 4 },
- { MT6660_REG_HPF2_COEF, 4 },
- { MT6660_REG_TDM_CFG3, 2 },
- { MT6660_REG_RESV17, 2 },
- { MT6660_REG_RESV23, 2 },
- { MT6660_REG_SIGMAX, 2 },
- { MT6660_REG_DEVID, 2},
- { MT6660_REG_TDM_CFG3, 2},
- { MT6660_REG_HCLIP_CTRL, 2},
- { MT6660_REG_DA_GAIN, 2},
+};
+static int mt6660_get_reg_size(uint32_t addr) +{
- int i = 0;
- for (i = 0; i < ARRAY_SIZE(mt6660_reg_size_table); i++) {
if (mt6660_reg_size_table[i].addr == addr)
return mt6660_reg_size_table[i].size;
- }
- return 1;
+}
+#if GENERIC_DEBUGFS +static int mt6660_dbg_io_read(void *drvdata, u16 reg, void *val, u16 size) +{
- struct mt6660_chip *chip = (struct mt6660_chip *)drvdata;
- int ret = 0, i = 0;
- unsigned int data;
- u8 *_val = val;
- if (size != 1 && size != 2 && size != 4) {
dev_err(chip->dev, "%s size not match\n", __func__);
return -EINVAL;
- }
- ret = regmap_read(chip->regmap, reg, &data);
- if (reg < 0)
return ret;
- for (i = 0; i < size; i++)
_val[size-i-1] = (data >> (8*i))&0xff;
- return 0;
+}
+static int mt6660_dbg_io_write(void *drvdata, u16 reg,
const void *val, u16 size)
+{
- struct mt6660_chip *chip = (struct mt6660_chip *)drvdata;
- int reg_size = mt6660_get_reg_size(reg);
- int i = 0;
- unsigned int regval = 0;
- u8 *_val = (u8 *)val;
- if (size != reg_size) {
dev_err(chip->dev,
"%s size not match reg_size(%d), size(%d)\n",
__func__, reg_size, size);
return -EINVAL;
- }
- for (i = 0; i < size; i++) {
regval <<= 8;
regval |= _val[i];
- }
- return regmap_write(chip->regmap, reg, regval);
+} +#endif /* GENERIC_DEBUGFS */
+static int mt6660_reg_write(void *context, unsigned int reg, unsigned int val) +{
- struct mt6660_chip *chip = context;
- int size = mt6660_get_reg_size(reg);
- u8 reg_data[4] = {0};
- int i = 0;
- for (i = 0; i < size; i++)
reg_data[size - i - 1] = (val >> (8 * i)) & 0xff;
- return i2c_smbus_write_i2c_block_data(chip->i2c, reg, size, reg_data);
+}
+static int mt6660_reg_read(void *context, unsigned int reg, unsigned int *val) +{
- struct mt6660_chip *chip = context;
- int size = mt6660_get_reg_size(reg);
- int i = 0, ret = 0;
- u8 data[4] = {0};
- u32 reg_data = 0;
- ret = i2c_smbus_read_i2c_block_data(chip->i2c, reg, size, data);
- if (ret < 0)
return ret;
- for (i = 0; i < size; i++) {
reg_data <<= 8;
reg_data |= data[i];
- }
- *val = reg_data;
- return ret;
+}
+static bool mt6660_volatile_reg(struct device *dev, unsigned int reg) +{
- return true;
+}
+static struct regmap_config mt6660_regmap_config = {
- .reg_bits = 8,
- .val_bits = 32,
- .reg_write = mt6660_reg_write,
- .reg_read = mt6660_reg_read,
- .volatile_reg = mt6660_volatile_reg,
+};
+static unsigned int mt6660_component_io_read(
- struct snd_soc_component *component, unsigned int reg)
+{
- struct mt6660_chip *chip = snd_soc_component_get_drvdata(component);
- unsigned int val;
- int ret;
- ret = regmap_read(chip->regmap, reg, &val);
- if (ret < 0) /* ret success -> >= 0, fail -> < - */
return ret;
- pr_err("%s val = 0x%x\n", __func__, val);
- return val;
+}
+static int mt6660_component_io_write(struct snd_soc_component *component,
- unsigned int reg, unsigned int data)
+{
- struct mt6660_chip *chip = snd_soc_component_get_drvdata(component);
- pr_err("%s data = 0x%x\n", __func__, data);
- return regmap_write(chip->regmap, reg, data);
+}
+static const int mt6660_dump_table[] = {
- MT6660_REG_DEVID,
- MT6660_REG_SYSTEM_CTRL,
- MT6660_REG_IRQ_STATUS1,
- MT6660_REG_ADDA_CLOCK,
- MT6660_REG_SERIAL_CFG1,
- MT6660_REG_DATAO_SEL,
- MT6660_REG_TDM_CFG3,
- MT6660_REG_HPF_CTRL,
- MT6660_REG_HPF1_COEF,
- MT6660_REG_HPF2_COEF,
- MT6660_REG_PATH_BYPASS,
- MT6660_REG_WDT_CTRL,
- MT6660_REG_HCLIP_CTRL,
- MT6660_REG_VOL_CTRL,
- MT6660_REG_SPS_CTRL,
- MT6660_REG_SIGMAX,
- MT6660_REG_CALI_T0,
- MT6660_REG_BST_CTRL,
- MT6660_REG_PROTECTION_CFG,
- MT6660_REG_DA_GAIN,
- MT6660_REG_AUDIO_IN2_SEL,
- MT6660_REG_SIG_GAIN,
- MT6660_REG_PLL_CFG1,
- MT6660_REG_DRE_CTRL,
- MT6660_REG_DRE_THDMODE,
- MT6660_REG_DRE_CORASE,
- MT6660_REG_PWM_CTRL,
- MT6660_REG_DC_PROTECT_CTRL,
- MT6660_REG_ADC_USB_MODE,
- MT6660_REG_INTERNAL_CFG,
- MT6660_REG_RESV0,
- MT6660_REG_RESV1,
- MT6660_REG_RESV2,
- MT6660_REG_RESV3,
- MT6660_REG_RESV7,
- MT6660_REG_RESV10,
- MT6660_REG_RESV11,
- MT6660_REG_RESV16,
- MT6660_REG_RESV17,
- MT6660_REG_RESV19,
- MT6660_REG_RESV21,
- MT6660_REG_RESV23,
- MT6660_REG_RESV31,
- MT6660_REG_RESV40,
+};
+#if GENERIC_DEBUGFS +#ifdef CONFIG_DEBUG_FS +/* reg/size/data/bustype */ +#define PREALLOC_RBUFFER_SIZE (32) +#define PREALLOC_WBUFFER_SIZE (1000)
+static int data_debug_show(struct seq_file *s, void *data) +{
- struct dbg_info *di = s->private;
- struct dbg_internal *d = &di->internal;
- void *buffer;
- u8 *pdata;
- int i, ret;
- if (d->data_buffer_size < d->size) {
buffer = kzalloc(d->size, GFP_KERNEL);
if (!buffer)
return -ENOMEM;
kfree(d->data_buffer);
d->data_buffer = buffer;
d->data_buffer_size = d->size;
- }
- /* read transfer */
- if (!di->io_read)
return -EPERM;
- ret = di->io_read(di->io_drvdata, d->reg, d->data_buffer, d->size);
- if (ret < 0)
return ret;
- pdata = d->data_buffer;
- seq_printf(s, "0x");
- for (i = 0; i < d->size; i++)
seq_printf(s, "%02x,", *(pdata + i));
- seq_printf(s, "\n");
- return 0;
+}
+static int data_debug_open(struct inode *inode, struct file *file) +{
- if (file->f_mode & FMODE_READ)
return single_open(file, data_debug_show, inode->i_private);
- return simple_open(inode, file);
+}
+static ssize_t data_debug_write(struct file *file,
const char __user *user_buf,
size_t cnt, loff_t *loff)
+{
- struct dbg_info *di = file->private_data;
- struct dbg_internal *d = &di->internal;
- void *buffer;
- u8 *pdata;
- char buf[PREALLOC_WBUFFER_SIZE + 1], *token, *cur;
- int val_cnt = 0, ret;
- if (cnt > PREALLOC_WBUFFER_SIZE)
return -ENOMEM;
- if (copy_from_user(buf, user_buf, cnt))
return -EFAULT;
- buf[cnt] = 0;
- /* buffer size check */
- if (d->data_buffer_size < d->size) {
buffer = kzalloc(d->size, GFP_KERNEL);
if (!buffer)
return -ENOMEM;
kfree(d->data_buffer);
d->data_buffer = buffer;
d->data_buffer_size = d->size;
- }
- /* data parsing */
- cur = buf;
- pdata = d->data_buffer;
- while ((token = strsep(&cur, ",\n")) != NULL) {
if (!*token)
break;
if (val_cnt++ >= d->size)
break;
if (kstrtou8(token, 16, pdata++))
return -EINVAL;
- }
- if (val_cnt != d->size)
return -EINVAL;
- /* write transfer */
- if (!di->io_write)
return -EPERM;
- ret = di->io_write(di->io_drvdata, d->reg, d->data_buffer, d->size);
- return (ret < 0) ? ret : cnt;
+}
+static int data_debug_release(struct inode *inode, struct file *file) +{
- if (file->f_mode & FMODE_READ)
return single_release(inode, file);
- return 0;
+}
+static const struct file_operations data_debug_fops = {
- .open = data_debug_open,
- .read = seq_read,
- .write = data_debug_write,
- .llseek = seq_lseek,
- .release = data_debug_release,
+};
+static int type_debug_show(struct seq_file *s, void *data) +{
- struct dbg_info *di = s->private;
- seq_printf(s, "%s,%s\n", di->typestr, di->devname);
- return 0;
+}
+static int type_debug_open(struct inode *inode, struct file *file) +{
- return single_open(file, type_debug_show, inode->i_private);
+}
+static const struct file_operations type_debug_fops = {
- .open = type_debug_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = single_release,
+};
+static int dump_debug_show(struct seq_file *s, void *data) +{
- struct dbg_info *di = s->private;
- struct mt6660_chip *chip =
container_of(di, struct mt6660_chip, dbg_info);
- int i = 0, j = 0, ret = 0;
- unsigned int val;
- int size = 0;
- if (!chip) {
pr_err("%s chip is null\n", __func__);
return -ENODEV;
- }
- for (i = 0; i < ARRAY_SIZE(mt6660_dump_table); i++) {
ret = regmap_read(chip->regmap, mt6660_dump_table[i], &val);
size = mt6660_get_reg_size(mt6660_dump_table[i]);
seq_printf(s, "reg0x%02x:0x", mt6660_dump_table[i]);
for (j = size - 1; j >= 0; j--)
seq_printf(s, "%x,", (val >> 8*j)&0xff);
seq_printf(s, "\n");
- }
- return 0;
+}
+static int dump_debug_open(struct inode *inode, struct file *file) +{
- return single_open(file, dump_debug_show, inode->i_private);
+}
+static const struct file_operations dump_debug_fops = {
- .open = dump_debug_open,
- .read = seq_read,
- .llseek = seq_lseek,
- .release = single_release,
+};
+static ssize_t lock_debug_read(struct file *file,
char __user *user_buf, size_t cnt, loff_t *loff)
+{
- struct dbg_info *di = file->private_data;
- struct dbg_internal *d = &di->internal;
- char buf[10];
- snprintf(buf, sizeof(buf), "%d\n", mutex_is_locked(&d->io_lock));
- return simple_read_from_buffer(user_buf, cnt, loff, buf, strlen(buf));
+}
+static ssize_t lock_debug_write(struct file *file,
const char __user *user_buf,
size_t cnt, loff_t *loff)
+{
- struct dbg_info *di = file->private_data;
- struct dbg_internal *d = &di->internal;
- u32 lock;
- int ret;
- ret = kstrtou32_from_user(user_buf, cnt, 0, &lock);
- if (ret < 0)
return ret;
- lock ? mutex_lock(&d->io_lock) : mutex_unlock(&d->io_lock);
- return cnt;
+}
+static const struct file_operations lock_debug_fops = {
- .open = simple_open,
- .read = lock_debug_read,
- .write = lock_debug_write,
+};
+static int generic_debugfs_init(struct dbg_info *di) +{
- struct dbg_internal *d = &di->internal;
- /* valid check */
- if (!di->dirname || !di->devname || !di->typestr)
return -EINVAL;
- d->data_buffer_size = PREALLOC_RBUFFER_SIZE;
- d->data_buffer = kzalloc(PREALLOC_RBUFFER_SIZE, GFP_KERNEL);
- if (!d->data_buffer)
return -ENOMEM;
- /* create debugfs */
- d->rt_root = debugfs_lookup("ext_dev_io", NULL);
- if (!d->rt_root) {
d->rt_root = debugfs_create_dir("ext_dev_io", NULL);
if (!d->rt_root)
return -ENODEV;
d->rt_dir_create = true;
- }
- d->ic_root = debugfs_create_dir(di->dirname, d->rt_root);
- if (!d->ic_root)
goto err_cleanup_rt;
- if (!debugfs_create_u16("reg", 0644, d->ic_root, &d->reg))
goto err_cleanup_ic;
- if (!debugfs_create_u16("size", 0644, d->ic_root, &d->size))
goto err_cleanup_ic;
- if (!debugfs_create_file("data", 0644,
d->ic_root, di, &data_debug_fops))
goto err_cleanup_ic;
- if (!debugfs_create_file("type", 0444,
d->ic_root, di, &type_debug_fops))
goto err_cleanup_ic;
- if (!debugfs_create_file("lock", 0644,
d->ic_root, di, &lock_debug_fops))
goto err_cleanup_ic;
- if (!debugfs_create_file("dumps", 0444,
d->ic_root, di, &dump_debug_fops))
goto err_cleanup_ic;
- mutex_init(&d->io_lock);
- return 0;
+err_cleanup_ic:
- debugfs_remove_recursive(d->ic_root);
+err_cleanup_rt:
- if (d->rt_dir_create)
debugfs_remove_recursive(d->rt_root);
- kfree(d->data_buffer);
- return -ENODEV;
+}
+static void generic_debugfs_exit(struct dbg_info *di) +{
- struct dbg_internal *d = &di->internal;
- mutex_destroy(&d->io_lock);
- debugfs_remove_recursive(d->ic_root);
- if (d->rt_dir_create)
debugfs_remove_recursive(d->rt_root);
- kfree(d->data_buffer);
+} +#else +static inline int generic_debugfs_init(struct dbg_info *di) +{
- return 0;
+}
+static inline void generic_debugfs_exit(struct dbg_info *di) {} +#endif /* CONFIG_DEBUG_FS */ +#endif /* GENERIC_DEBUGFS */
+/*
- MT6660 Generic Setting make this chip work normally.
- it is tuned by Richtek RDs.
- */
+static const struct codec_reg_val generic_reg_inits[] = {
- { MT6660_REG_WDT_CTRL, 0x80, 0x00 },
- { MT6660_REG_SPS_CTRL, 0x01, 0x00 },
- { MT6660_REG_AUDIO_IN2_SEL, 0x1c, 0x04 },
- { MT6660_REG_RESV11, 0x0c, 0x00 },
- { MT6660_REG_RESV31, 0x03, 0x03 },
- { MT6660_REG_RESV40, 0x01, 0x00 },
- { MT6660_REG_RESV0, 0x44, 0x04 },
- { MT6660_REG_RESV19, 0xff, 0x82 },
- { MT6660_REG_RESV17, 0x7777, 0x7273 },
- { MT6660_REG_RESV16, 0x07, 0x03 },
- { MT6660_REG_DRE_CORASE, 0xe0, 0x20 },
- { MT6660_REG_ADDA_CLOCK, 0xff, 0x70 },
- { MT6660_REG_RESV21, 0xff, 0x20 },
- { MT6660_REG_DRE_THDMODE, 0xff, 0x40 },
- { MT6660_REG_RESV23, 0xffff, 0x17f8 },
- { MT6660_REG_PWM_CTRL, 0xff, 0x15 },
- { MT6660_REG_ADC_USB_MODE, 0xff, 0x00 },
- { MT6660_REG_PROTECTION_CFG, 0xff, 0x1d },
- { MT6660_REG_HPF1_COEF, 0xffffffff, 0x7fdb7ffe },
- { MT6660_REG_HPF2_COEF, 0xffffffff, 0x7fdb7ffe },
- { MT6660_REG_SIG_GAIN, 0xff, 0x58 },
- { MT6660_REG_RESV6, 0xff, 0xce },
- { MT6660_REG_SIGMAX, 0xffff, 0x7fff },
- { MT6660_REG_DA_GAIN, 0xffff, 0x0116 },
- { MT6660_REG_TDM_CFG3, 0x1800, 0x0800 },
- { MT6660_REG_DRE_CTRL, 0x1f, 0x07 },
+};
+static int mt6660_component_init_setting(struct snd_soc_component *component) +{
- int i, len, ret;
- const struct codec_reg_val *init_table;
- pr_info("%s start\n", __func__);
- init_table = generic_reg_inits;
- len = ARRAY_SIZE(generic_reg_inits);
- for (i = 0; i < len; i++) {
ret = snd_soc_component_update_bits(component,
init_table[i].addr,
init_table[i].mask, init_table[i].data);
if (ret < 0)
return ret;
- }
- pr_info("%s end\n", __func__);
- return 0;
+}
+static int mt6660_component_set_bias_level(struct snd_soc_component *component,
- enum snd_soc_bias_level level)
+{
- struct snd_soc_dapm_context *dapm =
snd_soc_component_get_dapm(component);
- struct mt6660_chip *chip = snd_soc_component_get_drvdata(component);
- unsigned int val;
- int ret = 0;
- switch (level) {
- case SND_SOC_BIAS_OFF:
ret = regmap_read(chip->regmap, MT6660_REG_IRQ_STATUS1, &val);
dev_info(component->dev,
"%s reg0x05 = 0x%x\n", __func__, val);
break;
- case SND_SOC_BIAS_ON:
- case SND_SOC_BIAS_PREPARE:
- /* Fall Through */
- case SND_SOC_BIAS_STANDBY:
- default:
break;
- }
- dapm->bias_level = level;
- dev_dbg(component->dev, "c bias_level = %d\n", level);
- return 0;
+}
+static int mt6660_codec_dac_event(struct snd_soc_dapm_widget *w,
- struct snd_kcontrol *kcontrol, int event)
+{
- switch (event) {
- case SND_SOC_DAPM_POST_PMU:
usleep_range(1000, 1100);
break;
- }
- return 0;
+}
+static int mt6660_codec_classd_event(struct snd_soc_dapm_widget *w,
- struct snd_kcontrol *kcontrol, int event)
+{
- struct snd_soc_component *component =
snd_soc_dapm_to_component(w->dapm);
- int ret = 0;
- switch (event) {
- case SND_SOC_DAPM_PRE_PMU:
dev_dbg(component->dev,
"%s: before classd turn on\n", __func__);
/* config to adaptive mode */
ret = snd_soc_component_update_bits(component,
MT6660_REG_BST_CTRL, 0x03, 0x03);
if (ret < 0) {
dev_err(component->dev, "config mode adaptive fail\n");
return ret;
}
break;
- case SND_SOC_DAPM_POST_PMU:
/* voltage sensing enable */
ret = snd_soc_component_update_bits(component,
MT6660_REG_RESV7, 0x04, 0x04);
if (ret < 0) {
dev_err(component->dev,
"enable voltage sensing fail\n");
return ret;
}
break;
- case SND_SOC_DAPM_PRE_PMD:
/* voltage sensing disable */
ret = snd_soc_component_update_bits(component,
MT6660_REG_RESV7, 0x04, 0x00);
if (ret < 0) {
dev_err(component->dev,
"disable voltage sensing fail\n");
return ret;
}
/* pop-noise improvement 1 */
ret = snd_soc_component_update_bits(component,
MT6660_REG_RESV10, 0x10, 0x10);
if (ret < 0) {
dev_err(component->dev,
"pop-noise improvement 1 fail\n");
return ret;
}
break;
- case SND_SOC_DAPM_POST_PMD:
dev_dbg(component->dev,
"%s: after classd turn off\n", __func__);
/* pop-noise improvement 2 */
ret = snd_soc_component_update_bits(component,
MT6660_REG_RESV10, 0x10, 0x00);
if (ret < 0) {
dev_err(component->dev,
"pop-noise improvement 2 fail\n");
return ret;
}
/* config to off mode */
ret = snd_soc_component_update_bits(component,
MT6660_REG_BST_CTRL, 0x03, 0x00);
if (ret < 0) {
dev_err(component->dev, "config mode off fail\n");
return ret;
}
break;
- }
- return 0;
+}
+static const struct snd_soc_dapm_widget mt6660_component_dapm_widgets[] = {
- SND_SOC_DAPM_DAC_E("DAC", NULL, MT6660_REG_PLL_CFG1,
0, 1, mt6660_codec_dac_event, SND_SOC_DAPM_POST_PMU),
- SND_SOC_DAPM_ADC("VI ADC", NULL, SND_SOC_NOPM, 0, 0),
- SND_SOC_DAPM_PGA("PGA", SND_SOC_NOPM, 0, 0, NULL, 0),
- SND_SOC_DAPM_OUT_DRV_E("ClassD", MT6660_REG_SYSTEM_CTRL, 2, 0,
NULL, 0, mt6660_codec_classd_event,
SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
- SND_SOC_DAPM_OUTPUT("OUTP"),
- SND_SOC_DAPM_OUTPUT("OUTN"),
+};
+static const struct snd_soc_dapm_route mt6660_component_dapm_routes[] = {
- { "DAC", NULL, "aif_playback"},
- { "PGA", NULL, "DAC"},
- { "ClassD", NULL, "PGA"},
- { "OUTP", NULL, "ClassD"},
- { "OUTN", NULL, "ClassD"},
- { "VI ADC", NULL, "ClassD"},
- { "aif_capture", NULL, "VI ADC"},
+};
+static int mt6660_component_put_volsw(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
+{
- struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
- int put_ret = 0;
- pm_runtime_get_sync(component->dev);
- put_ret = snd_soc_put_volsw(kcontrol, ucontrol);
- if (put_ret < 0)
return put_ret;
- pm_runtime_put(component->dev);
- return put_ret;
+}
+static int mt6660_component_get_volsw(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
+{
- struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
- struct mt6660_chip *chip = (struct mt6660_chip *)
snd_soc_component_get_drvdata(component);
- int ret = -EINVAL;
- if (!strcmp(kcontrol->id.name, "Chip_Rev")) {
ucontrol->value.integer.value[0] = chip->chip_rev & 0x0f;
ret = 0;
- }
- return ret;
+}
+static const DECLARE_TLV_DB_SCALE(vol_ctl_tlv, -1155, 5, 0);
+static const struct snd_kcontrol_new mt6660_component_snd_controls[] = {
- SOC_SINGLE_EXT_TLV("Digital Volume", MT6660_REG_VOL_CTRL, 0, 255,
1, snd_soc_get_volsw, mt6660_component_put_volsw,
vol_ctl_tlv),
- SOC_SINGLE_EXT("WDT Switch", MT6660_REG_WDT_CTRL, 7, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("Hard Clip Switch", MT6660_REG_HCLIP_CTRL, 8, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("Clip Switch", MT6660_REG_SPS_CTRL, 0, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("BoostMode", MT6660_REG_BST_CTRL, 0, 3, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("DRE Switch", MT6660_REG_DRE_CTRL, 0, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("DC_Protect Switch",
MT6660_REG_DC_PROTECT_CTRL, 3, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("audio input selection", MT6660_REG_DATAO_SEL, 6, 3, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("Data Output Left Channel Selection",
MT6660_REG_DATAO_SEL, 3, 7, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("Data Output Right Channel Selection",
MT6660_REG_DATAO_SEL, 0, 7, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- /* for debug purpose */
- SOC_SINGLE_EXT("HPF AUD IN Switch", MT6660_REG_HPF_CTRL, 0, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("AUD LOOP BACK Switch", MT6660_REG_PATH_BYPASS, 4, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("Mute Switch", MT6660_REG_SYSTEM_CTRL, 1, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("Bypass CS Comp Switch", MT6660_REG_PATH_BYPASS, 2, 1, 0,
snd_soc_get_volsw, mt6660_component_put_volsw),
- SOC_SINGLE_EXT("T0 SEL", MT6660_REG_CALI_T0, 0, 7, 0,
snd_soc_get_volsw, NULL),
- SOC_SINGLE_EXT("Chip Rev", SND_SOC_NOPM, 0, 16, 0,
mt6660_component_get_volsw, NULL),
+};
+static int mt6660_component_probe(struct snd_soc_component *component) +{
- struct mt6660_chip *chip = snd_soc_component_get_drvdata(component);
- int ret = 0;
- pr_info("%s\n", __func__);
- //snd_soc_component_init_regmap(component, chip->regmap);
- /* init chip setting */
- ret = mt6660_component_init_setting(component);
- if (ret < 0)
dev_err(chip->dev, "chip i2c init setting fail\n");
- return ret;
+}
+static void mt6660_component_remove(struct snd_soc_component *component) +{
- pr_info("%s\n", __func__);
- snd_soc_component_exit_regmap(component);
+}
+static const struct snd_soc_component_driver mt6660_component_driver = {
- .probe = mt6660_component_probe,
- .remove = mt6660_component_remove,
- .read = mt6660_component_io_read,
- .write = mt6660_component_io_write,
- .controls = mt6660_component_snd_controls,
- .num_controls = ARRAY_SIZE(mt6660_component_snd_controls),
- .dapm_widgets = mt6660_component_dapm_widgets,
- .num_dapm_widgets = ARRAY_SIZE(mt6660_component_dapm_widgets),
- .dapm_routes = mt6660_component_dapm_routes,
- .num_dapm_routes = ARRAY_SIZE(mt6660_component_dapm_routes),
- .set_bias_level = mt6660_component_set_bias_level,
- .idle_bias_on = false, /* idle_bias_off = true */
+};
+static int mt6660_component_aif_hw_params(struct snd_pcm_substream *substream,
- struct snd_pcm_hw_params *hw_params, struct snd_soc_dai *dai)
+{
- int word_len = params_physical_width(hw_params);
- int aud_bit = params_width(hw_params);
- u16 reg_data = 0;
- int ret = 0;
- dev_dbg(dai->dev, "%s: ++\n", __func__);
- dev_dbg(dai->dev, "format: 0x%08x\n", params_format(hw_params));
- dev_dbg(dai->dev, "rate: 0x%08x\n", params_rate(hw_params));
- dev_dbg(dai->dev, "word_len: %d, aud_bit: %d\n", word_len, aud_bit);
- if (word_len > 32 || word_len < 16) {
dev_err(dai->dev, "not supported word length\n");
return -ENOTSUPP;
- }
- switch (aud_bit) {
- case 16:
reg_data = 3;
break;
- case 18:
reg_data = 2;
break;
- case 20:
reg_data = 1;
break;
- case 24:
- case 32:
reg_data = 0;
break;
- default:
return -ENOTSUPP;
- }
- ret = snd_soc_component_update_bits(dai->component,
MT6660_REG_SERIAL_CFG1, 0xc0, (reg_data << 6));
- if (ret < 0) {
dev_err(dai->dev, "config aud bit fail\n");
return ret;
- }
- ret = snd_soc_component_update_bits(dai->component,
MT6660_REG_TDM_CFG3, 0x3f0, word_len << 4);
- if (ret < 0) {
dev_err(dai->dev, "config word len fail\n");
return ret;
- }
- dev_dbg(dai->dev, "%s: --\n", __func__);
- return 0;
+}
+static const struct snd_soc_dai_ops mt6660_component_aif_ops = {
- .hw_params = mt6660_component_aif_hw_params,
+};
+#define STUB_RATES SNDRV_PCM_RATE_8000_192000 +#define STUB_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
SNDRV_PCM_FMTBIT_U16_LE | \
SNDRV_PCM_FMTBIT_S24_LE | \
SNDRV_PCM_FMTBIT_U24_LE | \
SNDRV_PCM_FMTBIT_S32_LE | \
SNDRV_PCM_FMTBIT_U32_LE)
+static struct snd_soc_dai_driver mt6660_codec_dai = {
- .name = "mt6660-aif",
- .playback = {
.stream_name = "aif_playback",
.channels_min = 1,
.channels_max = 2,
.rates = STUB_RATES,
.formats = STUB_FORMATS,
- },
- .capture = {
.stream_name = "aif_capture",
.channels_min = 1,
.channels_max = 2,
.rates = STUB_RATES,
.formats = STUB_FORMATS,
- },
- /* dai properties */
- .symmetric_rates = 1,
- .symmetric_channels = 1,
- .symmetric_samplebits = 1,
- /* dai operations */
- .ops = &mt6660_component_aif_ops,
+};
+static inline int _mt6660_chip_id_check(struct mt6660_chip *chip) +{
- u8 id[2] = {0};
- int ret = 0;
- ret = i2c_smbus_read_i2c_block_data(chip->i2c, MT6660_REG_DEVID, 2, id);
- if (ret < 0)
return ret;
- ret = (id[0] << 8) + id[1];
- ret &= 0x0ff0;
- if (ret != 0x00e0 && ret != 0x01e0)
return -ENODEV;
- return ret;
+}
+static inline int _mt6660_chip_sw_reset(struct mt6660_chip *chip) +{
- int ret;
- /* turn on main pll first, then trigger reset */
- ret = regmap_write(chip->regmap, 0x03, 0x00);
- if (ret < 0)
return ret;
- ret = regmap_write(chip->regmap, MT6660_REG_SYSTEM_CTRL, 0x80);
- msleep(30);
- return 0;
+}
+static inline int _mt6660_chip_power_on(struct mt6660_chip *chip, int on_off) +{
- u8 reg_data = 0;
- int ret = 0;
- ret = i2c_smbus_read_byte_data(chip->i2c, MT6660_REG_SYSTEM_CTRL);
- if (ret < 0)
return ret;
- reg_data = (u8)ret;
- if (on_off)
reg_data &= (~0x01);
- else
reg_data |= 0x01;
- return regmap_write(chip->regmap, MT6660_REG_SYSTEM_CTRL, reg_data);
+}
+static inline int _mt6660_read_chip_revision(struct mt6660_chip *chip) +{
- u8 reg_data[2] = {0};
- int ret = 0;
- ret = i2c_smbus_read_i2c_block_data(
chip->i2c, MT6660_REG_DEVID, 2, reg_data);
- if (ret < 0) {
dev_err(chip->dev, "get chip revision fail\n");
return ret;
- }
- chip->chip_rev = reg_data[1];
- return 0;
+}
+static int mt6660_i2c_probe(struct i2c_client *client,
const struct i2c_device_id *id)
+{
- struct mt6660_chip *chip = NULL;
- int ret = 0;
- pr_info("%s start\n", __func__);
- chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
- if (!chip)
return -ENOMEM;
- chip->i2c = client;
- chip->dev = &client->dev;
- mutex_init(&chip->io_lock);
- i2c_set_clientdata(client, chip);
- chip->regmap = devm_regmap_init(&client->dev,
NULL, chip, &mt6660_regmap_config);
- if (IS_ERR(chip->regmap)) {
ret = PTR_ERR(chip->regmap);
dev_err(&client->dev, "failed to initialise regmap: %d\n", ret);
return ret;
- }
+#if GENERIC_DEBUGFS
- /* debugfs interface */
- chip->dbg_info.dirname = devm_kasprintf(&client->dev,
GFP_KERNEL, "MT6660.%s",
dev_name(&client->dev));
- chip->dbg_info.devname = dev_name(&client->dev);
- chip->dbg_info.typestr = devm_kasprintf(&client->dev,
GFP_KERNEL, "I2C,MT6660");
- chip->dbg_info.io_drvdata = chip;
- chip->dbg_info.io_read = mt6660_dbg_io_read;
- chip->dbg_info.io_write = mt6660_dbg_io_write;
- ret = generic_debugfs_init(&chip->dbg_info);
- if (ret < 0) {
dev_err(&client->dev, "generic dbg init fail\n");
return -EINVAL;
- }
+#endif /* GENERIC_DEBUGFS */
- /* chip reset first */
- ret = _mt6660_chip_sw_reset(chip);
- if (ret < 0) {
dev_err(chip->dev, "chip reset fail\n");
goto probe_fail;
- }
- /* chip power on */
- ret = _mt6660_chip_power_on(chip, 1);
- if (ret < 0) {
dev_err(chip->dev, "chip power on 2 fail\n");
goto probe_fail;
- }
- /* chip devid check */
- ret = _mt6660_chip_id_check(chip);
- if (ret < 0) {
dev_err(chip->dev, "chip id check fail\n");
goto probe_fail;
- }
- /* chip revision get */
- ret = _mt6660_read_chip_revision(chip);
- if (ret < 0) {
dev_err(chip->dev, "read chip revision fail\n");
goto probe_fail;
- }
- pm_runtime_set_active(chip->dev);
- pm_runtime_enable(chip->dev);
- ret = devm_snd_soc_register_component(chip->dev,
&mt6660_component_driver,
&mt6660_codec_dai, 1);
- pr_info("%s end, ret = %d\n", __func__, ret);
- return ret;
+probe_fail:
- _mt6660_chip_power_on(chip, 0);
- mutex_destroy(&chip->io_lock);
- return ret;
+}
+static int mt6660_i2c_remove(struct i2c_client *client) +{
- struct mt6660_chip *chip = i2c_get_clientdata(client);
- pm_runtime_disable(chip->dev);
- pm_runtime_set_suspended(chip->dev);
+#if GENERIC_DEBUGFS
- generic_debugfs_exit(&chip->dbg_info);
+#endif /* GENERIC_DEBUGFS */
- mutex_destroy(&chip->io_lock);
- return 0;
+}
+static int __maybe_unused mt6660_i2c_runtime_suspend(struct device *dev) +{
- struct mt6660_chip *chip = dev_get_drvdata(dev);
- dev_dbg(dev, "enter low power mode\n");
- return regmap_update_bits(chip->regmap,
MT6660_REG_SYSTEM_CTRL, 0x01, 0x01);
+}
+static int __maybe_unused mt6660_i2c_runtime_resume(struct device *dev) +{
- struct mt6660_chip *chip = dev_get_drvdata(dev);
- dev_dbg(dev, "exit low power mode\n");
- return regmap_update_bits(chip->regmap,
MT6660_REG_SYSTEM_CTRL, 0x01, 0x00);
+}
+static const struct dev_pm_ops mt6660_dev_pm_ops = {
- SET_RUNTIME_PM_OPS(mt6660_i2c_runtime_suspend,
mt6660_i2c_runtime_resume, NULL)
+};
+static const struct of_device_id __maybe_unused mt6660_of_id[] = {
- { .compatible = "mediatek,mt6660",},
- {},
+}; +MODULE_DEVICE_TABLE(of, mt6660_of_id);
+static const struct i2c_device_id mt6660_i2c_id[] = {
- {"mt6660", 0 },
- {},
+}; +MODULE_DEVICE_TABLE(i2c, mt6660_i2c_id);
+static struct i2c_driver mt6660_i2c_driver = {
- .driver = {
.name = "mt6660",
.of_match_table = of_match_ptr(mt6660_of_id),
.pm = &mt6660_dev_pm_ops,
- },
- .probe = mt6660_i2c_probe,
- .remove = mt6660_i2c_remove,
- .id_table = mt6660_i2c_id,
+}; +module_i2c_driver(mt6660_i2c_driver);
+MODULE_AUTHOR("Jeff Chang jeff_chang@richtek.com"); +MODULE_DESCRIPTION("MT6660 SPKAMP Driver"); +MODULE_LICENSE("GPL"); +MODULE_VERSION("1.0.7_G"); diff --git a/sound/soc/codecs/mt6660.h b/sound/soc/codecs/mt6660.h new file mode 100644 index 0000000..9e62dcc --- /dev/null +++ b/sound/soc/codecs/mt6660.h @@ -0,0 +1,95 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/*
- Copyright (c) 2019 MediaTek Inc.
- */
+#ifndef __SND_SOC_MT6660_H +#define __SND_SOC_MT6660_H
+#include <linux/mutex.h> +#include <linux/regmap.h>
+#define GENERIC_DEBUGFS 0
+#if GENERIC_DEBUGFS +struct dbg_internal {
- struct dentry *rt_root;
- struct dentry *ic_root;
- bool rt_dir_create;
- struct mutex io_lock;
- u16 reg;
- u16 size;
- u16 data_buffer_size;
- void *data_buffer;
+};
+struct dbg_info {
- const char *dirname;
- const char *devname;
- const char *typestr;
- void *io_drvdata;
- int (*io_read)(void *drvdata, u16 reg, void *val, u16 size);
- int (*io_write)(void *drvdata, u16 reg, const void *val, u16 size);
- struct dbg_internal internal;
+}; +#endif /* GENERIC_DEBUGFS */
+struct mt6660_chip {
- struct i2c_client *i2c;
- struct device *dev;
- struct platform_device *param_dev;
- struct mutex io_lock;
+#if GENERIC_DEBUGFS
- struct dbg_info dbg_info;
+#endif /* GENERIC_DEBUGFS */
- struct regmap *regmap;
- u16 chip_rev;
+};
+#define MT6660_REG_DEVID (0x00) +#define MT6660_REG_SYSTEM_CTRL (0x03) +#define MT6660_REG_IRQ_STATUS1 (0x05) +#define MT6660_REG_ADDA_CLOCK (0x07) +#define MT6660_REG_SERIAL_CFG1 (0x10) +#define MT6660_REG_DATAO_SEL (0x12) +#define MT6660_REG_TDM_CFG3 (0x15) +#define MT6660_REG_HPF_CTRL (0x18) +#define MT6660_REG_HPF1_COEF (0x1A) +#define MT6660_REG_HPF2_COEF (0x1B) +#define MT6660_REG_PATH_BYPASS (0x1E) +#define MT6660_REG_WDT_CTRL (0x20) +#define MT6660_REG_HCLIP_CTRL (0x24) +#define MT6660_REG_VOL_CTRL (0x29) +#define MT6660_REG_SPS_CTRL (0x30) +#define MT6660_REG_SIGMAX (0x33) +#define MT6660_REG_CALI_T0 (0x3F) +#define MT6660_REG_BST_CTRL (0x40) +#define MT6660_REG_PROTECTION_CFG (0x46) +#define MT6660_REG_DA_GAIN (0x4c) +#define MT6660_REG_AUDIO_IN2_SEL (0x50) +#define MT6660_REG_SIG_GAIN (0x51) +#define MT6660_REG_PLL_CFG1 (0x60) +#define MT6660_REG_DRE_CTRL (0x68) +#define MT6660_REG_DRE_THDMODE (0x69) +#define MT6660_REG_DRE_CORASE (0x6B) +#define MT6660_REG_PWM_CTRL (0x70) +#define MT6660_REG_DC_PROTECT_CTRL (0x74) +#define MT6660_REG_ADC_USB_MODE (0x7c) +#define MT6660_REG_INTERNAL_CFG (0x88) +#define MT6660_REG_RESV0 (0x98) +#define MT6660_REG_RESV1 (0x99) +#define MT6660_REG_RESV2 (0x9A) +#define MT6660_REG_RESV3 (0x9B) +#define MT6660_REG_RESV6 (0xA2) +#define MT6660_REG_RESV7 (0xA3) +#define MT6660_REG_RESV10 (0xB0) +#define MT6660_REG_RESV11 (0xB1) +#define MT6660_REG_RESV16 (0xB6) +#define MT6660_REG_RESV17 (0xB7) +#define MT6660_REG_RESV19 (0xB9) +#define MT6660_REG_RESV21 (0xBB) +#define MT6660_REG_RESV23 (0xBD) +#define MT6660_REG_RESV31 (0xD3) +#define MT6660_REG_RESV40 (0xE0)
+#endif /* __SND_SOC_MT6660_H */
On Thu, Dec 12, 2019 at 07:08:54PM +0800, Jeff Chang wrote:
The MT6660 is a boosted BTL class-D amplifier with V/I sensing. A built-in DC-DC step-up converter is used to provide efficient power for class-D amplifier with multi-level class-G operation. The digital audio interface supports I2S, left-justified, right-justified, TDM and DSP A/B format for audio in with a data out used for chip information like voltage sense and current sense, which are able to be monitored via DATAO through proper
sound/soc/codecs/Kconfig | 14 +
You've not provided a Signed-off-by so I can't do anything with this, please see submitting-patches.rst for an explanation of what that is or why it's important.
On Thu, Dec 12, 2019 at 07:08:54PM +0800, Jeff Chang wrote: ookup("ext_dev_io", NULL);
- if (!d->rt_root) {
d->rt_root = debugfs_create_dir("ext_dev_io", NULL);
if (!d->rt_root)
return -ENODEV;
No need to ever check the result of this function
d->rt_dir_create = true;
- }
- d->ic_root = debugfs_create_dir(di->dirname, d->rt_root);
- if (!d->ic_root)
goto err_cleanup_rt;
Same here.
- if (!debugfs_create_u16("reg", 0644, d->ic_root, &d->reg))
goto err_cleanup_ic;
No need to ever check any result of any debugfs_create_* function. In fact, this function doesn't even return a value anymore, so if you tried to build this against Linus's latest tree, it wouldn't work :)
thanks,
greg k-h
participants (4)
-
Greg KH
-
Jeff Chang
-
Mark Brown
-
Matthias Brugger