/* * max98512.c -- MAX98512 ALSA Soc Audio driver * * Copyright (C) 2017 Maxim Integrated Products * Author: Ryan Lee * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. */ #include #include #include #include #include #include #include #include #include #include #include #include #include "max98512.h" #define DEBUG_MAX98512 #ifdef DEBUG_MAX98512 #define msg_maxim(format, args...) \ pr_info("[MAX98512_DEBUG] %s: " format "\n", __func__, ## args) #else #define msg_maxim(format, args...) #endif /* DEBUG_MAX98512 */ struct max98512_priv *g_max98512; static struct reg_default max98512_reg[] = { {MAX98512_R0001_INT_RAW1, 0x00}, {MAX98512_R0002_INT_RAW2, 0x00}, {MAX98512_R0003_INT_RAW3, 0x00}, {MAX98512_R0004_INT_STATE1, 0x00}, {MAX98512_R0005_INT_STATE2, 0x00}, {MAX98512_R0006_INT_STATE3, 0x00}, {MAX98512_R0007_INT_FLAG1, 0x00}, {MAX98512_R0008_INT_FLAG2, 0x00}, {MAX98512_R0009_INT_FLAG3, 0x00}, {MAX98512_R000A_INT_EN1, 0x00}, {MAX98512_R000B_INT_EN2, 0x00}, {MAX98512_R000C_INT_EN3, 0x00}, {MAX98512_R000D_INT_FLAG_CLR1, 0x00}, {MAX98512_R000E_INT_FLAG_CLR2, 0x00}, {MAX98512_R000F_INT_FLAG_CLR3, 0x00}, {MAX98512_R0010_IRQ_CTRL, 0x00}, {MAX98512_R0011_CLK_MON, 0x00}, {MAX98512_R0012_WDOG_CTRL, 0x00}, {MAX98512_R0013_WDOG_RST, 0x00}, {MAX98512_R0014_MEAS_ADC_THERM_WARN_THRESH, 0x75}, {MAX98512_R0015_MEAS_ADC_THERM_SHDN_THRESH, 0x8C}, {MAX98512_R0016_MEAS_ADC_THERM_HYSTERESIS, 0x08}, {MAX98512_R0017_PIN_CFG, 0x55}, {MAX98512_R0018_PCM_RX_EN_A, 0x00}, {MAX98512_R0019_PCM_RX_EN_B, 0x00}, {MAX98512_R001A_PCM_TX_EN_A, 0x00}, {MAX98512_R001B_PCM_TX_EN_B, 0x00}, {MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 0x00}, {MAX98512_R001D_PCM_TX_HIZ_CTRL_B, 0x00}, {MAX98512_R001E_PCM_TX_CH_SRC_A, 0x00}, {MAX98512_R001F_PCM_TX_CH_SRC_B, 0x00}, {MAX98512_R0020_PCM_MODE_CFG, 0x22}, {MAX98512_R0021_PCM_MASTER_MODE, 0x00}, {MAX98512_R0022_PCM_CLK_SETUP, 0x22}, {MAX98512_R0023_PCM_SR_SETUP1, 0x00}, {MAX98512_R0024_PCM_SR_SETUP2, 0x00}, {MAX98512_R0025_PCM_TO_SPK_MONOMIX_A, 0x00}, {MAX98512_R0026_PCM_TO_SPK_MONOMIX_B, 0x00}, {MAX98512_R0027_ICC_RX_EN_A, 0x00}, {MAX98512_R0028_ICC_RX_EN_B, 0x00}, {MAX98512_R002B_ICC_TX_EN_A, 0x00}, {MAX98512_R002C_ICC_TX_EN_B, 0x00}, {MAX98512_R002D_ICC_HIZ_MANUAL_MODE, 0x00}, {MAX98512_R002E_ICC_TX_HIZ_EN_A, 0x00}, {MAX98512_R002F_ICC_TX_HIZ_EN_B, 0x00}, {MAX98512_R0030_ICC_LNK_EN, 0x00}, {MAX98512_R0031_PDM_TX_EN, 0x00}, {MAX98512_R0032_PDM_TX_HIZ_CTRL, 0x00}, {MAX98512_R0033_PDM_TX_CTRL, 0x00}, {MAX98512_R0034_PDM_RX_CTRL, 0x40}, {MAX98512_R0035_AMP_VOL_CTRL, 0x00}, {MAX98512_R0036_AMP_DSP_CFG, 0x02}, {MAX98512_R0037_TONE_GEN_DC_CFG, 0x00}, {MAX98512_R0038_AMP_EN, 0x00}, {MAX98512_R0039_SPK_SRC_SEL, 0x00}, {MAX98512_R003A_SPK_GAIN, 0x00}, {MAX98512_R003B_SSM_CFG, 0x01}, {MAX98512_R003C_MEAS_EN, 0x00}, {MAX98512_R003D_MEAS_DSP_CFG, 0x04}, {MAX98512_R003E_BOOST_CTRL0, 0x00}, {MAX98512_R003F_BOOST_CTRL3, 0x00}, {MAX98512_R0040_BOOST_CTRL1, 0x00}, {MAX98512_R0041_MEAS_ADC_CFG, 0x00}, {MAX98512_R0042_MEAS_ADC_BASE_MSB, 0x00}, {MAX98512_R0043_MEAS_ADC_BASE_LSB, 0x00}, {MAX98512_R0044_ADC_CH0_DIVIDE, 0x00}, {MAX98512_R0045_ADC_CH1_DIVIDE, 0x00}, {MAX98512_R0046_ADC_CH2_DIVIDE, 0x00}, {MAX98512_R0047_ADC_CH0_FILT_CFG, 0x00}, {MAX98512_R0048_ADC_CH1_FILT_CFG, 0x00}, {MAX98512_R0049_ADC_CH2_FILT_CFG, 0x00}, {MAX98512_R004A_MEAS_ADC_CH0_READ, 0x00}, {MAX98512_R004B_MEAS_ADC_CH1_READ, 0x00}, {MAX98512_R004C_MEAS_ADC_CH2_READ, 0x00}, {MAX98512_R004E_SQUELCH, 0x10}, {MAX98512_R004F_BROWNOUT_STATUS, 0x00}, {MAX98512_R0050_BROWNOUT_EN, 0x00}, {MAX98512_R0051_BROWNOUT_INFINITE_HOLD, 0x00}, {MAX98512_R0052_BROWNOUT_INFINITE_HOLD_CLR, 0x00}, {MAX98512_R0053_BROWNOUT_LVL_HOLD, 0x00}, {MAX98512_R0058_BROWNOUT_LVL1_THRESH, 0x00}, {MAX98512_R0059_BROWNOUT_LVL2_THRESH, 0x00}, {MAX98512_R005A_BROWNOUT_LVL3_THRESH, 0x00}, {MAX98512_R005B_BROWNOUT_LVL4_THRESH, 0x00}, {MAX98512_R005C_BROWNOUT_THRESH_HYSTERYSIS, 0x00}, {MAX98512_R005D_BROWNOUT_AMP_LIMITER_ATK_REL, 0x00}, {MAX98512_R005E_BROWNOUT_AMP_GAIN_ATK_REL, 0x00}, {MAX98512_R005F_BROWNOUT_AMP1_CLIP_MODE, 0x00}, {MAX98512_R0070_BROWNOUT_LVL1_CUR_LIMIT, 0x00}, {MAX98512_R0071_BROWNOUT_LVL1_AMP1_CTRL1, 0x00}, {MAX98512_R0072_BROWNOUT_LVL1_AMP1_CTRL2, 0x00}, {MAX98512_R0073_BROWNOUT_LVL1_AMP1_CTRL3, 0x00}, {MAX98512_R0074_BROWNOUT_LVL2_CUR_LIMIT, 0x00}, {MAX98512_R0075_BROWNOUT_LVL2_AMP1_CTRL1, 0x00}, {MAX98512_R0076_BROWNOUT_LVL2_AMP1_CTRL2, 0x00}, {MAX98512_R0077_BROWNOUT_LVL2_AMP1_CTRL3, 0x00}, {MAX98512_R0078_BROWNOUT_LVL3_CUR_LIMIT, 0x00}, {MAX98512_R0079_BROWNOUT_LVL3_AMP1_CTRL1, 0x00}, {MAX98512_R007A_BROWNOUT_LVL3_AMP1_CTRL2, 0x00}, {MAX98512_R007B_BROWNOUT_LVL3_AMP1_CTRL3, 0x00}, {MAX98512_R007C_BROWNOUT_LVL4_CUR_LIMIT, 0x00}, {MAX98512_R007D_BROWNOUT_LVL4_AMP1_CTRL1, 0x00}, {MAX98512_R007E_BROWNOUT_LVL4_AMP1_CTRL2, 0x00}, {MAX98512_R007F_BROWNOUT_LVL4_AMP1_CTRL3, 0x00}, {MAX98512_R0080_ENV_TRACK_VOUT_HEADROOM, 0x00}, {MAX98512_R0081_ENV_TRACK_BOOST_VOUT_DELAY, 0x00}, {MAX98512_R0082_ENV_TRACK_REL_RATE, 0x00}, {MAX98512_R0083_ENV_TRACK_HOLD_RATE, 0x00}, {MAX98512_R0084_ENV_TRACK_CTRL, 0x00}, {MAX98512_R0085_ENV_TRACK_BOOST_VOUT_READ, 0x00}, {MAX98512_R0086_BOOST_BYPASS_1, 0x00}, {MAX98512_R0087_BOOST_BYPASS_2, 0x00}, {MAX98512_R0088_BOOST_BYPASS_3, 0x00}, {MAX98512_R0400_GLOBAL_SHDN, 0x00}, {MAX98512_R0401_SOFT_RESET, 0x00}, {MAX98512_R0402_REV_ID, 0x40}, }; int max98512_regmap_read(struct regmap *map, unsigned int reg, unsigned int *val) { int ret = 0; if (map) ret = regmap_read(map, reg, val); return ret; } int max98512_regmap_write(struct regmap *map, unsigned int reg, unsigned int val) { int ret = 0; if (map) ret = regmap_write(map, reg, val); return ret; } int max98512_wrapper_read(struct max98512_priv *max98512, int speaker, unsigned int reg, unsigned int *val) { int ret = -999; int count = 0; while (count++ < MAX_TRY_COUNT && ret != 0) { switch (speaker) { case MAX98512L: ret = max98512_regmap_read(max98512->regmap_l, reg, val); break; case MAX98512R: if (max98512->pdata->sub_reg) ret = max98512_regmap_read(max98512->regmap_r, reg, val); break; case MAX98512B: ret = max98512_regmap_read(max98512->regmap_l, reg, val); if (max98512->pdata->sub_reg) ret = max98512_regmap_read(max98512->regmap_r, reg, val); break; default: msg_maxim("Unknown type %d", speaker); break; } if (!ret) return ret; } dev_err(max98512->i2c_dev, "Failed to read [0x%04x][%d]", reg, ret); return ret; } int max98512_wrapper_write(struct max98512_priv *max98512, int speaker, unsigned int reg, unsigned int val) { int ret = -999; int count = 0; while (count++ < MAX_TRY_COUNT && ret != 0) { switch (speaker) { case MAX98512L: ret = max98512_regmap_write(max98512->regmap_l, reg, val); break; case MAX98512R: if (max98512->pdata->sub_reg) ret = max98512_regmap_write(max98512->regmap_r, reg, val); break; case MAX98512B: ret = max98512_regmap_write(max98512->regmap_l, reg, val); if (max98512->pdata->sub_reg) ret = max98512_regmap_write(max98512->regmap_r, reg, val); break; default: msg_maxim("Unknown type %d", speaker); break; } if (!ret) return ret; } dev_err(max98512->i2c_dev, "Failed to write [0x%04x, 0x%02x][%d]", reg, val, ret); return ret; } int max98512_wrapper_update(struct max98512_priv *max98512, int speaker, unsigned int reg, unsigned int mask, unsigned int val) { int ret = -999; int count = 0; while (count++ < MAX_TRY_COUNT && ret != 0) { switch (speaker) { case MAX98512L: ret = regmap_update_bits(max98512->regmap_l, reg, mask, val); break; case MAX98512R: if (max98512->pdata->sub_reg) ret = regmap_update_bits(max98512->regmap_r, reg, mask, val); break; case MAX98512B: ret = regmap_update_bits(max98512->regmap_l, reg, mask, val); if (max98512->pdata->sub_reg) ret = regmap_update_bits(max98512->regmap_r, reg, mask, val); break; default: msg_maxim("Unknown type %d", speaker); } if (!ret) return ret; } dev_err(max98512->i2c_dev, "Failed to update [0x%04x, 0x%02x][%d]", reg, val, ret); return ret; } static int max98512_dai_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) { struct snd_soc_codec *codec = codec_dai->codec; struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); unsigned int mode = 0; unsigned int pcm_fmt = 0; bool pdm_fmt = false; unsigned int invert = 0; msg_maxim("%s: fmt 0x%08X\n", __func__, fmt); switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { case SND_SOC_DAIFMT_CBS_CFS: mode = MAX98512_PCM_MASTER_MODE_SLAVE; break; case SND_SOC_DAIFMT_CBM_CFM: max98512->master = true; mode = MAX98512_PCM_MASTER_MODE_MASTER; break; default: dev_err(codec->dev, "DAI clock mode unsupported"); return -EINVAL; } max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0021_PCM_MASTER_MODE, MAX98512_PCM_MASTER_MODE_MASK, mode); switch (fmt & SND_SOC_DAIFMT_INV_MASK) { case SND_SOC_DAIFMT_NB_NF: break; case SND_SOC_DAIFMT_IB_NF: invert = MAX98512_PCM_MODE_CFG_PCM_BCLKEDGE; break; default: dev_err(codec->dev, "DAI invert mode unsupported"); return -EINVAL; } max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0020_PCM_MODE_CFG, MAX98512_PCM_MODE_CFG_PCM_BCLKEDGE, invert); /* interface format */ switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { case SND_SOC_DAIFMT_I2S: pcm_fmt = MAX98512_PCM_FORMAT_I2S; pdm_fmt = false; break; case SND_SOC_DAIFMT_LEFT_J: pcm_fmt = MAX98512_PCM_FORMAT_LJ; pdm_fmt = false; break; case SND_SOC_DAIFMT_PDM: pcm_fmt = 0; pdm_fmt = true; break; default: return -EINVAL; } if (pdm_fmt) { /* pdm channel configuration */ max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0034_PDM_RX_CTRL, MAX98512_PDM_RX_EN_MASK, 1); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0039_SPK_SRC_SEL, MAX98512_SPK_SRC_MASK, MAX98512_SPK_SOURCE_PDM_IN); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0018_PCM_RX_EN_A, MAX98512_PCM_RX_CH0_EN | MAX98512_PCM_RX_CH1_EN, 0); } else { /* pcm channel configuration */ if (max98512->mono_stereo) { msg_maxim("Stereo mode source select"); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R0018_PCM_RX_EN_A, MAX98512_PCM_RX_CH0_EN, MAX98512_PCM_RX_CH0_EN); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R0018_PCM_RX_EN_A, MAX98512_PCM_RX_CH1_EN, MAX98512_PCM_RX_CH1_EN); } else max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0018_PCM_RX_EN_A, MAX98512_PCM_RX_CH0_EN | MAX98512_PCM_RX_CH1_EN, MAX98512_PCM_RX_CH0_EN | MAX98512_PCM_RX_CH1_EN); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0020_PCM_MODE_CFG, MAX98512_PCM_MODE_CFG_FORMAT_MASK, pcm_fmt << MAX98512_PCM_MODE_CFG_FORMAT_SHIFT); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0039_SPK_SRC_SEL, MAX98512_SPK_SRC_MASK, MAX98512_SPK_SOURCE_DIGITAL); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0034_PDM_RX_CTRL, MAX98512_PDM_RX_EN_MASK, 0); } return 0; } /* codec MCLK rate in master mode */ static const int rate_table[] = { 5644800, 6000000, 6144000, 6500000, 9600000, 11289600, 12000000, 12288000, 13000000, 19200000, }; static int max98512_set_clock(struct max98512_priv *max98512, struct snd_pcm_hw_params *params) { struct snd_soc_codec *codec = max98512->codec; /* BCLK/LRCLK ratio calculation */ int blr_clk_ratio = params_channels(params) * max98512->ch_size; int value; if (max98512->master) { long i; /* match rate to closest value */ for (i = 0; i < ARRAY_SIZE(rate_table); i++) { if (rate_table[i] >= max98512->sysclk) break; } if (i == ARRAY_SIZE(rate_table)) { dev_err(codec->dev, "failed to find proper clock rate.\n"); return -EINVAL; } max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0021_PCM_MASTER_MODE, MAX98512_PCM_MASTER_MODE_MCLK_MASK, i << MAX98512_PCM_MASTER_MODE_MCLK_RATE_SHIFT); } switch (blr_clk_ratio) { case 32: value = 2; break; case 48: value = 3; break; case 64: value = 4; break; default: return -EINVAL; } max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0022_PCM_CLK_SETUP, MAX98512_PCM_CLK_SETUP_BSEL_MASK, value); return 0; } static int max98512_dai_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params, struct snd_soc_dai *dai) { struct snd_soc_codec *codec = dai->codec; struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); unsigned int sampling_rate = 0; unsigned int chan_sz = 0; /* pcm mode configuration */ switch (params_format(params)) { case SNDRV_PCM_FORMAT_S16_LE: chan_sz = MAX98512_PCM_MODE_CFG_CHANSZ_16; break; case SNDRV_PCM_FORMAT_S24_LE: chan_sz = MAX98512_PCM_MODE_CFG_CHANSZ_24; break; case SNDRV_PCM_FORMAT_S32_LE: chan_sz = MAX98512_PCM_MODE_CFG_CHANSZ_32; break; default: dev_err(codec->dev, "format unsupported %d", params_format(params)); goto err; } max98512->ch_size = snd_pcm_format_width(params_format(params)); msg_maxim("channel size %d, bit width %d", chan_sz, max98512->ch_size); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0020_PCM_MODE_CFG, MAX98512_PCM_MODE_CFG_CHANSZ_MASK, chan_sz); msg_maxim("format supported %d", params_format(params)); /* sampling rate configuration */ switch (params_rate(params)) { case 8000: sampling_rate = MAX98512_PCM_SR_SET1_SR_8000; break; case 11025: sampling_rate = MAX98512_PCM_SR_SET1_SR_11025; break; case 12000: sampling_rate = MAX98512_PCM_SR_SET1_SR_12000; break; case 16000: sampling_rate = MAX98512_PCM_SR_SET1_SR_16000; break; case 22050: sampling_rate = MAX98512_PCM_SR_SET1_SR_22050; break; case 24000: sampling_rate = MAX98512_PCM_SR_SET1_SR_24000; break; case 32000: sampling_rate = MAX98512_PCM_SR_SET1_SR_32000; break; case 44100: sampling_rate = MAX98512_PCM_SR_SET1_SR_44100; break; case 48000: sampling_rate = MAX98512_PCM_SR_SET1_SR_48000; break; case 88200: sampling_rate = MAX98512_PCM_SR_SET1_SR_88200; break; case 96000: sampling_rate = MAX98512_PCM_SR_SET1_SR_96000; break; case 176400: sampling_rate = MAX98512_PCM_SR_SET1_SR_176400; break; case 192000: sampling_rate = MAX98512_PCM_SR_SET1_SR_192000; break; default: dev_err(codec->dev, "rate %d not supported\n", params_rate(params)); goto err; } msg_maxim("sample rate is %d, apply %d", params_rate(params), sampling_rate); /* set DAI_SR to correct LRCLK frequency */ max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0023_PCM_SR_SETUP1, MAX98512_PCM_SR_SET1_SR_MASK, sampling_rate); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0024_PCM_SR_SETUP2, MAX98512_PCM_SR_SET2_SR_MASK, sampling_rate << MAX98512_PCM_SR_SET2_SR_SHIFT); /* set sampling rate of IV */ if (max98512->interleave_mode && sampling_rate > MAX98512_PCM_SR_SET1_SR_16000) max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0024_PCM_SR_SETUP2, MAX98512_PCM_SR_SET2_IVADC_SR_MASK, sampling_rate - 3); else max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0024_PCM_SR_SETUP2, MAX98512_PCM_SR_SET2_IVADC_SR_MASK, sampling_rate); return max98512_set_clock(max98512, params); err: return -EINVAL; } #define MAX98512_RATES SNDRV_PCM_RATE_8000_48000 #define MAX98512_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \ SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) static int max98512_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id, unsigned int freq, int dir) { struct snd_soc_codec *codec = dai->codec; struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); msg_maxim("clk_id %d, freq %d, dir %d", clk_id, freq, dir); max98512->sysclk = freq; return 0; } static void max98512_reinit_reg(struct max98512_priv *max98512) { max98512_wrapper_write(max98512, MAX98512B, MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 0xFF); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R001A_PCM_TX_EN_A, 0x00); } static int max98512_adc_config(struct max98512_priv *max98512) { max98512_reinit_reg(max98512); max98512_wrapper_write(max98512, MAX98512L, MAX98512_R001E_PCM_TX_CH_SRC_A, (max98512->i_l_slot << MAX98512_PCM_TX_CH_SRC_A_I_SHIFT | max98512->v_l_slot) & 0xFF); if (max98512->mono_stereo) { max98512_wrapper_write(max98512, MAX98512R, MAX98512_R001E_PCM_TX_CH_SRC_A, (max98512->i_r_slot<v_r_slot)&0xFF); } if (max98512->v_l_slot < 8) { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 1 << max98512->v_l_slot, 0); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001A_PCM_TX_EN_A, 1 << max98512->v_l_slot, 1 << max98512->v_l_slot); } else { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001D_PCM_TX_HIZ_CTRL_B, 1 << (max98512->v_l_slot - 8), 0); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001B_PCM_TX_EN_B, 1 << (max98512->v_l_slot - 8), 1 << (max98512->v_l_slot - 8)); } if (max98512->i_l_slot < 8) { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 1 << max98512->i_l_slot, 0); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001A_PCM_TX_EN_A, 1 << max98512->i_l_slot, 1 << max98512->i_l_slot); } else { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001D_PCM_TX_HIZ_CTRL_B, 1 << (max98512->i_l_slot - 8), 0); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R001B_PCM_TX_EN_B, 1 << (max98512->i_l_slot - 8), 1 << (max98512->i_l_slot - 8)); } if (max98512->mono_stereo) { if (max98512->v_r_slot < 8) { max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 1 << max98512->v_r_slot, 0); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001A_PCM_TX_EN_A, 1 << max98512->v_r_slot, 1 << max98512->v_r_slot); } else { max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001D_PCM_TX_HIZ_CTRL_B, 1 << (max98512->v_r_slot - 8), 0); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001B_PCM_TX_EN_B, 1 << (max98512->v_r_slot - 8), 1 << (max98512->v_r_slot - 8)); } if (max98512->i_l_slot < 8) { max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 1 << max98512->i_r_slot, 0); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001A_PCM_TX_EN_A, 1 << max98512->i_r_slot, 1 << max98512->i_r_slot); } else { max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001D_PCM_TX_HIZ_CTRL_B, 1 << (max98512->i_r_slot - 8), 0); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R001B_PCM_TX_EN_B, 1 << (max98512->i_r_slot - 8), 1 << (max98512->i_r_slot - 8)); } } /* Set interleave mode */ if (max98512->interleave_mode) { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R001F_PCM_TX_CH_SRC_B, MAX98512_PCM_TX_CH_INTERLEAVE_MASK, MAX98512_PCM_TX_CH_INTERLEAVE_MASK); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0024_PCM_SR_SETUP2, MAX98512_PCM_SR_SET2_IVADC_SR_MASK, MAX98512_PCM_SR_SET1_SR_24000); } else max98512_wrapper_update(max98512, MAX98512B, MAX98512_R001F_PCM_TX_CH_SRC_B, MAX98512_PCM_TX_CH_INTERLEAVE_MASK, 0); return 0; } static int __max98512_spk_enable(struct max98512_priv *max98512) { struct max98512_pdata *pdata = max98512->pdata; struct max98512_volume_step_info *vstep = &max98512->vstep; unsigned int gain_l, gain_r; unsigned int digital_gain_l, digital_gain_r; unsigned int enable_l, enable_r; unsigned int pcm_ch_enable_l, pcm_ch_enable_r; unsigned int pcm_to_monomix_a_l, pcm_to_monomix_a_r; unsigned int pcm_to_monomix_b_l, pcm_to_monomix_b_r; unsigned int dem_l, dem_r; unsigned int vimon = 0; unsigned int interleave_mode; gain_l = max98512->spk_gain_left; gain_r = max98512->spk_gain_right; digital_gain_l = digital_gain_r = max98512->digital_gain; interleave_mode = max98512->interleave_mode; enable_l = enable_r = 0x00; dem_l = dem_r = 0x80; pcm_ch_enable_l = 0x01; pcm_ch_enable_r = 0x02; pcm_to_monomix_a_l = 0x00; pcm_to_monomix_a_r = 0x41; pcm_to_monomix_b_l = 0x00; pcm_to_monomix_b_r = 0x01; if (vstep->adc_status && !pdata->nodsm) vimon = MAX98512_MEAS_VI_EN; switch (pdata->osm) { case MAX98512_OSM_STEREO_MODE2: case MAX98512_OSM_STEREO: enable_l = enable_r = 1; break; case MAX98512_OSM_RCV_L: case MAX98512_OSM_RCV_R: digital_gain_l = digital_gain_r = max98512->digital_gain_rcv; dem_l = dem_r = 0x40; vimon = 0; /* turn off VIMON */ pcm_ch_enable_l = pcm_ch_enable_r = 0x03; pcm_to_monomix_a_l = pcm_to_monomix_a_r = 0x80; pcm_to_monomix_b_l = pcm_to_monomix_b_r = 0x01; if (pdata->osm == MAX98512_OSM_RCV_L) enable_l = 1; else enable_r = 1; break; case MAX98512_OSM_MONO_L: digital_gain_l = max98512->digital_gain_rcv; case MAX98512_OSM_MONO_R: pcm_ch_enable_l = pcm_ch_enable_r = 0x03; pcm_to_monomix_a_l = 0x00; if (pdata->osm == MAX98512_OSM_MONO_L) enable_l = 1; else enable_r = 1; break; case MAX98512_OSM_STEREO_L: enable_l = 1; break; case MAX98512_OSM_STEREO_R: enable_r = 1; break; default: msg_maxim("Invalid one_stop_mode"); return -EINVAL; } msg_maxim("Gain[%d][%d] Enable[%d][%d] OSM[%d]", gain_l, gain_r, enable_l, enable_r, pdata->osm); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PCM_GAIN_MASK, gain_l); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R0035_AMP_VOL_CTRL, MAX98512_AMP_VOL_MASK, digital_gain_l); if (max98512->mono_stereo) { max98512_wrapper_update(max98512, MAX98512R, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PCM_GAIN_MASK, gain_r); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R0035_AMP_VOL_CTRL, MAX98512_AMP_VOL_MASK, digital_gain_r); } max98512_wrapper_update(max98512, MAX98512B, MAX98512_R003C_MEAS_EN, MAX98512_MEAS_VI_EN, vimon); max98512_wrapper_write(max98512, MAX98512L, MAX98512_R0018_PCM_RX_EN_A, pcm_ch_enable_l); max98512_wrapper_write(max98512, MAX98512L, MAX98512_R0025_PCM_TO_SPK_MONOMIX_A, pcm_to_monomix_a_l); max98512_wrapper_write(max98512, MAX98512L, MAX98512_R0026_PCM_TO_SPK_MONOMIX_B, pcm_to_monomix_b_l); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R0038_AMP_EN, MAX98512_AMP_EN_MASK, enable_l); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R0038_AMP_EN, MAX98512_DEM_EN_MASK|MAX98512_DEM_OFF_TRIM_MASK, dem_l); max98512_wrapper_update(max98512, MAX98512L, MAX98512_R0400_GLOBAL_SHDN, MAX98512_GLOBAL_EN_MASK, enable_l); if (max98512->mono_stereo) { max98512_wrapper_write(max98512, MAX98512R, MAX98512_R0018_PCM_RX_EN_A, pcm_ch_enable_r); max98512_wrapper_write(max98512, MAX98512R, MAX98512_R0025_PCM_TO_SPK_MONOMIX_A, pcm_to_monomix_a_r); max98512_wrapper_write(max98512, MAX98512R, MAX98512_R0026_PCM_TO_SPK_MONOMIX_B, pcm_to_monomix_b_r); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R0038_AMP_EN, MAX98512_AMP_EN_MASK, enable_r); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R0038_AMP_EN, MAX98512_DEM_EN_MASK | MAX98512_DEM_OFF_TRIM_MASK, dem_r); max98512_wrapper_update(max98512, MAX98512R, MAX98512_R0400_GLOBAL_SHDN, MAX98512_GLOBAL_EN_MASK, enable_r); } return 0; } static void max98512_spk_enable(struct max98512_priv *max98512, int enable) { if (enable) __max98512_spk_enable(max98512); else { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0400_GLOBAL_SHDN, MAX98512_GLOBAL_EN_MASK, 0); max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0038_AMP_EN, MAX98512_AMP_EN_MASK, 0); /* disable the v and i for vi feedback */ max98512_wrapper_update(max98512, MAX98512B, MAX98512_R003C_MEAS_EN, MAX98512_MEAS_VI_EN, 0); usleep_range(15000, 16000); } } static void max98512_spk_enable_l(struct max98512_priv *max98512, int enable) { msg_maxim("max98512_spk_enable_l enable[%d], max98512->spk_gain_left[%d]", enable, max98512->spk_gain_left); if (enable) { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PCM_GAIN_MASK, max98512->spk_gain_left); } else { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PCM_GAIN_MASK, 0); } } static int max98512_dai_mute_stream(struct snd_soc_dai *dai, int mute, int stream) { struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(dai->codec); if (stream == SNDRV_PCM_STREAM_PLAYBACK) { msg_maxim("max98512_spk_enable mute = %d", mute); max98512_spk_enable(max98512, mute != 0 ? 0 : 1); } return 0; } static const struct snd_soc_dai_ops max98512_dai_ops = { .set_sysclk = max98512_dai_set_sysclk, .set_fmt = max98512_dai_set_fmt, .hw_params = max98512_dai_hw_params, .mute_stream = max98512_dai_mute_stream, }; static DECLARE_TLV_DB_SCALE(max98512_spk_tlv, 300, 300, 0); static DECLARE_TLV_DB_SCALE(max98512_digital_tlv, -1600, 25, 0); static DECLARE_TLV_DB_SCALE(max98512_pdm_tlv, 300, 300, 0); static int pdm_l_zero; static int pdm_l_one; int max98512_common_pdm(struct max98512_priv *max98512, int channel, int source) { int ret = 0; /* enable the pdm receive interface */ max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0034_PDM_RX_CTRL, MAX98512_PDM_RX_EN_MASK, MAX98512_PDM_RX_EN_MASK); /* enable the pdm transmit interface */ max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0031_PDM_TX_EN, MAX98512_PDM_TX_ENABLES_PDM_TX_EN, MAX98512_PDM_TX_ENABLES_PDM_TX_EN); /* enable channel */ if (channel == 0) { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0034_PDM_RX_CTRL, MAX98512_PDM_RX_EN_MASK, 0); } else { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0034_PDM_RX_CTRL, MAX98512_PDM_RX_EN_MASK, MAX98512_PDM_RX_EN_MASK); } switch (source) { case 0: /* enable source*/ if (channel == 1) { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0033_PDM_TX_CTRL, MAX98512_PDM_TX_CTRL_PDM_TX_CH1_SRC, MAX98512_PDM_TX_CTRL_PDM_TX_CH1_SRC); } else { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0033_PDM_TX_CTRL, MAX98512_PDM_TX_CTRL_PDM_TX_CH0_SRC, MAX98512_PDM_TX_CTRL_PDM_TX_CH0_SRC); } break; case 1: /* enable source*/ if (channel == 1) { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0033_PDM_TX_CTRL, MAX98512_PDM_TX_CTRL_PDM_TX_CH1_SRC, 0); } else { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R0033_PDM_TX_CTRL, MAX98512_PDM_TX_CTRL_PDM_TX_CH0_SRC, 0); } break; default: dev_err(max98512->i2c_dev, "%s no source found %d\n", __func__, source); return -EINVAL; } return ret; } static int max98512_get_pdm_l_zero(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = pdm_l_zero; return 0; } static int max98512_put_pdm_l_zero(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); int ret; pdm_l_zero = ucontrol->value.integer.value[0]; ret = max98512_common_pdm(max98512, 0, pdm_l_zero); if (ret < 0) return -EINVAL; return 0; } static int max98512_get_pdm_l_one(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = pdm_l_one; return 0; } static int max98512_put_pdm_l_one(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); int ret; pdm_l_one = ucontrol->value.integer.value[0]; ret = max98512_common_pdm(max98512, 1, pdm_l_one); if (ret < 0) return -EINVAL; return 0; } static int max98512_get_amp_l_status(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); int val = 0; max98512_wrapper_read(max98512, MAX98512L, MAX98512_R0400_GLOBAL_SHDN, &val); ucontrol->value.integer.value[0] = val; return 0; } static int max98512_set_amp_l_status(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); max98512_spk_enable_l(max98512, ucontrol->value.integer.value[0]); return 0; } static const char *const pdm_1_text[] = { "Current", "Voltage", }; static const char *const pdm_0_text[] = { "Current", "Voltage", }; static const char * const max98512_speaker_source_text[] = { "i2s", "reserved", "tone", "pdm" }; static const char * const max98512_monomix_output_text[] = { "ch_0", "ch_1", "ch_1_2_div" }; static const char * const max98512_one_stop_mode_text[] = { "Stereo", "Stereo II", "Mono Left", "Mono Right", "Receiver Left", "Receiver Right", "Stereo Left", "Stereo Right" }; static const char * const max98512_boost_mode_text[] = { "Automatic Bypass", "Bypass On", "Bypass Off" }; static const char * const max98512_spk_analog_gain_text[] = { "mute", "3dB", "6dB", "9dB", "12dB", "15dB", "18dB" }; static const char * const max98512_spk_analog_right_gain_text[] = { "mute", "3dB", "6dB", "9dB", "12dB", "15dB", "18dB" }; static bool max98512_readable_register(struct device *dev, unsigned int reg) { switch (reg) { case MAX98512_R0001_INT_RAW1 ... MAX98512_R0028_ICC_RX_EN_B: case MAX98512_R002B_ICC_TX_EN_A ... MAX98512_R002C_ICC_TX_EN_B: case MAX98512_R002D_ICC_HIZ_MANUAL_MODE ... MAX98512_R004E_SQUELCH: case MAX98512_R004F_BROWNOUT_STATUS ... MAX98512_R0053_BROWNOUT_LVL_HOLD: case MAX98512_R0058_BROWNOUT_LVL1_THRESH ... MAX98512_R005F_BROWNOUT_AMP1_CLIP_MODE: case MAX98512_R0070_BROWNOUT_LVL1_CUR_LIMIT ... MAX98512_R0088_BOOST_BYPASS_3: case MAX98512_R0400_GLOBAL_SHDN: case MAX98512_R0401_SOFT_RESET: case MAX98512_R0402_REV_ID: return true; default: return false; } }; static bool max98512_volatile_reg(struct device *dev, unsigned int reg) { switch (reg) { case MAX98512_R0001_INT_RAW1 ... MAX98512_R0009_INT_FLAG3: return true; default: return false; } } static const char * const max98512_boost_voltage_text[] = { "6.5V", "6.625V", "6.75V", "6.875V", "7V", "7.125V", "7.25V", "7.375V", "7.5V", "7.625V", "7.75V", "7.875V", "8V", "8.125V", "8.25V", "8.375V", "8.5V", "8.625V", "8.75V", "8.875V", "9V", "9.125V", "9.25V", "9.375V", "9.5V", "9.625V", "9.75V", "9.875V", "10V" }; static SOC_ENUM_SINGLE_DECL(max98512_boost_voltage, MAX98512_R003E_BOOST_CTRL0, 0, max98512_boost_voltage_text); static const char * const max98512_current_limit_text[] = { "1.00A", "1.10A", "1.20A", "1.30A", "1.40A", "1.50A", "1.60A", "1.70A", "1.80A", "1.90A", "2.00A", "2.10A", "2.20A", "2.30A", "2.40A", "2.50A", "2.60A", "2.70A", "2.80A", "2.90A", "3.00A", "3.10A", "3.20A", "3.30A", "3.40A", "3.50A", "3.60A", "3.70A", "3.80A", "3.90A", "4.00A", "4.10A" }; static SOC_ENUM_SINGLE_DECL(max98512_current_limit, MAX98512_R0040_BOOST_CTRL1, 1, max98512_current_limit_text); static int max98512_pdm_gain_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); ucontrol->value.integer.value[0] = max98512->pdm_gain; msg_maxim("pdm_gain setting returned %d", (int) ucontrol->value.integer.value[0]); return 0; } static int max98512_pdm_gain_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); unsigned int sel = ucontrol->value.integer.value[0]; if (sel < ((1 << MAX98512_PDM_GAIN_WIDTH) - 1)) { max98512_wrapper_update(max98512, MAX98512B, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PDM_GAIN_MASK, sel << MAX98512_PDM_GAIN_SHIFT); max98512->pdm_gain = sel; } return 0; } static int max98512_rcv_digital_gain_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); ucontrol->value.integer.value[0] = max98512->digital_gain_rcv; msg_maxim("digital_gain_rcv setting returned %d", (int) ucontrol->value.integer.value[0]); return 0; } static int max98512_rcv_digital_gain_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); unsigned int sel = ucontrol->value.integer.value[0]; if (sel < (1 << MAX98512_AMP_VOL_WIDTH) - 1) { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R0035_AMP_VOL_CTRL, MAX98512_AMP_VOL_MASK, sel); max98512->digital_gain_rcv = sel; } return 0; } static int max98512_analog_gain_l_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); ucontrol->value.integer.value[0] = max98512->spk_gain_left; msg_maxim("spk_gain_left for left analog setting returned %d", (int) ucontrol->value.integer.value[0]); return 0; } static int max98512_analog_gain_l_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); int sel = (int)ucontrol->value.integer.value[0]; msg_maxim("set spk_gain_left [%d] for left channel", sel); if (sel < (1 << MAX98512_AMP_VOL_WIDTH) - 1) { max98512_wrapper_update(max98512, MAX98512L, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PCM_GAIN_MASK, sel); max98512->spk_gain_left = sel; } return 0; } static int max98512_analog_gain_r_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); ucontrol->value.integer.value[0] = max98512->spk_gain_right; msg_maxim("spk_gain_right for right analog setting returned %d", (int) ucontrol->value.integer.value[0]); return 0; } static int max98512_analog_gain_r_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); int sel = (int)ucontrol->value.integer.value[0]; msg_maxim("set spk_gain_right [%d] for right channel", sel); if (sel < (1 << MAX98512_AMP_VOL_WIDTH) - 1) { max98512_wrapper_update(max98512, MAX98512R, MAX98512_R003A_SPK_GAIN, MAX98512_SPK_PCM_GAIN_MASK, sel); max98512->spk_gain_right = sel; } return 0; } static int max98512_one_stop_mode_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); struct max98512_pdata *pdata = max98512->pdata; ucontrol->value.integer.value[0] = pdata->osm; return 0; } static int max98512_one_stop_mode_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); struct max98512_pdata *pdata = max98512->pdata; int osm = (int)ucontrol->value.integer.value[0]; osm = osm < 0 ? 0 : osm; if (osm < MAX98512_OSM_MAX && pdata->osm != osm) pdata->osm = osm; msg_maxim("mixer set OSM[%d]", pdata->osm); return osm >= MAX98512_OSM_MAX ? -EINVAL : 0; } static int max98512_boost_mode_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); struct max98512_pdata *pdata = max98512->pdata; ucontrol->value.integer.value[0] = pdata->boost_mode; return 0; } static int max98512_boost_mode_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); struct max98512_pdata *pdata = max98512->pdata; int boost_mode = (int)ucontrol->value.integer.value[0]; boost_mode = boost_mode < 0 ? 0 : boost_mode; max98512_wrapper_write(max98512, MAX98512L, MAX98512_R0087_BOOST_BYPASS_2, boost_mode); pdata->boost_mode = boost_mode; return 0; } static const struct soc_enum max98512_enum[] = { SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(pdm_0_text), pdm_0_text), SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(pdm_1_text), pdm_1_text), SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(max98512_one_stop_mode_text), max98512_one_stop_mode_text), SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(max98512_boost_mode_text), max98512_boost_mode_text), SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(max98512_spk_analog_gain_text), max98512_spk_analog_gain_text), SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(max98512_spk_analog_right_gain_text), max98512_spk_analog_right_gain_text), }; static const struct snd_kcontrol_new max98512_snd_controls[] = { SOC_SINGLE_TLV("Speaker Volume", MAX98512_R003A_SPK_GAIN, 0, 6, 0, max98512_spk_tlv), SOC_SINGLE_TLV("Digital Volume", MAX98512_R0035_AMP_VOL_CTRL, 0, (1 << MAX98512_AMP_VOL_WIDTH) - 1, 0, max98512_digital_tlv), SOC_SINGLE("Amp DSP Switch", MAX98512_R0050_BROWNOUT_EN, MAX98512_BROWNOUT_DSP_SHIFT, 1, 0), SOC_SINGLE("Ramp Switch", MAX98512_R0036_AMP_DSP_CFG, MAX98512_AMP_DSP_CFG_RMP_SHIFT, 1, 0), SOC_SINGLE("Volume Location Switch", MAX98512_R0035_AMP_VOL_CTRL, MAX98512_AMP_VOL_SEL_SHIFT, 1, 0), SOC_ENUM("Boost Output Voltage", max98512_boost_voltage), SOC_ENUM("Current Limit", max98512_current_limit), SOC_SINGLE_EXT_TLV("Pdm Gain", MAX98512_R003A_SPK_GAIN, MAX98512_PDM_GAIN_SHIFT, (1 << MAX98512_PDM_GAIN_WIDTH) - 1, 0, max98512_pdm_gain_get, max98512_pdm_gain_put, max98512_pdm_tlv), SOC_SINGLE_EXT_TLV("Rcv Digital Gain", MAX98512_R0035_AMP_VOL_CTRL, 0, (1 << MAX98512_AMP_VOL_WIDTH) - 1, 0, max98512_rcv_digital_gain_get, max98512_rcv_digital_gain_put, max98512_digital_tlv), SOC_ENUM_EXT("PDM_L_CH_0", max98512_enum[0], max98512_get_pdm_l_zero, max98512_put_pdm_l_zero), SOC_ENUM_EXT("PDM_L_CH_1", max98512_enum[1], max98512_get_pdm_l_one, max98512_put_pdm_l_one), SOC_ENUM_EXT("One Stop Mode", max98512_enum[2], max98512_one_stop_mode_get, max98512_one_stop_mode_put), SOC_ENUM_EXT("Boost Bypass Mode", max98512_enum[3], max98512_boost_mode_get, max98512_boost_mode_put), SOC_ENUM_EXT("SPK Analog Left Gain", max98512_enum[4], max98512_analog_gain_l_get, max98512_analog_gain_l_put), SOC_ENUM_EXT("SPK Analog Right Gain", max98512_enum[5], max98512_analog_gain_r_get, max98512_analog_gain_r_put), SOC_SINGLE_EXT("Spk AmpL Power", SND_SOC_NOPM, 0, 1, 0, max98512_get_amp_l_status, max98512_set_amp_l_status), }; static struct snd_soc_dai_driver max98512_dai[] = { { .name = "max98512-aif1", .playback = { .stream_name = "HiFi Playback", .channels_min = 1, .channels_max = 2, .rates = MAX98512_RATES, .formats = MAX98512_FORMATS, }, .capture = { .stream_name = "HiFi Capture", .channels_min = 1, .channels_max = 2, .rates = MAX98512_RATES, .formats = MAX98512_FORMATS, }, .ops = &max98512_dai_ops, } }; static int max98512_probe(struct snd_soc_codec *codec) { struct max98512_priv *max98512 = snd_soc_codec_get_drvdata(codec); struct max98512_pdata *pdata = max98512->pdata; struct max98512_volume_step_info *vstep = &max98512->vstep; int ret = 0, reg = 0x0; unsigned int vimon = pdata->nodsm ? 0 : MAX98512_MEAS_VI_EN; max98512->codec = codec; codec->control_data = max98512->regmap_l; regcache_cache_bypass(max98512->regmap_l, true); if (max98512->mono_stereo) regcache_cache_bypass(max98512->regmap_r, true); ret = snd_soc_add_codec_controls(codec, max98512_snd_controls, ARRAY_SIZE(max98512_snd_controls)); if (ret < 0) { msg_maxim("Failed to add controls to max98512: %d\n", ret); return ret; } ret = max98512_wrapper_read(max98512, MAX98512L, MAX98512_R0402_REV_ID, ®); msg_maxim("L device version 0x%02X", reg); reg = 0x0; if (max98512->mono_stereo) { ret = max98512_wrapper_read(max98512, MAX98512R, MAX98512_R0402_REV_ID, ®); msg_maxim("R device version 0x%02X", reg); } max98512_wrapper_read(max98512, MAX98512L, MAX98512_R003E_BOOST_CTRL0, &pdata->boostv); /* Software Reset */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0401_SOFT_RESET, MAX98512_SOFT_RESET); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R003C_MEAS_EN, vimon); vstep->adc_status = !!vimon; /* IV default slot configuration */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R001C_PCM_TX_HIZ_CTRL_A, 0xFF); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R001D_PCM_TX_HIZ_CTRL_B, 0xFF); if (max98512->mono_stereo) { msg_maxim("Stereo channel setting!!!"); max98512_wrapper_write(max98512, MAX98512L, MAX98512_R0025_PCM_TO_SPK_MONOMIX_A, 0x0); max98512_wrapper_write(max98512, MAX98512L, MAX98512_R0026_PCM_TO_SPK_MONOMIX_B, 0x0); max98512_wrapper_write(max98512, MAX98512R, MAX98512_R0025_PCM_TO_SPK_MONOMIX_A, 0x41); max98512_wrapper_write(max98512, MAX98512R, MAX98512_R0026_PCM_TO_SPK_MONOMIX_B, 0x1); } else { max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0025_PCM_TO_SPK_MONOMIX_A, 0x80); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0026_PCM_TO_SPK_MONOMIX_B, 0x1); } /* Set inital volume (+15dB) */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0035_AMP_VOL_CTRL, 0x40); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R003A_SPK_GAIN, 0x05); /* Enable DC blocker */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0036_AMP_DSP_CFG, 0x01); /* Enable IMON VMON DC blocker */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R003D_MEAS_DSP_CFG, 0xF7); /* Boost Output Voltage & Current limit */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R003E_BOOST_CTRL0, 0x1C); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0040_BOOST_CTRL1, 0x3E); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R003F_BOOST_CTRL3, 0x01); /* Measurement ADC config */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0041_MEAS_ADC_CFG, 0x07); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0042_MEAS_ADC_BASE_MSB, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0043_MEAS_ADC_BASE_LSB, 0x0B); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0044_ADC_CH0_DIVIDE, 0x02); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0045_ADC_CH1_DIVIDE, 0x02); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0046_ADC_CH2_DIVIDE, 0x02); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0047_ADC_CH0_FILT_CFG, 0x0C); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0048_ADC_CH1_FILT_CFG, 0x0C); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0049_ADC_CH2_FILT_CFG, 0x0C); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R004E_SQUELCH, 0x10); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0050_BROWNOUT_EN, 0x07); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0053_BROWNOUT_LVL_HOLD, 0xFF); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0058_BROWNOUT_LVL1_THRESH, 0xA0); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0059_BROWNOUT_LVL2_THRESH, 0x30); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R005A_BROWNOUT_LVL3_THRESH, 0x10); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R005C_BROWNOUT_THRESH_HYSTERYSIS, 0x0F); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R005D_BROWNOUT_AMP_LIMITER_ATK_REL, 0x76); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0070_BROWNOUT_LVL1_CUR_LIMIT, 0x3E); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0071_BROWNOUT_LVL1_AMP1_CTRL1, 0x06); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0072_BROWNOUT_LVL1_AMP1_CTRL2, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0073_BROWNOUT_LVL1_AMP1_CTRL3, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0074_BROWNOUT_LVL2_CUR_LIMIT, 0x3E); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0075_BROWNOUT_LVL2_AMP1_CTRL1, 0x09); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0076_BROWNOUT_LVL2_AMP1_CTRL2, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0077_BROWNOUT_LVL2_AMP1_CTRL3, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0078_BROWNOUT_LVL3_CUR_LIMIT, 0x3E); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0079_BROWNOUT_LVL3_AMP1_CTRL1, 0x0C); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R007A_BROWNOUT_LVL3_AMP1_CTRL2, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R007B_BROWNOUT_LVL3_AMP1_CTRL3, 0x00); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R007C_BROWNOUT_LVL4_CUR_LIMIT, 0x00); /* Brownout Level */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R007D_BROWNOUT_LVL4_AMP1_CTRL1, 0x00); /* Envelope Tracking configuration */ max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0080_ENV_TRACK_VOUT_HEADROOM, 0x0A); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0084_ENV_TRACK_CTRL, 0x01); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0085_ENV_TRACK_BOOST_VOUT_READ, 0x10); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0086_BOOST_BYPASS_1, 0x05); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0087_BOOST_BYPASS_2, 0x03); max98512_wrapper_write(max98512, MAX98512B, MAX98512_R0088_BOOST_BYPASS_3, 0x01); /* voltage, current slot configuration */ max98512_adc_config(max98512); msg_maxim("End"); return 0; } static const struct snd_soc_codec_driver soc_codec_dev_max98512 = { .probe = max98512_probe, }; static const struct regmap_config max98512_regmap = { .reg_bits = 16, .val_bits = 8, .max_register = MAX98512_R0402_REV_ID, .reg_defaults = max98512_reg, .num_reg_defaults = ARRAY_SIZE(max98512_reg), .readable_reg = max98512_readable_register, .volatile_reg = max98512_volatile_reg, .cache_type = REGCACHE_RBTREE, }; static void max98512_slot_config(struct i2c_client *i2c, struct max98512_priv *max98512) { int value; if (!of_property_read_u32(i2c->dev.of_node, "vmon-l-slot-no", &value)) max98512->v_l_slot = value & 0xF; else max98512->v_l_slot = 0; if (!of_property_read_u32(i2c->dev.of_node, "imon-l-slot-no", &value)) max98512->i_l_slot = value & 0xF; else max98512->i_l_slot = 0; if (!of_property_read_u32(i2c->dev.of_node, "vmon-r-slot-no", &value)) max98512->v_r_slot = value & 0xF; else max98512->v_r_slot = 1; if (!of_property_read_u32(i2c->dev.of_node, "imon-r-slot-no", &value)) max98512->i_r_slot = value & 0xF; else max98512->i_r_slot = 1; } static struct i2c_board_info max98512_i2c_sub_board[] = { { I2C_BOARD_INFO("max98512_sub", 0x3a), } }; static struct i2c_driver max98512_i2c_sub_driver = { .driver = { .name = "max98512_sub", .owner = THIS_MODULE, }, }; struct i2c_client *max98512_add_sub_device(int bus_id, int slave_addr) { struct i2c_client *i2c = NULL; struct i2c_adapter *adapter; msg_maxim("bus_id:%d, slave_addr:0x%x", bus_id, slave_addr); max98512_i2c_sub_board[0].addr = slave_addr; adapter = i2c_get_adapter(bus_id); if (adapter) { i2c = i2c_new_device(adapter, max98512_i2c_sub_board); if (i2c) i2c->dev.driver = &max98512_i2c_sub_driver.driver; } return i2c; } static int max98512_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id) { struct max98512_priv *max98512; struct max98512_pdata *pdata; struct max98512_volume_step_info *vstep; int ret = 0, value; msg_maxim("Start. driver_data %ld", id->driver_data); max98512 = devm_kzalloc(&i2c->dev, sizeof(*max98512), GFP_KERNEL); if (!max98512) { ret = -ENOMEM; goto err_alloc_priv; } max98512->pdata = devm_kzalloc(&i2c->dev, sizeof(struct max98512_pdata), GFP_KERNEL); if (!max98512->pdata) { ret = -ENOMEM; goto err_alloc_pdata; } i2c_set_clientdata(i2c, max98512); max98512->i2c_dev = &i2c->dev; pdata = max98512->pdata; vstep = &max98512->vstep; if (i2c->dev.of_node) { if (of_property_read_u32_array(i2c->dev.of_node, "maxim,boost_step", (uint32_t *) &vstep->boost_step, sizeof(vstep->boost_step) / sizeof(uint32_t))) { dev_warn(&i2c->dev, "set boost_step by default.\n"); for (ret = 0; ret < MAX98512_VSTEP_14; ret++) vstep->boost_step[ret] = 0x00; vstep->boost_step[MAX98512_VSTEP_14] = 0x0C; /* 8V */ vstep->boost_step[MAX98512_VSTEP_15] = 0x10; /* 8.5V */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,spk-gain", &max98512->spk_gain)) { dev_warn(&i2c->dev, "set spk_gain by default.\n"); max98512->spk_gain = 0x05; /* +15db for PCM */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,spk-gain-left", &max98512->spk_gain_left)) { dev_warn(&i2c->dev, "set spk_gain_left by default.\n"); max98512->spk_gain = 0x05; /* +15db for PCM */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,spk-gain-right", &max98512->spk_gain_right)) { dev_warn(&i2c->dev, "set spk_gain_right by default.\n"); max98512->spk_gain = 0x05; /* +15db for PCM */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,spk-gain-rcv", &max98512->spk_gain_rcv)) { dev_warn(&i2c->dev, "set spk_gain-rcv by default.\n"); max98512->spk_gain_rcv = 0x01; /* +3db for RCV */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,digital-gain", &max98512->digital_gain)) { dev_warn(&i2c->dev, "set digital_gain by default.\n"); max98512->digital_gain = 0x40; /* 0db */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,digital-gain-rcv", &max98512->digital_gain_rcv)) { dev_warn(&i2c->dev, "set digital_gain-rcv by default.\n"); max98512->digital_gain_rcv = 0x34; /* -3db */ } if (of_property_read_u32(i2c->dev.of_node, "maxim,sysclk", &max98512->sysclk)) { dev_warn(&i2c->dev, "set sysclk by default value.\n"); max98512->sysclk = 12288000; } if (!of_property_read_u32(i2c->dev.of_node, "maxim,mono_stereo", &value)) { max98512->mono_stereo = value; } else max98512->mono_stereo = 0; dev_info(&i2c->dev, "mono_stereo %d\n", max98512->mono_stereo); /* update interleave mode info */ if (!of_property_read_u32(i2c->dev.of_node, "interleave_mode", &value)) { if (value > 0) max98512->interleave_mode = 1; else max98512->interleave_mode = 0; } else max98512->interleave_mode = 0; if (of_property_read_u32(i2c->dev.of_node, "maxim,adc_threshold", &vstep->adc_thres)) { dev_warn(&i2c->dev, "set adc_threshold by default.\n"); vstep->adc_thres = MAX98512_VSTEP_8; } pdata->reg_arr = of_get_property(i2c->dev.of_node, "maxim,registers-of-amp", &pdata->reg_arr_len); pdata->nodsm = of_property_read_bool(i2c->dev.of_node, "maxim,nodsm"); msg_maxim("use DSM(%d)", pdata->nodsm); /* update sub device info */ if (of_property_read_u32(i2c->dev.of_node, "maxim,sub_reg", &pdata->sub_reg)) { dev_err(&i2c->dev, "sub-device register was not found.\n"); pdata->sub_reg = 0; } else dev_info(&i2c->dev, "set sub-device address %#x", pdata->sub_reg); } else { /* If i2c->dev.of_node is not found */ max98512->sysclk = 12288000; for (ret = 0; ret < MAX98512_VSTEP_14; ret++) vstep->boost_step[ret] = 0x00; vstep->boost_step[MAX98512_VSTEP_14] = 0x0C; /* 8V */ vstep->boost_step[MAX98512_VSTEP_15] = 0x10; /* 8.5V */ max98512->spk_gain = 0x05; /* +15db for PCM */ max98512->digital_gain = 0x40; /* 0db */ max98512->mono_stereo = 0; max98512->interleave_mode = 0; vstep->adc_thres = MAX98512_VSTEP_8; pdata->nodsm = 0; } /* regmap init */ max98512->regmap_l = regmap_init_i2c(i2c, &max98512_regmap); if (IS_ERR(max98512->regmap_l)) { ret = PTR_ERR(max98512->regmap_l); dev_err(&i2c->dev, "Failed to allocate regmap_l: %d\n", ret); goto err_regmap; } else { regcache_cache_bypass(max98512->regmap_l, true); msg_maxim("regmap_L %p", max98512->regmap_l); } /* regmap init for sub-device */ if (pdata->sub_reg) { max98512->sub_i2c = max98512_add_sub_device(i2c->adapter->nr, pdata->sub_reg); if (IS_ERR(max98512->sub_i2c)) { dev_err(&max98512->sub_i2c->dev, "second max98512 was not found\n"); ret = -ENODEV; goto err_regmap; } else { max98512->regmap_r = regmap_init_i2c(max98512->sub_i2c, &max98512_regmap); if (IS_ERR(max98512->regmap_r)) { ret = PTR_ERR(max98512->regmap_r); dev_err(&max98512->sub_i2c->dev, "Failed to allocate regmap_r: %d\n", ret); goto err_regmap; } else { regcache_cache_bypass(max98512->regmap_r, true); msg_maxim("regmap_R %p", max98512->regmap_r); } } } /* voltage/current slot configuration */ if (max98512->mono_stereo) { if (max98512->regmap_r && max98512->regmap_l) max98512_slot_config(i2c, max98512); } else if (max98512->regmap_l && !max98512->mono_stereo) max98512_slot_config(i2c, max98512); /* codec registeration */ ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_max98512, max98512_dai, ARRAY_SIZE(max98512_dai)); if (ret < 0) { dev_err(&i2c->dev, "Failed to register codec: %d\n", ret); goto err_register_codec; } g_max98512 = max98512; msg_maxim("End. driver_data %ld", id->driver_data); return 0; err_register_codec: if (max98512->regmap_l) regmap_exit(max98512->regmap_l); if (max98512->regmap_r) regmap_exit(max98512->regmap_r); err_regmap: devm_kfree(&i2c->dev, max98512->pdata); err_alloc_pdata: devm_kfree(&i2c->dev, max98512); err_alloc_priv: msg_maxim("Failed with %d. driver_data %ld", ret, id->driver_data); return ret; } static int max98512_i2c_remove(struct i2c_client *client) { struct max98512_priv *max98512 = i2c_get_clientdata(client); struct max98512_pdata *pdata = max98512->pdata; snd_soc_unregister_codec(&client->dev); if (max98512->regmap_l) regmap_exit(max98512->regmap_l); if (max98512->regmap_r) regmap_exit(max98512->regmap_r); devm_kfree(&client->dev, pdata); devm_kfree(&client->dev, max98512); return 0; } static const struct i2c_device_id max98512_i2c_id[] = { { "max98512", MAX98512}, { }, }; MODULE_DEVICE_TABLE(i2c, max98512_i2c_id); #ifdef CONFIG_OF static const struct of_device_id max98512_of_match[] = { { .compatible = "maxim,max98512", }, { } }; MODULE_DEVICE_TABLE(of, max98512_of_match); #endif static struct i2c_driver max98512_i2c_driver = { .driver = { .name = "max98512", .of_match_table = of_match_ptr(max98512_of_match), .pm = NULL, }, .probe = max98512_i2c_probe, .remove = max98512_i2c_remove, .id_table = max98512_i2c_id, }; module_i2c_driver(max98512_i2c_driver) MODULE_DESCRIPTION("ALSA SoC MAX98512 driver"); MODULE_AUTHOR("Ryan Lee "); MODULE_LICENSE("GPL");