|
@@ -1,1154 +0,0 @@
|
|
|
-// SPDX-License-Identifier: GPL-2.0
|
|
|
-// Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
|
|
|
-// Copyright (c) 2017-2018, Linaro Limited
|
|
|
-
|
|
|
-#include <linux/module.h>
|
|
|
-#include <linux/init.h>
|
|
|
-#include <linux/platform_device.h>
|
|
|
-#include <linux/device.h>
|
|
|
-#include <linux/wait.h>
|
|
|
-#include <linux/bitops.h>
|
|
|
-#include <linux/regulator/consumer.h>
|
|
|
-#include <linux/clk.h>
|
|
|
-#include <linux/delay.h>
|
|
|
-#include <linux/kernel.h>
|
|
|
-#include <linux/slimbus.h>
|
|
|
-#include <sound/soc.h>
|
|
|
-#include <sound/pcm_params.h>
|
|
|
-#include <sound/soc-dapm.h>
|
|
|
-#include <sound/tlv.h>
|
|
|
-#include <sound/info.h>
|
|
|
-#include <dt-bindings/mfd/wcd9335.h>
|
|
|
-#include <linux/mfd/wcd9335/wcd9335.h>
|
|
|
-#include <linux/mfd/wcd9335/registers.h>
|
|
|
-
|
|
|
-#define WCD9335_RATES_MASK (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
|
|
|
- SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
|
|
|
- SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
|
|
|
-/* Fractional Rates */
|
|
|
-#define WCD9335_FRAC_RATES_MASK (SNDRV_PCM_RATE_44100)
|
|
|
-#define WCD9335_FORMATS_S16_S24_LE (SNDRV_PCM_FMTBIT_S16_LE | \
|
|
|
- SNDRV_PCM_FMTBIT_S24_LE)
|
|
|
-
|
|
|
-/* slave port water mark level
|
|
|
- * (0: 6bytes, 1: 9bytes, 2: 12 bytes, 3: 15 bytes)
|
|
|
- */
|
|
|
-#define SLAVE_PORT_WATER_MARK_6BYTES 0
|
|
|
-#define SLAVE_PORT_WATER_MARK_9BYTES 1
|
|
|
-#define SLAVE_PORT_WATER_MARK_12BYTES 2
|
|
|
-#define SLAVE_PORT_WATER_MARK_15BYTES 3
|
|
|
-#define SLAVE_PORT_WATER_MARK_SHIFT 1
|
|
|
-#define SLAVE_PORT_ENABLE 1
|
|
|
-#define SLAVE_PORT_DISABLE 0
|
|
|
-#define WCD9335_SLIM_WATER_MARK_VAL \
|
|
|
- ((SLAVE_PORT_WATER_MARK_12BYTES << SLAVE_PORT_WATER_MARK_SHIFT) | \
|
|
|
- (SLAVE_PORT_ENABLE))
|
|
|
-
|
|
|
-#define WCD9335_SLIM_NUM_PORT_REG 3
|
|
|
-#define WCD9335_SLIM_PGD_PORT_INT_TX_EN0 (WCD9335_SLIM_PGD_PORT_INT_EN0 + 2)
|
|
|
-
|
|
|
-#define WCD9335_MCLK_CLK_12P288MHZ 12288000
|
|
|
-#define WCD9335_MCLK_CLK_9P6MHZ 9600000
|
|
|
-
|
|
|
-#define WCD9335_SLIM_CLOSE_TIMEOUT 1000
|
|
|
-#define WCD9335_SLIM_IRQ_OVERFLOW (1 << 0)
|
|
|
-#define WCD9335_SLIM_IRQ_UNDERFLOW (1 << 1)
|
|
|
-#define WCD9335_SLIM_IRQ_PORT_CLOSED (1 << 2)
|
|
|
-
|
|
|
-#define WCD9335_NUM_INTERPOLATORS 9
|
|
|
-#define WCD9335_RX_START 16
|
|
|
-#define WCD9335_SLIM_CH_START 128
|
|
|
-
|
|
|
-#define WCD9335_SLIM_RX_CH(p) \
|
|
|
- {.port = p + WCD9335_RX_START, .shift = p,}
|
|
|
-
|
|
|
-/* vout step value */
|
|
|
-#define WCD9335_CALCULATE_VOUT_D(req_mv) (((req_mv - 650) * 10) / 25)
|
|
|
-
|
|
|
-enum {
|
|
|
- WCD9335_RX0 = 0,
|
|
|
- WCD9335_RX1,
|
|
|
- WCD9335_RX2,
|
|
|
- WCD9335_RX3,
|
|
|
- WCD9335_RX4,
|
|
|
- WCD9335_RX5,
|
|
|
- WCD9335_RX6,
|
|
|
- WCD9335_RX7,
|
|
|
- WCD9335_RX8,
|
|
|
- WCD9335_RX9,
|
|
|
- WCD9335_RX10,
|
|
|
- WCD9335_RX11,
|
|
|
- WCD9335_RX12,
|
|
|
- WCD9335_RX_MAX,
|
|
|
-};
|
|
|
-
|
|
|
-enum {
|
|
|
- SIDO_SOURCE_INTERNAL = 0,
|
|
|
- SIDO_SOURCE_RCO_BG,
|
|
|
-};
|
|
|
-
|
|
|
-enum wcd9335_sido_voltage {
|
|
|
- SIDO_VOLTAGE_SVS_MV = 950,
|
|
|
- SIDO_VOLTAGE_NOMINAL_MV = 1100,
|
|
|
-};
|
|
|
-
|
|
|
-enum {
|
|
|
- AIF1_PB = 0,
|
|
|
- AIF1_CAP,
|
|
|
- AIF2_PB,
|
|
|
- AIF2_CAP,
|
|
|
- AIF3_PB,
|
|
|
- AIF3_CAP,
|
|
|
- AIF4_PB,
|
|
|
- NUM_CODEC_DAIS,
|
|
|
-};
|
|
|
-
|
|
|
-enum {
|
|
|
- INTn_2_INP_SEL_ZERO = 0,
|
|
|
- INTn_2_INP_SEL_RX0,
|
|
|
- INTn_2_INP_SEL_RX1,
|
|
|
- INTn_2_INP_SEL_RX2,
|
|
|
- INTn_2_INP_SEL_RX3,
|
|
|
- INTn_2_INP_SEL_RX4,
|
|
|
- INTn_2_INP_SEL_RX5,
|
|
|
- INTn_2_INP_SEL_RX6,
|
|
|
- INTn_2_INP_SEL_RX7,
|
|
|
- INTn_2_INP_SEL_PROXIMITY,
|
|
|
-};
|
|
|
-
|
|
|
-enum {
|
|
|
- INTn_1_MIX_INP_SEL_ZERO = 0,
|
|
|
- INTn_1_MIX_INP_SEL_DEC0,
|
|
|
- INTn_1_MIX_INP_SEL_DEC1,
|
|
|
- INTn_1_MIX_INP_SEL_IIR0,
|
|
|
- INTn_1_MIX_INP_SEL_IIR1,
|
|
|
- INTn_1_MIX_INP_SEL_RX0,
|
|
|
- INTn_1_MIX_INP_SEL_RX1,
|
|
|
- INTn_1_MIX_INP_SEL_RX2,
|
|
|
- INTn_1_MIX_INP_SEL_RX3,
|
|
|
- INTn_1_MIX_INP_SEL_RX4,
|
|
|
- INTn_1_MIX_INP_SEL_RX5,
|
|
|
- INTn_1_MIX_INP_SEL_RX6,
|
|
|
- INTn_1_MIX_INP_SEL_RX7,
|
|
|
-
|
|
|
-};
|
|
|
-
|
|
|
-enum wcd_clock_type {
|
|
|
- WCD_CLK_OFF,
|
|
|
- WCD_CLK_RCO,
|
|
|
- WCD_CLK_MCLK,
|
|
|
-};
|
|
|
-
|
|
|
-struct wcd9335_slim_ch {
|
|
|
- u32 ch_num;
|
|
|
- u16 port;
|
|
|
- u16 shift;
|
|
|
- struct list_head list;
|
|
|
-};
|
|
|
-
|
|
|
-struct wcd_slim_codec_dai_data {
|
|
|
- struct list_head slim_ch_list;
|
|
|
- struct slim_stream_config sconfig;
|
|
|
- struct slim_stream_runtime *sruntime;
|
|
|
-};
|
|
|
-
|
|
|
-struct wcd9335_codec {
|
|
|
- struct device *dev;
|
|
|
- struct clk *mclk;
|
|
|
- struct clk *native_clk;
|
|
|
- u32 mclk_rate;
|
|
|
- u8 intf_type;
|
|
|
- u8 version;
|
|
|
-
|
|
|
- struct slim_device *slim;
|
|
|
- struct slim_device *slim_ifd;
|
|
|
- struct regmap *regmap;
|
|
|
- struct regmap *if_regmap;
|
|
|
- struct regmap_irq_chip_data *irq_data;
|
|
|
-
|
|
|
- struct wcd9335_slim_ch rx_chs[WCD9335_RX_MAX];
|
|
|
- u32 num_rx_port;
|
|
|
-
|
|
|
- int sido_input_src;
|
|
|
- enum wcd9335_sido_voltage sido_voltage;
|
|
|
-
|
|
|
- struct wcd_slim_codec_dai_data dai[NUM_CODEC_DAIS];
|
|
|
- struct snd_soc_component *component;
|
|
|
-
|
|
|
- int master_bias_users;
|
|
|
- int clk_mclk_users;
|
|
|
- int clk_rco_users;
|
|
|
- int sido_ccl_cnt;
|
|
|
- enum wcd_clock_type clk_type;
|
|
|
-
|
|
|
- u32 hph_mode;
|
|
|
-};
|
|
|
-
|
|
|
-static const struct wcd9335_slim_ch wcd9335_rx_chs[WCD9335_RX_MAX] = {
|
|
|
- WCD9335_SLIM_RX_CH(0), /* 16 */
|
|
|
- WCD9335_SLIM_RX_CH(1), /* 17 */
|
|
|
- WCD9335_SLIM_RX_CH(2),
|
|
|
- WCD9335_SLIM_RX_CH(3),
|
|
|
- WCD9335_SLIM_RX_CH(4),
|
|
|
- WCD9335_SLIM_RX_CH(5),
|
|
|
- WCD9335_SLIM_RX_CH(6),
|
|
|
- WCD9335_SLIM_RX_CH(7),
|
|
|
- WCD9335_SLIM_RX_CH(8),
|
|
|
- WCD9335_SLIM_RX_CH(9),
|
|
|
- WCD9335_SLIM_RX_CH(10),
|
|
|
- WCD9335_SLIM_RX_CH(11),
|
|
|
- WCD9335_SLIM_RX_CH(12),
|
|
|
-};
|
|
|
-
|
|
|
-struct interp_sample_rate {
|
|
|
- int rate;
|
|
|
- int rate_val;
|
|
|
-};
|
|
|
-
|
|
|
-static struct interp_sample_rate int_mix_rate_val[] = {
|
|
|
- {48000, 0x4}, /* 48K */
|
|
|
- {96000, 0x5}, /* 96K */
|
|
|
- {192000, 0x6}, /* 192K */
|
|
|
-};
|
|
|
-
|
|
|
-static struct interp_sample_rate int_prim_rate_val[] = {
|
|
|
- {8000, 0x0}, /* 8K */
|
|
|
- {16000, 0x1}, /* 16K */
|
|
|
- {24000, -EINVAL},/* 24K */
|
|
|
- {32000, 0x3}, /* 32K */
|
|
|
- {48000, 0x4}, /* 48K */
|
|
|
- {96000, 0x5}, /* 96K */
|
|
|
- {192000, 0x6}, /* 192K */
|
|
|
- {384000, 0x7}, /* 384K */
|
|
|
- {44100, 0x8}, /* 44.1K */
|
|
|
-};
|
|
|
-
|
|
|
-struct wcd9335_reg_mask_val {
|
|
|
- u16 reg;
|
|
|
- u8 mask;
|
|
|
- u8 val;
|
|
|
-};
|
|
|
-
|
|
|
-static const struct wcd9335_reg_mask_val wcd9335_codec_reg_init_val_2_0[] = {
|
|
|
- {WCD9335_RCO_CTRL_2, 0x0F, 0x08},
|
|
|
- {WCD9335_RX_BIAS_FLYB_MID_RST, 0xF0, 0x10},
|
|
|
- {WCD9335_FLYBACK_CTRL_1, 0x20, 0x20},
|
|
|
- {WCD9335_HPH_OCP_CTL, 0xFF, 0x5A},
|
|
|
- {WCD9335_HPH_L_TEST, 0x01, 0x01},
|
|
|
- {WCD9335_HPH_R_TEST, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_BOOST0_BOOST_CFG1, 0x3F, 0x12},
|
|
|
- {WCD9335_CDC_BOOST0_BOOST_CFG2, 0x1C, 0x08},
|
|
|
- {WCD9335_CDC_COMPANDER7_CTL7, 0x1E, 0x18},
|
|
|
- {WCD9335_CDC_BOOST1_BOOST_CFG1, 0x3F, 0x12},
|
|
|
- {WCD9335_CDC_BOOST1_BOOST_CFG2, 0x1C, 0x08},
|
|
|
- {WCD9335_CDC_COMPANDER8_CTL7, 0x1E, 0x18},
|
|
|
- {WCD9335_CDC_TX0_TX_PATH_SEC7, 0xFF, 0x45},
|
|
|
- {WCD9335_CDC_RX0_RX_PATH_SEC0, 0xFC, 0xF4},
|
|
|
- {WCD9335_HPH_REFBUFF_LP_CTL, 0x08, 0x08},
|
|
|
- {WCD9335_HPH_REFBUFF_LP_CTL, 0x06, 0x02},
|
|
|
-};
|
|
|
-
|
|
|
-static const struct wcd9335_reg_mask_val wcd9335_codec_reg_init_common_val[] = {
|
|
|
- /* Rbuckfly/R_EAR(32) */
|
|
|
- {WCD9335_CDC_CLSH_K2_MSB, 0x0F, 0x00},
|
|
|
- {WCD9335_CDC_CLSH_K2_LSB, 0xFF, 0x60},
|
|
|
- {WCD9335_CPE_SS_DMIC_CFG, 0x80, 0x00},
|
|
|
- {WCD9335_CDC_BOOST0_BOOST_CTL, 0x70, 0x50},
|
|
|
- {WCD9335_CDC_BOOST1_BOOST_CTL, 0x70, 0x50},
|
|
|
- {WCD9335_CDC_RX7_RX_PATH_CFG1, 0x08, 0x08},
|
|
|
- {WCD9335_CDC_RX8_RX_PATH_CFG1, 0x08, 0x08},
|
|
|
- {WCD9335_ANA_LO_1_2, 0x3C, 0X3C},
|
|
|
- {WCD9335_DIFF_LO_COM_SWCAP_REFBUF_FREQ, 0x70, 0x00},
|
|
|
- {WCD9335_DIFF_LO_COM_PA_FREQ, 0x70, 0x40},
|
|
|
- {WCD9335_SOC_MAD_AUDIO_CTL_2, 0x03, 0x03},
|
|
|
- {WCD9335_CDC_TOP_TOP_CFG1, 0x02, 0x02},
|
|
|
- {WCD9335_CDC_TOP_TOP_CFG1, 0x01, 0x01},
|
|
|
- {WCD9335_EAR_CMBUFF, 0x08, 0x00},
|
|
|
- {WCD9335_CDC_TX9_SPKR_PROT_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_TX10_SPKR_PROT_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_TX11_SPKR_PROT_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_TX12_SPKR_PROT_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_COMPANDER7_CTL3, 0x80, 0x80},
|
|
|
- {WCD9335_CDC_COMPANDER8_CTL3, 0x80, 0x80},
|
|
|
- {WCD9335_CDC_COMPANDER7_CTL7, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_COMPANDER8_CTL7, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX0_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX1_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX2_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX3_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX4_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX5_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX6_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX7_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX8_RX_PATH_CFG0, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX0_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX1_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX2_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX3_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX4_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX5_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX6_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX7_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_CDC_RX8_RX_PATH_MIX_CFG, 0x01, 0x01},
|
|
|
- {WCD9335_VBADC_IBIAS_FE, 0x0C, 0x08},
|
|
|
-};
|
|
|
-
|
|
|
-static int wcd9335_set_mix_interpolator_rate(struct snd_soc_dai *dai,
|
|
|
- int rate_val,
|
|
|
- u32 rate)
|
|
|
-{
|
|
|
- struct snd_soc_component *component = dai->component;
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(component->dev);
|
|
|
- struct wcd9335_slim_ch *ch;
|
|
|
- int val, j;
|
|
|
-
|
|
|
- list_for_each_entry(ch, &wcd->dai[dai->id].slim_ch_list, list) {
|
|
|
- for (j = 0; j < WCD9335_NUM_INTERPOLATORS; j++) {
|
|
|
- val = snd_soc_component_read32(component,
|
|
|
- WCD9335_CDC_RX_INP_MUX_RX_INT_CFG1(j)) &
|
|
|
- WCD9335_CDC_RX_INP_MUX_RX_INT_SEL_MASK;
|
|
|
-
|
|
|
- if (val == (ch->shift + INTn_2_INP_SEL_RX0))
|
|
|
- snd_soc_component_update_bits(component,
|
|
|
- WCD9335_CDC_RX_PATH_MIX_CTL(j),
|
|
|
- WCD9335_CDC_MIX_PCM_RATE_MASK,
|
|
|
- rate_val);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_set_prim_interpolator_rate(struct snd_soc_dai *dai,
|
|
|
- u8 rate_val,
|
|
|
- u32 rate)
|
|
|
-{
|
|
|
- struct snd_soc_component *comp = dai->component;
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(comp->dev);
|
|
|
- struct wcd9335_slim_ch *ch;
|
|
|
- u8 cfg0, cfg1, inp0_sel, inp1_sel, inp2_sel;
|
|
|
- int inp, j;
|
|
|
-
|
|
|
- list_for_each_entry(ch, &wcd->dai[dai->id].slim_ch_list, list) {
|
|
|
- inp = ch->shift + INTn_1_MIX_INP_SEL_RX0;
|
|
|
- /*
|
|
|
- * Loop through all interpolator MUX inputs and find out
|
|
|
- * to which interpolator input, the slim rx port
|
|
|
- * is connected
|
|
|
- */
|
|
|
- for (j = 0; j < WCD9335_NUM_INTERPOLATORS; j++) {
|
|
|
- cfg0 = snd_soc_component_read32(comp,
|
|
|
- WCD9335_CDC_RX_INP_MUX_RX_INT_CFG0(j));
|
|
|
- cfg1 = snd_soc_component_read32(comp,
|
|
|
- WCD9335_CDC_RX_INP_MUX_RX_INT_CFG1(j));
|
|
|
-
|
|
|
- inp0_sel = cfg0 & WCD9335_CDC_RX_INP_MUX_RX_INT_SEL_MASK;
|
|
|
- inp1_sel = (cfg0 >> 4) & WCD9335_CDC_RX_INP_MUX_RX_INT_SEL_MASK;
|
|
|
- inp2_sel = (cfg1 >> 4) & WCD9335_CDC_RX_INP_MUX_RX_INT_SEL_MASK;
|
|
|
-
|
|
|
- if ((inp0_sel == inp) || (inp1_sel == inp) ||
|
|
|
- (inp2_sel == inp)) {
|
|
|
- /* rate is in Hz */
|
|
|
- if ((j == 0) && (rate == 44100))
|
|
|
- dev_info(wcd->dev,
|
|
|
- "Cannot set 44.1KHz on INT0\n");
|
|
|
- else
|
|
|
- snd_soc_component_update_bits(comp,
|
|
|
- WCD9335_CDC_RX_PATH_CTL(j),
|
|
|
- WCD9335_CDC_MIX_PCM_RATE_MASK,
|
|
|
- rate_val);
|
|
|
- }
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_set_interpolator_rate(struct snd_soc_dai *dai, u32 rate)
|
|
|
-{
|
|
|
- int i;
|
|
|
-
|
|
|
- /* set mixing path rate */
|
|
|
- for (i = 0; i < ARRAY_SIZE(int_mix_rate_val); i++) {
|
|
|
- if (rate == int_mix_rate_val[i].rate) {
|
|
|
- wcd9335_set_mix_interpolator_rate(dai,
|
|
|
- int_mix_rate_val[i].rate_val, rate);
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- /* set primary path sample rate */
|
|
|
- for (i = 0; i < ARRAY_SIZE(int_prim_rate_val); i++) {
|
|
|
- if (rate == int_prim_rate_val[i].rate) {
|
|
|
- wcd9335_set_prim_interpolator_rate(dai,
|
|
|
- int_prim_rate_val[i].rate_val, rate);
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_slim_set_hw_params(struct wcd9335_codec *wcd,
|
|
|
- struct wcd_slim_codec_dai_data *dai_data,
|
|
|
- int direction)
|
|
|
-{
|
|
|
- struct list_head *slim_ch_list = &dai_data->slim_ch_list;
|
|
|
- struct slim_stream_config *cfg = &dai_data->sconfig;
|
|
|
- struct wcd9335_slim_ch *ch;
|
|
|
- u16 payload = 0;
|
|
|
- int ret, i;
|
|
|
-
|
|
|
- cfg->ch_count = 0;
|
|
|
- cfg->direction = direction;
|
|
|
- cfg->port_mask = 0;
|
|
|
-
|
|
|
- /* Configure slave interface device */
|
|
|
- list_for_each_entry(ch, slim_ch_list, list) {
|
|
|
- cfg->ch_count++;
|
|
|
- payload |= 1 << ch->shift;
|
|
|
- cfg->port_mask |= BIT(ch->port);
|
|
|
- }
|
|
|
-
|
|
|
- cfg->chs = kcalloc(cfg->ch_count, sizeof(unsigned int), GFP_KERNEL);
|
|
|
- if (!cfg->chs)
|
|
|
- return -ENOMEM;
|
|
|
-
|
|
|
- i = 0;
|
|
|
- list_for_each_entry(ch, slim_ch_list, list) {
|
|
|
- cfg->chs[i++] = ch->ch_num;
|
|
|
- if (direction == SNDRV_PCM_STREAM_PLAYBACK) {
|
|
|
- /* write to interface device */
|
|
|
- ret = regmap_write(wcd->if_regmap,
|
|
|
- WCD9335_SLIM_PGD_RX_PORT_MULTI_CHNL_0(ch->port),
|
|
|
- payload);
|
|
|
-
|
|
|
- if (ret < 0)
|
|
|
- goto err;
|
|
|
-
|
|
|
- /* configure the slave port for water mark and enable*/
|
|
|
- ret = regmap_write(wcd->if_regmap,
|
|
|
- WCD9335_SLIM_PGD_RX_PORT_CFG(ch->port),
|
|
|
- WCD9335_SLIM_WATER_MARK_VAL);
|
|
|
- if (ret < 0)
|
|
|
- goto err;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- dai_data->sruntime = slim_stream_allocate(wcd->slim, "WCD9335-SLIM");
|
|
|
- slim_stream_prepare(dai_data->sruntime, cfg);
|
|
|
-
|
|
|
- return 0;
|
|
|
-
|
|
|
-err:
|
|
|
- dev_err(wcd->dev, "Error Setting slim hw params\n");
|
|
|
- kfree(cfg->chs);
|
|
|
- cfg->chs = NULL;
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_hw_params(struct snd_pcm_substream *substream,
|
|
|
- struct snd_pcm_hw_params *params,
|
|
|
- struct snd_soc_dai *dai)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd;
|
|
|
- int ret;
|
|
|
-
|
|
|
- wcd = snd_soc_component_get_drvdata(dai->component);
|
|
|
-
|
|
|
- switch (substream->stream) {
|
|
|
- case SNDRV_PCM_STREAM_PLAYBACK:
|
|
|
- ret = wcd9335_set_interpolator_rate(dai, params_rate(params));
|
|
|
- if (ret) {
|
|
|
- dev_err(wcd->dev, "cannot set sample rate: %u\n",
|
|
|
- params_rate(params));
|
|
|
- return ret;
|
|
|
- }
|
|
|
- switch (params_width(params)) {
|
|
|
- case 16 ... 24:
|
|
|
- wcd->dai[dai->id].sconfig.bps = params_width(params);
|
|
|
- break;
|
|
|
- default:
|
|
|
- dev_err(wcd->dev, "%s: Invalid format 0x%x\n",
|
|
|
- __func__, params_width(params));
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
- break;
|
|
|
- default:
|
|
|
- dev_err(wcd->dev, "Invalid stream type %d\n",
|
|
|
- substream->stream);
|
|
|
- return -EINVAL;
|
|
|
- };
|
|
|
-
|
|
|
- wcd->dai[dai->id].sconfig.rate = params_rate(params);
|
|
|
- wcd9335_slim_set_hw_params(wcd, &wcd->dai[dai->id], substream->stream);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_prepare(struct snd_pcm_substream *substream,
|
|
|
- struct snd_soc_dai *dai)
|
|
|
-{
|
|
|
- struct wcd_slim_codec_dai_data *dai_data;
|
|
|
- struct wcd9335_codec *wcd;
|
|
|
-
|
|
|
- wcd = snd_soc_component_get_drvdata(dai->component);
|
|
|
- dai_data = &wcd->dai[dai->id];
|
|
|
- slim_stream_enable(dai_data->sruntime);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_set_channel_map(struct snd_soc_dai *dai,
|
|
|
- unsigned int tx_num, unsigned int *tx_slot,
|
|
|
- unsigned int rx_num, unsigned int *rx_slot)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd;
|
|
|
- int i;
|
|
|
-
|
|
|
- wcd = snd_soc_component_get_drvdata(dai->component);
|
|
|
-
|
|
|
- if (!tx_slot || !rx_slot) {
|
|
|
- dev_err(wcd->dev, "Invalid tx_slot=%p, rx_slot=%p\n",
|
|
|
- tx_slot, rx_slot);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- if (wcd->rx_chs) {
|
|
|
- wcd->num_rx_port = rx_num;
|
|
|
- for (i = 0; i < rx_num; i++) {
|
|
|
- wcd->rx_chs[i].ch_num = rx_slot[i];
|
|
|
- INIT_LIST_HEAD(&wcd->rx_chs[i].list);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_get_channel_map(struct snd_soc_dai *dai,
|
|
|
- unsigned int *tx_num, unsigned int *tx_slot,
|
|
|
- unsigned int *rx_num, unsigned int *rx_slot)
|
|
|
-{
|
|
|
- struct wcd9335_slim_ch *ch;
|
|
|
- struct wcd9335_codec *wcd;
|
|
|
- int i = 0;
|
|
|
-
|
|
|
- wcd = snd_soc_component_get_drvdata(dai->component);
|
|
|
-
|
|
|
- switch (dai->id) {
|
|
|
- case AIF1_PB:
|
|
|
- case AIF2_PB:
|
|
|
- case AIF3_PB:
|
|
|
- case AIF4_PB:
|
|
|
- if (!rx_slot || !rx_num) {
|
|
|
- dev_err(wcd->dev, "Invalid rx_slot %p or rx_num %p\n",
|
|
|
- rx_slot, rx_num);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- list_for_each_entry(ch, &wcd->dai[dai->id].slim_ch_list, list)
|
|
|
- rx_slot[i++] = ch->ch_num;
|
|
|
-
|
|
|
- *rx_num = i;
|
|
|
- break;
|
|
|
- default:
|
|
|
- dev_err(wcd->dev, "Invalid DAI ID %x\n", dai->id);
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static struct snd_soc_dai_ops wcd9335_dai_ops = {
|
|
|
- .hw_params = wcd9335_hw_params,
|
|
|
- .prepare = wcd9335_prepare,
|
|
|
- .set_channel_map = wcd9335_set_channel_map,
|
|
|
- .get_channel_map = wcd9335_get_channel_map,
|
|
|
-};
|
|
|
-
|
|
|
-static struct snd_soc_dai_driver wcd9335_slim_dais[] = {
|
|
|
- [0] = {
|
|
|
- .name = "wcd9335_rx1",
|
|
|
- .id = AIF1_PB,
|
|
|
- .playback = {
|
|
|
- .stream_name = "AIF1 Playback",
|
|
|
- .rates = WCD9335_RATES_MASK | WCD9335_FRAC_RATES_MASK,
|
|
|
- .formats = WCD9335_FORMATS_S16_S24_LE,
|
|
|
- .rate_max = 192000,
|
|
|
- .rate_min = 8000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 2,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
- [1] = {
|
|
|
- .name = "wcd9335_tx1",
|
|
|
- .id = AIF1_CAP,
|
|
|
- .capture = {
|
|
|
- .stream_name = "AIF1 Capture",
|
|
|
- .rates = WCD9335_RATES_MASK,
|
|
|
- .formats = SNDRV_PCM_FMTBIT_S16_LE,
|
|
|
- .rate_min = 8000,
|
|
|
- .rate_max = 192000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 4,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
- [2] = {
|
|
|
- .name = "wcd9335_rx2",
|
|
|
- .id = AIF2_PB,
|
|
|
- .playback = {
|
|
|
- .stream_name = "AIF2 Playback",
|
|
|
- .rates = WCD9335_RATES_MASK | WCD9335_FRAC_RATES_MASK,
|
|
|
- .formats = WCD9335_FORMATS_S16_S24_LE,
|
|
|
- .rate_min = 8000,
|
|
|
- .rate_max = 192000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 2,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
- [3] = {
|
|
|
- .name = "wcd9335_tx2",
|
|
|
- .id = AIF2_CAP,
|
|
|
- .capture = {
|
|
|
- .stream_name = "AIF2 Capture",
|
|
|
- .rates = WCD9335_RATES_MASK,
|
|
|
- .formats = SNDRV_PCM_FMTBIT_S16_LE,
|
|
|
- .rate_min = 8000,
|
|
|
- .rate_max = 192000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 4,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
- [4] = {
|
|
|
- .name = "wcd9335_rx3",
|
|
|
- .id = AIF3_PB,
|
|
|
- .playback = {
|
|
|
- .stream_name = "AIF3 Playback",
|
|
|
- .rates = WCD9335_RATES_MASK | WCD9335_FRAC_RATES_MASK,
|
|
|
- .formats = WCD9335_FORMATS_S16_S24_LE,
|
|
|
- .rate_min = 8000,
|
|
|
- .rate_max = 192000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 2,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
- [5] = {
|
|
|
- .name = "wcd9335_tx3",
|
|
|
- .id = AIF3_CAP,
|
|
|
- .capture = {
|
|
|
- .stream_name = "AIF3 Capture",
|
|
|
- .rates = WCD9335_RATES_MASK,
|
|
|
- .formats = SNDRV_PCM_FMTBIT_S16_LE,
|
|
|
- .rate_min = 8000,
|
|
|
- .rate_max = 192000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 4,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
- [6] = {
|
|
|
- .name = "wcd9335_rx4",
|
|
|
- .id = AIF4_PB,
|
|
|
- .playback = {
|
|
|
- .stream_name = "AIF4 Playback",
|
|
|
- .rates = WCD9335_RATES_MASK | WCD9335_FRAC_RATES_MASK,
|
|
|
- .formats = WCD9335_FORMATS_S16_S24_LE,
|
|
|
- .rate_min = 8000,
|
|
|
- .rate_max = 192000,
|
|
|
- .channels_min = 1,
|
|
|
- .channels_max = 2,
|
|
|
- },
|
|
|
- .ops = &wcd9335_dai_ops,
|
|
|
- },
|
|
|
-};
|
|
|
-
|
|
|
-static irqreturn_t wcd9335_slimbus_irq(int irq, void *data)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = data;
|
|
|
- unsigned long status = 0;
|
|
|
- int i, j, port_id;
|
|
|
- unsigned int val, int_val = 0;
|
|
|
- bool tx;
|
|
|
- unsigned short reg = 0;
|
|
|
-
|
|
|
- for (i = WCD9335_SLIM_PGD_PORT_INT_STATUS_RX_0, j = 0;
|
|
|
- i <= WCD9335_SLIM_PGD_PORT_INT_STATUS_TX_1; i++, j++) {
|
|
|
- regmap_read(wcd->if_regmap, i, &val);
|
|
|
- status |= ((u32)val << (8 * j));
|
|
|
- }
|
|
|
-
|
|
|
- for_each_set_bit(j, &status, 32) {
|
|
|
- tx = (j >= 16 ? true : false);
|
|
|
- port_id = (tx ? j - 16 : j);
|
|
|
- regmap_read(wcd->if_regmap,
|
|
|
- WCD9335_SLIM_PGD_PORT_INT_RX_SOURCE0 + j, &val);
|
|
|
- if (val) {
|
|
|
- if (!tx)
|
|
|
- reg = WCD9335_SLIM_PGD_PORT_INT_EN0 +
|
|
|
- (port_id / 8);
|
|
|
- else
|
|
|
- reg = WCD9335_SLIM_PGD_PORT_INT_TX_EN0 +
|
|
|
- (port_id / 8);
|
|
|
- regmap_read(
|
|
|
- wcd->if_regmap, reg, &int_val);
|
|
|
- /*
|
|
|
- * Ignore interrupts for ports for which the
|
|
|
- * interrupts are not specifically enabled.
|
|
|
- */
|
|
|
- if (!(int_val & (1 << (port_id % 8))))
|
|
|
- continue;
|
|
|
- }
|
|
|
- if (val & WCD9335_SLIM_IRQ_OVERFLOW)
|
|
|
- dev_err_ratelimited(wcd->dev,
|
|
|
- "%s: overflow error on %s port %d, value %x\n",
|
|
|
- __func__, (tx ? "TX" : "RX"), port_id, val);
|
|
|
- if (val & WCD9335_SLIM_IRQ_UNDERFLOW)
|
|
|
- dev_err_ratelimited(wcd->dev,
|
|
|
- "%s: underflow error on %s port %d, value %x\n",
|
|
|
- __func__, (tx ? "TX" : "RX"), port_id, val);
|
|
|
- if ((val & WCD9335_SLIM_IRQ_OVERFLOW) ||
|
|
|
- (val & WCD9335_SLIM_IRQ_UNDERFLOW)) {
|
|
|
- if (!tx)
|
|
|
- reg = WCD9335_SLIM_PGD_PORT_INT_EN0 +
|
|
|
- (port_id / 8);
|
|
|
- else
|
|
|
- reg = WCD9335_SLIM_PGD_PORT_INT_TX_EN0 +
|
|
|
- (port_id / 8);
|
|
|
- regmap_read(
|
|
|
- wcd->if_regmap, reg, &int_val);
|
|
|
- if (int_val & (1 << (port_id % 8))) {
|
|
|
- int_val = int_val ^ (1 << (port_id % 8));
|
|
|
- regmap_write(wcd->if_regmap,
|
|
|
- reg, int_val);
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- regmap_write(wcd->if_regmap,
|
|
|
- WCD9335_SLIM_PGD_PORT_INT_CLR_RX_0 + (j / 8),
|
|
|
- BIT(j % 8));
|
|
|
- }
|
|
|
-
|
|
|
- return IRQ_HANDLED;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_setup_irqs(struct wcd9335_codec *wcd)
|
|
|
-{
|
|
|
- int slim_irq = regmap_irq_get_virq(wcd->irq_data, WCD9335_IRQ_SLIMBUS);
|
|
|
- int i, ret = 0;
|
|
|
-
|
|
|
- ret = request_threaded_irq(slim_irq, NULL, wcd9335_slimbus_irq,
|
|
|
- IRQF_TRIGGER_RISING, "SLIMBus Slave", wcd);
|
|
|
- if (ret) {
|
|
|
- dev_err(wcd->dev, "Failed to request SLIMBUS irq\n");
|
|
|
- return ret;
|
|
|
- }
|
|
|
-
|
|
|
- /* enable interrupts on all slave ports */
|
|
|
- for (i = 0; i < WCD9335_SLIM_NUM_PORT_REG; i++)
|
|
|
- regmap_write(wcd->if_regmap, WCD9335_SLIM_PGD_PORT_INT_EN0 + i,
|
|
|
- 0xFF);
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static void wcd9335_cdc_sido_ccl_enable(struct wcd9335_codec *wcd,
|
|
|
- bool ccl_flag)
|
|
|
-{
|
|
|
- struct snd_soc_component *comp = wcd->component;
|
|
|
-
|
|
|
- if (ccl_flag) {
|
|
|
- if (++wcd->sido_ccl_cnt == 1)
|
|
|
- snd_soc_component_write(comp, WCD9335_SIDO_SIDO_CCL_10,
|
|
|
- WCD9335_SIDO_SIDO_CCL_DEF_VALUE);
|
|
|
- } else {
|
|
|
- if (wcd->sido_ccl_cnt == 0) {
|
|
|
- dev_err(wcd->dev, "sido_ccl already disabled\n");
|
|
|
- return;
|
|
|
- }
|
|
|
- if (--wcd->sido_ccl_cnt == 0)
|
|
|
- snd_soc_component_write(comp, WCD9335_SIDO_SIDO_CCL_10,
|
|
|
- WCD9335_SIDO_SIDO_CCL_10_ICHARG_PWR_SEL_C320FF);
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_enable_master_bias(struct wcd9335_codec *wcd)
|
|
|
-{
|
|
|
- wcd->master_bias_users++;
|
|
|
- if (wcd->master_bias_users == 1) {
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_BIAS,
|
|
|
- WCD9335_ANA_BIAS_EN_MASK,
|
|
|
- WCD9335_ANA_BIAS_ENABLE);
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_BIAS,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_EN_MASK,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_ENABLE);
|
|
|
- /*
|
|
|
- * 1ms delay is required after pre-charge is enabled
|
|
|
- * as per HW requirement
|
|
|
- */
|
|
|
- usleep_range(1000, 1100);
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_BIAS,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_EN_MASK,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_DISABLE);
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_BIAS,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_CTL_MODE,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_CTL_MODE_MANUAL);
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_enable_mclk(struct wcd9335_codec *wcd)
|
|
|
-{
|
|
|
- /* Enable mclk requires master bias to be enabled first */
|
|
|
- if (wcd->master_bias_users <= 0)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- if (((wcd->clk_mclk_users == 0) && (wcd->clk_type == WCD_CLK_MCLK)) ||
|
|
|
- ((wcd->clk_mclk_users > 0) && (wcd->clk_type != WCD_CLK_MCLK))) {
|
|
|
- dev_err(wcd->dev, "Error enabling MCLK, clk_type: %d\n",
|
|
|
- wcd->clk_type);
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
-
|
|
|
- if (++wcd->clk_mclk_users == 1) {
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_CLK_TOP,
|
|
|
- WCD9335_ANA_CLK_EXT_CLKBUF_EN_MASK,
|
|
|
- WCD9335_ANA_CLK_EXT_CLKBUF_ENABLE);
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_CLK_TOP,
|
|
|
- WCD9335_ANA_CLK_MCLK_SRC_MASK,
|
|
|
- WCD9335_ANA_CLK_MCLK_SRC_EXTERNAL);
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_CLK_TOP,
|
|
|
- WCD9335_ANA_CLK_MCLK_EN_MASK,
|
|
|
- WCD9335_ANA_CLK_MCLK_ENABLE);
|
|
|
- regmap_update_bits(wcd->regmap,
|
|
|
- WCD9335_CDC_CLK_RST_CTRL_FS_CNT_CONTROL,
|
|
|
- WCD9335_CDC_CLK_RST_CTRL_FS_CNT_EN_MASK,
|
|
|
- WCD9335_CDC_CLK_RST_CTRL_FS_CNT_ENABLE);
|
|
|
- regmap_update_bits(wcd->regmap,
|
|
|
- WCD9335_CDC_CLK_RST_CTRL_MCLK_CONTROL,
|
|
|
- WCD9335_CDC_CLK_RST_CTRL_MCLK_EN_MASK,
|
|
|
- WCD9335_CDC_CLK_RST_CTRL_MCLK_ENABLE);
|
|
|
- /*
|
|
|
- * 10us sleep is required after clock is enabled
|
|
|
- * as per HW requirement
|
|
|
- */
|
|
|
- usleep_range(10, 15);
|
|
|
- }
|
|
|
-
|
|
|
- wcd->clk_type = WCD_CLK_MCLK;
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_disable_mclk(struct wcd9335_codec *wcd)
|
|
|
-{
|
|
|
- if (wcd->clk_mclk_users <= 0)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- if (--wcd->clk_mclk_users == 0) {
|
|
|
- if (wcd->clk_rco_users > 0) {
|
|
|
- /* MCLK to RCO switch */
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_CLK_TOP,
|
|
|
- WCD9335_ANA_CLK_MCLK_SRC_MASK,
|
|
|
- WCD9335_ANA_CLK_MCLK_SRC_RCO);
|
|
|
- wcd->clk_type = WCD_CLK_RCO;
|
|
|
- } else {
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_CLK_TOP,
|
|
|
- WCD9335_ANA_CLK_MCLK_EN_MASK,
|
|
|
- WCD9335_ANA_CLK_MCLK_DISABLE);
|
|
|
- wcd->clk_type = WCD_CLK_OFF;
|
|
|
- }
|
|
|
-
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_CLK_TOP,
|
|
|
- WCD9335_ANA_CLK_EXT_CLKBUF_EN_MASK,
|
|
|
- WCD9335_ANA_CLK_EXT_CLKBUF_DISABLE);
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_disable_master_bias(struct wcd9335_codec *wcd)
|
|
|
-{
|
|
|
- if (wcd->master_bias_users <= 0)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- wcd->master_bias_users--;
|
|
|
- if (wcd->master_bias_users == 0) {
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_BIAS,
|
|
|
- WCD9335_ANA_BIAS_EN_MASK,
|
|
|
- WCD9335_ANA_BIAS_DISABLE);
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_ANA_BIAS,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_CTL_MODE,
|
|
|
- WCD9335_ANA_BIAS_PRECHRG_CTL_MODE_MANUAL);
|
|
|
- }
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_cdc_req_mclk_enable(struct wcd9335_codec *wcd,
|
|
|
- bool enable)
|
|
|
-{
|
|
|
- int ret = 0;
|
|
|
-
|
|
|
- if (enable) {
|
|
|
- wcd9335_cdc_sido_ccl_enable(wcd, true);
|
|
|
- ret = clk_prepare_enable(wcd->mclk);
|
|
|
- if (ret) {
|
|
|
- dev_err(wcd->dev, "%s: ext clk enable failed\n",
|
|
|
- __func__);
|
|
|
- goto err;
|
|
|
- }
|
|
|
- /* get BG */
|
|
|
- wcd9335_enable_master_bias(wcd);
|
|
|
- /* get MCLK */
|
|
|
- wcd9335_enable_mclk(wcd);
|
|
|
-
|
|
|
- } else {
|
|
|
- /* put MCLK */
|
|
|
- wcd9335_disable_mclk(wcd);
|
|
|
- /* put BG */
|
|
|
- wcd9335_disable_master_bias(wcd);
|
|
|
- clk_disable_unprepare(wcd->mclk);
|
|
|
- wcd9335_cdc_sido_ccl_enable(wcd, false);
|
|
|
- }
|
|
|
-err:
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static void wcd9335_codec_apply_sido_voltage(struct wcd9335_codec *wcd,
|
|
|
- enum wcd9335_sido_voltage req_mv)
|
|
|
-{
|
|
|
- struct snd_soc_component *comp = wcd->component;
|
|
|
- int vout_d_val;
|
|
|
-
|
|
|
- if (req_mv == wcd->sido_voltage)
|
|
|
- return;
|
|
|
-
|
|
|
- /* compute the vout_d step value */
|
|
|
- vout_d_val = WCD9335_CALCULATE_VOUT_D(req_mv) &
|
|
|
- WCD9335_ANA_BUCK_VOUT_MASK;
|
|
|
- snd_soc_component_write(comp, WCD9335_ANA_BUCK_VOUT_D, vout_d_val);
|
|
|
- snd_soc_component_update_bits(comp, WCD9335_ANA_BUCK_CTL,
|
|
|
- WCD9335_ANA_BUCK_CTL_RAMP_START_MASK,
|
|
|
- WCD9335_ANA_BUCK_CTL_RAMP_START_ENABLE);
|
|
|
-
|
|
|
- /* 1 msec sleep required after SIDO Vout_D voltage change */
|
|
|
- usleep_range(1000, 1100);
|
|
|
- wcd->sido_voltage = req_mv;
|
|
|
- snd_soc_component_update_bits(comp, WCD9335_ANA_BUCK_CTL,
|
|
|
- WCD9335_ANA_BUCK_CTL_RAMP_START_MASK,
|
|
|
- WCD9335_ANA_BUCK_CTL_RAMP_START_DISABLE);
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_codec_update_sido_voltage(struct wcd9335_codec *wcd,
|
|
|
- enum wcd9335_sido_voltage req_mv)
|
|
|
-{
|
|
|
- int ret = 0;
|
|
|
-
|
|
|
- /* enable mclk before setting SIDO voltage */
|
|
|
- ret = wcd9335_cdc_req_mclk_enable(wcd, true);
|
|
|
- if (ret) {
|
|
|
- dev_err(wcd->dev, "Ext clk enable failed\n");
|
|
|
- goto err;
|
|
|
- }
|
|
|
-
|
|
|
- wcd9335_codec_apply_sido_voltage(wcd, req_mv);
|
|
|
- wcd9335_cdc_req_mclk_enable(wcd, false);
|
|
|
-
|
|
|
-err:
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static int _wcd9335_codec_enable_mclk(struct snd_soc_component *component,
|
|
|
- int enable)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(component->dev);
|
|
|
- int ret;
|
|
|
-
|
|
|
- if (enable) {
|
|
|
- ret = wcd9335_cdc_req_mclk_enable(wcd, true);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
-
|
|
|
- wcd9335_codec_apply_sido_voltage(wcd,
|
|
|
- SIDO_VOLTAGE_NOMINAL_MV);
|
|
|
- } else {
|
|
|
- wcd9335_codec_update_sido_voltage(wcd,
|
|
|
- wcd->sido_voltage);
|
|
|
- wcd9335_cdc_req_mclk_enable(wcd, false);
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static void wcd9335_enable_sido_buck(struct snd_soc_component *component)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(component->dev);
|
|
|
-
|
|
|
- snd_soc_component_update_bits(component, WCD9335_ANA_RCO,
|
|
|
- WCD9335_ANA_RCO_BG_EN_MASK,
|
|
|
- WCD9335_ANA_RCO_BG_ENABLE);
|
|
|
- snd_soc_component_update_bits(component, WCD9335_ANA_BUCK_CTL,
|
|
|
- WCD9335_ANA_BUCK_CTL_VOUT_D_IREF_MASK,
|
|
|
- WCD9335_ANA_BUCK_CTL_VOUT_D_IREF_EXT);
|
|
|
- /* 100us sleep needed after IREF settings */
|
|
|
- usleep_range(100, 110);
|
|
|
- snd_soc_component_update_bits(component, WCD9335_ANA_BUCK_CTL,
|
|
|
- WCD9335_ANA_BUCK_CTL_VOUT_D_VREF_MASK,
|
|
|
- WCD9335_ANA_BUCK_CTL_VOUT_D_VREF_EXT);
|
|
|
- /* 100us sleep needed after VREF settings */
|
|
|
- usleep_range(100, 110);
|
|
|
- wcd->sido_input_src = SIDO_SOURCE_RCO_BG;
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_enable_efuse_sensing(struct snd_soc_component *comp)
|
|
|
-{
|
|
|
- _wcd9335_codec_enable_mclk(comp, true);
|
|
|
- snd_soc_component_update_bits(comp,
|
|
|
- WCD9335_CHIP_TIER_CTRL_EFUSE_CTL,
|
|
|
- WCD9335_CHIP_TIER_CTRL_EFUSE_EN_MASK,
|
|
|
- WCD9335_CHIP_TIER_CTRL_EFUSE_ENABLE);
|
|
|
- /*
|
|
|
- * 5ms sleep required after enabling efuse control
|
|
|
- * before checking the status.
|
|
|
- */
|
|
|
- usleep_range(5000, 5500);
|
|
|
-
|
|
|
- if (!(snd_soc_component_read32(comp,
|
|
|
- WCD9335_CHIP_TIER_CTRL_EFUSE_STATUS) &
|
|
|
- WCD9335_CHIP_TIER_CTRL_EFUSE_EN_MASK))
|
|
|
- WARN(1, "%s: Efuse sense is not complete\n", __func__);
|
|
|
-
|
|
|
- wcd9335_enable_sido_buck(comp);
|
|
|
- _wcd9335_codec_enable_mclk(comp, false);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static void wcd9335_codec_init(struct snd_soc_component *component)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(component->dev);
|
|
|
- int i;
|
|
|
-
|
|
|
- /* ungate MCLK and set clk rate */
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_CODEC_RPM_CLK_GATE,
|
|
|
- WCD9335_CODEC_RPM_CLK_GATE_MCLK_GATE_MASK, 0);
|
|
|
-
|
|
|
- regmap_update_bits(wcd->regmap, WCD9335_CODEC_RPM_CLK_MCLK_CFG,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG_MCLK_MASK,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG_9P6MHZ);
|
|
|
-
|
|
|
- for (i = 0; i < ARRAY_SIZE(wcd9335_codec_reg_init_common_val); i++)
|
|
|
- snd_soc_component_update_bits(component,
|
|
|
- wcd9335_codec_reg_init_common_val[i].reg,
|
|
|
- wcd9335_codec_reg_init_common_val[i].mask,
|
|
|
- wcd9335_codec_reg_init_common_val[i].val);
|
|
|
-
|
|
|
- if (WCD9335_IS_2_0(wcd->version)) {
|
|
|
- for (i = 0; i < ARRAY_SIZE(wcd9335_codec_reg_init_val_2_0); i++)
|
|
|
- snd_soc_component_update_bits(component,
|
|
|
- wcd9335_codec_reg_init_val_2_0[i].reg,
|
|
|
- wcd9335_codec_reg_init_val_2_0[i].mask,
|
|
|
- wcd9335_codec_reg_init_val_2_0[i].val);
|
|
|
- }
|
|
|
-
|
|
|
- wcd9335_enable_efuse_sensing(component);
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_codec_probe(struct snd_soc_component *component)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(component->dev);
|
|
|
- int i;
|
|
|
-
|
|
|
- snd_soc_component_init_regmap(component, wcd->regmap);
|
|
|
- wcd->component = component;
|
|
|
-
|
|
|
- wcd9335_codec_init(component);
|
|
|
-
|
|
|
- for (i = 0; i < NUM_CODEC_DAIS; i++)
|
|
|
- INIT_LIST_HEAD(&wcd->dai[i].slim_ch_list);
|
|
|
-
|
|
|
- return wcd9335_setup_irqs(wcd);
|
|
|
-}
|
|
|
-
|
|
|
-static void wcd9335_codec_remove(struct snd_soc_component *comp)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(comp->dev);
|
|
|
-
|
|
|
- free_irq(regmap_irq_get_virq(wcd->irq_data, WCD9335_IRQ_SLIMBUS), wcd);
|
|
|
-}
|
|
|
-
|
|
|
-static int wcd9335_codec_set_sysclk(struct snd_soc_component *comp,
|
|
|
- int clk_id, int source,
|
|
|
- unsigned int freq, int dir)
|
|
|
-{
|
|
|
- struct wcd9335_codec *wcd = dev_get_drvdata(comp->dev);
|
|
|
-
|
|
|
- wcd->mclk_rate = freq;
|
|
|
-
|
|
|
- if (wcd->mclk_rate == WCD9335_MCLK_CLK_12P288MHZ)
|
|
|
- snd_soc_component_update_bits(comp,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG_MCLK_MASK,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG_12P288MHZ);
|
|
|
- else if (wcd->mclk_rate == WCD9335_MCLK_CLK_9P6MHZ)
|
|
|
- snd_soc_component_update_bits(comp,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG_MCLK_MASK,
|
|
|
- WCD9335_CODEC_RPM_CLK_MCLK_CFG_9P6MHZ);
|
|
|
-
|
|
|
- return clk_set_rate(wcd->mclk, freq);
|
|
|
-}
|
|
|
-
|
|
|
-static const struct snd_soc_component_driver wcd9335_component_drv = {
|
|
|
- .probe = wcd9335_codec_probe,
|
|
|
- .remove = wcd9335_codec_remove,
|
|
|
- .set_sysclk = wcd9335_codec_set_sysclk,
|
|
|
-};
|
|
|
-
|
|
|
-static int wcd9335_probe(struct platform_device *pdev)
|
|
|
-{
|
|
|
- struct wcd9335 *pdata = dev_get_drvdata(pdev->dev.parent);
|
|
|
- struct device *dev = &pdev->dev;
|
|
|
- struct wcd9335_codec *wcd;
|
|
|
-
|
|
|
- wcd = devm_kzalloc(dev, sizeof(*wcd), GFP_KERNEL);
|
|
|
- if (!wcd)
|
|
|
- return -ENOMEM;
|
|
|
-
|
|
|
- dev_set_drvdata(dev, wcd);
|
|
|
-
|
|
|
- memcpy(wcd->rx_chs, wcd9335_rx_chs, sizeof(wcd9335_rx_chs));
|
|
|
-
|
|
|
- wcd->regmap = pdata->regmap;
|
|
|
- wcd->if_regmap = pdata->ifd_regmap;
|
|
|
- wcd->slim = pdata->slim;
|
|
|
- wcd->slim_ifd = pdata->slim_ifd;
|
|
|
- wcd->irq_data = pdata->irq_data;
|
|
|
- wcd->version = pdata->version;
|
|
|
- wcd->intf_type = pdata->intf_type;
|
|
|
- wcd->dev = dev;
|
|
|
- wcd->mclk = pdata->mclk;
|
|
|
- wcd->native_clk = pdata->native_clk;
|
|
|
- wcd->sido_input_src = SIDO_SOURCE_INTERNAL;
|
|
|
- wcd->sido_voltage = SIDO_VOLTAGE_NOMINAL_MV;
|
|
|
-
|
|
|
- return devm_snd_soc_register_component(dev, &wcd9335_component_drv,
|
|
|
- wcd9335_slim_dais,
|
|
|
- ARRAY_SIZE(wcd9335_slim_dais));
|
|
|
-}
|
|
|
-
|
|
|
-static struct platform_driver wcd9335_codec_driver = {
|
|
|
- .probe = wcd9335_probe,
|
|
|
- .driver = {
|
|
|
- .name = "wcd9335-codec",
|
|
|
- },
|
|
|
-};
|
|
|
-module_platform_driver(wcd9335_codec_driver);
|
|
|
-MODULE_DESCRIPTION("WCD9335 Codec driver");
|
|
|
-MODULE_LICENSE("GPL v2");
|