| /* Copyright (c) 2012-2017, The Linux Foundation. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 and |
| * only version 2 as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| #include <linux/module.h> |
| #include <linux/init.h> |
| #include <linux/firmware.h> |
| #include <linux/slab.h> |
| #include <linux/platform_device.h> |
| #include <linux/device.h> |
| #include <linux/printk.h> |
| #include <linux/ratelimit.h> |
| #include <linux/debugfs.h> |
| #include <linux/wait.h> |
| #include <linux/bitops.h> |
| #include <linux/regmap.h> |
| #include <linux/mfd/wcd9xxx/core.h> |
| #include <linux/mfd/wcd9xxx/wcd9xxx-irq.h> |
| #include <linux/mfd/wcd9xxx/wcd9xxx_registers.h> |
| #include <linux/mfd/wcd9xxx/wcd9330_registers.h> |
| #include <linux/mfd/wcd9xxx/pdata.h> |
| #include <linux/regulator/consumer.h> |
| #include <sound/pcm.h> |
| #include <sound/pcm_params.h> |
| #include <sound/soc.h> |
| #include <sound/soc-dapm.h> |
| #include <sound/tlv.h> |
| #include <linux/delay.h> |
| #include <linux/pm_runtime.h> |
| #include <linux/kernel.h> |
| #include <linux/gpio.h> |
| #include <linux/clk.h> |
| #include "wcd9330.h" |
| #include "wcd9xxx-resmgr.h" |
| #include "wcd9xxx-common.h" |
| #include "wcdcal-hwdep.h" |
| #include "wcd_cpe_core.h" |
| |
| enum { |
| BUS_DOWN, |
| ADC1_TXFE, |
| ADC2_TXFE, |
| ADC3_TXFE, |
| ADC4_TXFE, |
| ADC5_TXFE, |
| ADC6_TXFE, |
| HPH_DELAY, |
| }; |
| |
| #define TOMTOM_MAD_SLIMBUS_TX_PORT 12 |
| #define TOMTOM_MAD_AUDIO_FIRMWARE_PATH "wcd9320/wcd9320_mad_audio.bin" |
| #define TOMTOM_VALIDATE_RX_SBPORT_RANGE(port) ((port >= 16) && (port <= 23)) |
| #define TOMTOM_VALIDATE_TX_SBPORT_RANGE(port) ((port >= 0) && (port <= 15)) |
| #define TOMTOM_CONVERT_RX_SBPORT_ID(port) (port - 16) /* RX1 port ID = 0 */ |
| #define TOMTOM_BIT_ADJ_SHIFT_PORT1_6 4 |
| #define TOMTOM_BIT_ADJ_SHIFT_PORT7_10 5 |
| |
| #define TOMTOM_HPH_PA_SETTLE_COMP_ON 10000 |
| #define TOMTOM_HPH_PA_SETTLE_COMP_OFF 13000 |
| #define TOMTOM_HPH_PA_RAMP_DELAY 30000 |
| |
| #define TOMTOM_SVASS_INT_STATUS_RCO_WDOG 0x20 |
| #define TOMTOM_SVASS_INT_STATUS_WDOG_BITE 0x02 |
| |
| /* Add any SVA IRQs that are to be treated as FATAL */ |
| #define TOMTOM_CPE_FATAL_IRQS \ |
| (TOMTOM_SVASS_INT_STATUS_RCO_WDOG | \ |
| TOMTOM_SVASS_INT_STATUS_WDOG_BITE) |
| |
| #define DAPM_MICBIAS2_EXTERNAL_STANDALONE "MIC BIAS2 External Standalone" |
| |
| /* RX_HPH_CNP_WG_TIME increases by 0.24ms */ |
| #define TOMTOM_WG_TIME_FACTOR_US 240 |
| |
| #define RX8_PATH 8 |
| #define HPH_PA_ENABLE true |
| #define HPH_PA_DISABLE false |
| |
| #define SLIM_BW_CLK_GEAR_9 6200000 |
| #define SLIM_BW_UNVOTE 0 |
| |
| static int cpe_debug_mode; |
| module_param(cpe_debug_mode, int, 0664); |
| MODULE_PARM_DESC(cpe_debug_mode, "boot cpe in debug mode"); |
| |
| static atomic_t kp_tomtom_priv; |
| |
| static int high_perf_mode; |
| module_param(high_perf_mode, int, 0664); |
| MODULE_PARM_DESC(high_perf_mode, "enable/disable class AB config for hph"); |
| |
| static struct afe_param_slimbus_slave_port_cfg tomtom_slimbus_slave_port_cfg = { |
| .minor_version = 1, |
| .slimbus_dev_id = AFE_SLIMBUS_DEVICE_1, |
| .slave_dev_pgd_la = 0, |
| .slave_dev_intfdev_la = 0, |
| .bit_width = 16, |
| .data_format = 0, |
| .num_channels = 1 |
| }; |
| |
| static struct afe_param_cdc_reg_cfg audio_reg_cfg[] = { |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_CDC_MAD_MAIN_CTL_1), |
| HW_MAD_AUDIO_ENABLE, 0x1, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_CDC_MAD_AUDIO_CTL_3), |
| HW_MAD_AUDIO_SLEEP_TIME, 0xF, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_CDC_MAD_AUDIO_CTL_4), |
| HW_MAD_TX_AUDIO_SWITCH_OFF, 0x1, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR_MODE), |
| MAD_AUDIO_INT_DEST_SELECT_REG, 0x4, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_MASK0), |
| MAD_AUDIO_INT_MASK_REG, 0x2, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_STATUS0), |
| MAD_AUDIO_INT_STATUS_REG, 0x2, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_CLEAR0), |
| MAD_AUDIO_INT_CLEAR_REG, 0x2, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_SB_PGD_PORT_TX_BASE), |
| SB_PGD_PORT_TX_WATERMARK_N, 0x1E, 8, 0x1 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_SB_PGD_PORT_TX_BASE), |
| SB_PGD_PORT_TX_ENABLE_N, 0x1, 8, 0x1 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_SB_PGD_PORT_RX_BASE), |
| SB_PGD_PORT_RX_WATERMARK_N, 0x1E, 8, 0x1 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_SB_PGD_PORT_RX_BASE), |
| SB_PGD_PORT_RX_ENABLE_N, 0x1, 8, 0x1 |
| }, |
| { 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_CDC_ANC1_IIR_B1_CTL), |
| AANC_FF_GAIN_ADAPTIVE, 0x4, 8, 0 |
| }, |
| { 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_CDC_ANC1_IIR_B1_CTL), |
| AANC_FFGAIN_ADAPTIVE_EN, 0x8, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_CDC_ANC1_GAIN_CTL), |
| AANC_GAIN_CONTROL, 0xFF, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_MASK0), |
| MAD_CLIP_INT_MASK_REG, 0x10, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_MASK0), |
| MAD2_CLIP_INT_MASK_REG, 0x20, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_STATUS0), |
| MAD_CLIP_INT_STATUS_REG, 0x10, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_STATUS0), |
| MAD2_CLIP_INT_STATUS_REG, 0x20, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_CLEAR0), |
| MAD_CLIP_INT_CLEAR_REG, 0x10, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + TOMTOM_A_INTR2_CLEAR0), |
| MAD2_CLIP_INT_CLEAR_REG, 0x20, 8, 0 |
| }, |
| }; |
| |
| static struct afe_param_cdc_reg_cfg clip_reg_cfg[] = { |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_B1_CTL), |
| SPKR_CLIP_PIPE_BANK_SEL, 0x3, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL0), |
| SPKR_CLIPDET_VAL0, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL1), |
| SPKR_CLIPDET_VAL1, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL2), |
| SPKR_CLIPDET_VAL2, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL3), |
| SPKR_CLIPDET_VAL3, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL4), |
| SPKR_CLIPDET_VAL4, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL5), |
| SPKR_CLIPDET_VAL5, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL6), |
| SPKR_CLIPDET_VAL6, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR_CLIPDET_VAL7), |
| SPKR_CLIPDET_VAL7, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_B1_CTL), |
| SPKR2_CLIP_PIPE_BANK_SEL, 0x3, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL0), |
| SPKR2_CLIPDET_VAL0, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL1), |
| SPKR2_CLIPDET_VAL1, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL2), |
| SPKR2_CLIPDET_VAL2, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL3), |
| SPKR2_CLIPDET_VAL3, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL4), |
| SPKR2_CLIPDET_VAL4, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL5), |
| SPKR2_CLIPDET_VAL5, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL6), |
| SPKR2_CLIPDET_VAL6, 0xff, 8, 0 |
| }, |
| { |
| 1, |
| (TOMTOM_REGISTER_START_OFFSET + |
| TOMTOM_A_CDC_SPKR2_CLIPDET_VAL7), |
| SPKR2_CLIPDET_VAL7, 0xff, 8, 0 |
| }, |
| }; |
| |
| static struct afe_param_cdc_reg_cfg_data tomtom_audio_reg_cfg = { |
| .num_registers = ARRAY_SIZE(audio_reg_cfg), |
| .reg_data = audio_reg_cfg, |
| }; |
| |
| static struct afe_param_cdc_reg_cfg_data tomtom_clip_reg_cfg = { |
| .num_registers = ARRAY_SIZE(clip_reg_cfg), |
| .reg_data = clip_reg_cfg, |
| }; |
| |
| static struct afe_param_id_cdc_aanc_version tomtom_cdc_aanc_version = { |
| .cdc_aanc_minor_version = AFE_API_VERSION_CDC_AANC_VERSION, |
| .aanc_hw_version = AANC_HW_BLOCK_VERSION_2, |
| }; |
| |
| static struct afe_param_id_clip_bank_sel clip_bank_sel = { |
| .minor_version = AFE_API_VERSION_CLIP_BANK_SEL_CFG, |
| .num_banks = AFE_CLIP_MAX_BANKS, |
| .bank_map = {0, 1, 2, 3}, |
| }; |
| |
| #define WCD9330_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\ |
| SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\ |
| SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000) |
| |
| #define NUM_DECIMATORS 10 |
| #define NUM_INTERPOLATORS 8 |
| #define BITS_PER_REG 8 |
| #define TOMTOM_TX_PORT_NUMBER 16 |
| #define TOMTOM_RX_PORT_START_NUMBER 16 |
| |
| #define TOMTOM_I2S_MASTER_MODE_MASK 0x08 |
| |
| #define TOMTOM_SLIM_CLOSE_TIMEOUT 1000 |
| #define TOMTOM_SLIM_IRQ_OVERFLOW (1 << 0) |
| #define TOMTOM_SLIM_IRQ_UNDERFLOW (1 << 1) |
| #define TOMTOM_SLIM_IRQ_PORT_CLOSED (1 << 2) |
| #define TOMTOM_MCLK_CLK_12P288MHZ 12288000 |
| #define TOMTOM_MCLK_CLK_9P6MHZ 9600000 |
| |
| #define TOMTOM_FORMATS_S16_S24_LE (SNDRV_PCM_FMTBIT_S16_LE | \ |
| SNDRV_PCM_FORMAT_S24_LE) |
| |
| #define TOMTOM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE) |
| |
| #define TOMTOM_SLIM_PGD_PORT_INT_TX_EN0 (TOMTOM_SLIM_PGD_PORT_INT_EN0 + 2) |
| #define TOMTOM_ZDET_BOX_CAR_AVG_LOOP_COUNT 1 |
| #define TOMTOM_ZDET_MUL_FACTOR_1X 7218 |
| #define TOMTOM_ZDET_MUL_FACTOR_10X (TOMTOM_ZDET_MUL_FACTOR_1X * 10) |
| #define TOMTOM_ZDET_MUL_FACTOR_100X (TOMTOM_ZDET_MUL_FACTOR_1X * 100) |
| #define TOMTOM_ZDET_ERROR_APPROX_MUL_FACTOR 655 |
| #define TOMTOM_ZDET_ERROR_APPROX_SHIFT 16 |
| #define TOMTOM_ZDET_ZONE_3_DEFAULT_VAL 1000000 |
| |
| enum { |
| AIF1_PB = 0, |
| AIF1_CAP, |
| AIF2_PB, |
| AIF2_CAP, |
| AIF3_PB, |
| AIF3_CAP, |
| AIF4_VIFEED, |
| AIF4_MAD_TX, |
| NUM_CODEC_DAIS, |
| }; |
| |
| enum { |
| RX_MIX1_INP_SEL_ZERO = 0, |
| RX_MIX1_INP_SEL_SRC1, |
| RX_MIX1_INP_SEL_SRC2, |
| RX_MIX1_INP_SEL_IIR1, |
| RX_MIX1_INP_SEL_IIR2, |
| RX_MIX1_INP_SEL_RX1, |
| RX_MIX1_INP_SEL_RX2, |
| RX_MIX1_INP_SEL_RX3, |
| RX_MIX1_INP_SEL_RX4, |
| RX_MIX1_INP_SEL_RX5, |
| RX_MIX1_INP_SEL_RX6, |
| RX_MIX1_INP_SEL_RX7, |
| RX_MIX1_INP_SEL_AUXRX, |
| }; |
| enum { |
| RX8_MIX1_INP_SEL_ZERO = 0, |
| RX8_MIX1_INP_SEL_IIR1, |
| RX8_MIX1_INP_SEL_IIR2, |
| RX8_MIX1_INP_SEL_RX1, |
| RX8_MIX1_INP_SEL_RX2, |
| RX8_MIX1_INP_SEL_RX3, |
| RX8_MIX1_INP_SEL_RX4, |
| RX8_MIX1_INP_SEL_RX5, |
| RX8_MIX1_INP_SEL_RX6, |
| RX8_MIX1_INP_SEL_RX7, |
| RX8_MIX1_INP_SEL_RX8, |
| }; |
| |
| #define TOMTOM_COMP_DIGITAL_GAIN_OFFSET 3 |
| |
| static const DECLARE_TLV_DB_SCALE(digital_gain, 0, 1, 0); |
| static const DECLARE_TLV_DB_SCALE(line_gain, 0, 7, 1); |
| static const DECLARE_TLV_DB_SCALE(analog_gain, 0, 25, 1); |
| static struct snd_soc_dai_driver tomtom_dai[]; |
| static const DECLARE_TLV_DB_SCALE(aux_pga_gain, 0, 2, 0); |
| |
| /* Codec supports 2 IIR filters */ |
| enum { |
| IIR1 = 0, |
| IIR2, |
| IIR_MAX, |
| }; |
| /* Codec supports 5 bands */ |
| enum { |
| BAND1 = 0, |
| BAND2, |
| BAND3, |
| BAND4, |
| BAND5, |
| BAND_MAX, |
| }; |
| |
| enum { |
| COMPANDER_0, |
| COMPANDER_1, |
| COMPANDER_2, |
| COMPANDER_MAX, |
| }; |
| |
| enum { |
| COMPANDER_FS_8KHZ = 0, |
| COMPANDER_FS_16KHZ, |
| COMPANDER_FS_32KHZ, |
| COMPANDER_FS_48KHZ, |
| COMPANDER_FS_96KHZ, |
| COMPANDER_FS_192KHZ, |
| COMPANDER_FS_MAX, |
| }; |
| |
| struct comp_sample_dependent_params { |
| u32 peak_det_timeout; |
| u32 rms_meter_div_fact; |
| u32 rms_meter_resamp_fact; |
| }; |
| |
| struct hpf_work { |
| struct tomtom_priv *tomtom; |
| u32 decimator; |
| u8 tx_hpf_cut_of_freq; |
| bool tx_hpf_bypass; |
| struct delayed_work dwork; |
| }; |
| |
| static struct hpf_work tx_hpf_work[NUM_DECIMATORS]; |
| |
| static const struct wcd9xxx_ch tomtom_rx_chs[TOMTOM_RX_MAX] = { |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER, 0), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 1, 1), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 2, 2), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 3, 3), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 4, 4), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 5, 5), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 6, 6), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 7, 7), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 8, 8), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 9, 9), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 10, 10), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 11, 11), |
| WCD9XXX_CH(TOMTOM_RX_PORT_START_NUMBER + 12, 12), |
| }; |
| |
| static const struct wcd9xxx_ch tomtom_tx_chs[TOMTOM_TX_MAX] = { |
| WCD9XXX_CH(0, 0), |
| WCD9XXX_CH(1, 1), |
| WCD9XXX_CH(2, 2), |
| WCD9XXX_CH(3, 3), |
| WCD9XXX_CH(4, 4), |
| WCD9XXX_CH(5, 5), |
| WCD9XXX_CH(6, 6), |
| WCD9XXX_CH(7, 7), |
| WCD9XXX_CH(8, 8), |
| WCD9XXX_CH(9, 9), |
| WCD9XXX_CH(10, 10), |
| WCD9XXX_CH(11, 11), |
| WCD9XXX_CH(12, 12), |
| WCD9XXX_CH(13, 13), |
| WCD9XXX_CH(14, 14), |
| WCD9XXX_CH(15, 15), |
| }; |
| |
| static const u32 vport_check_table[NUM_CODEC_DAIS] = { |
| 0, /* AIF1_PB */ |
| (1 << AIF2_CAP) | (1 << AIF3_CAP), /* AIF1_CAP */ |
| 0, /* AIF2_PB */ |
| (1 << AIF1_CAP) | (1 << AIF3_CAP), /* AIF2_CAP */ |
| 0, /* AIF3_PB */ |
| (1 << AIF1_CAP) | (1 << AIF2_CAP), /* AIF3_CAP */ |
| }; |
| |
| static const u32 vport_i2s_check_table[NUM_CODEC_DAIS] = { |
| 0, /* AIF1_PB */ |
| 0, /* AIF1_CAP */ |
| 0, /* AIF2_PB */ |
| 0, /* AIF2_CAP */ |
| }; |
| |
| /* |
| * Interrupt table for v3 corresponds to newer version |
| * codecs (wcd9330) |
| */ |
| static const struct intr_data wcd9330_intr_tbl[] = { |
| {WCD9XXX_IRQ_SLIMBUS, false}, |
| {WCD9XXX_IRQ_MBHC_INSERTION, true}, |
| {WCD9XXX_IRQ_MBHC_POTENTIAL, true}, |
| {WCD9XXX_IRQ_MBHC_RELEASE, true}, |
| {WCD9XXX_IRQ_MBHC_PRESS, true}, |
| {WCD9XXX_IRQ_MBHC_SHORT_TERM, true}, |
| {WCD9XXX_IRQ_MBHC_REMOVAL, true}, |
| {WCD9330_IRQ_MBHC_JACK_SWITCH, true}, |
| {WCD9XXX_IRQ_BG_PRECHARGE, false}, |
| {WCD9XXX_IRQ_PA1_STARTUP, false}, |
| {WCD9XXX_IRQ_PA2_STARTUP, false}, |
| {WCD9XXX_IRQ_PA3_STARTUP, false}, |
| {WCD9XXX_IRQ_PA4_STARTUP, false}, |
| {WCD9XXX_IRQ_PA5_STARTUP, false}, |
| {WCD9XXX_IRQ_MICBIAS1_PRECHARGE, false}, |
| {WCD9XXX_IRQ_MICBIAS2_PRECHARGE, false}, |
| {WCD9XXX_IRQ_MICBIAS3_PRECHARGE, false}, |
| {WCD9XXX_IRQ_HPH_PA_OCPL_FAULT, false}, |
| {WCD9XXX_IRQ_HPH_PA_OCPR_FAULT, false}, |
| {WCD9XXX_IRQ_EAR_PA_OCPL_FAULT, false}, |
| {WCD9XXX_IRQ_HPH_L_PA_STARTUP, false}, |
| {WCD9XXX_IRQ_HPH_R_PA_STARTUP, false}, |
| {WCD9320_IRQ_EAR_PA_STARTUP, false}, |
| {WCD9330_IRQ_SVASS_ERR_EXCEPTION, false}, |
| {WCD9330_IRQ_SVASS_ENGINE, true}, |
| {WCD9330_IRQ_MAD_AUDIO, false}, |
| {WCD9330_IRQ_MAD_BEACON, false}, |
| {WCD9330_IRQ_MAD_ULTRASOUND, false}, |
| {WCD9330_IRQ_SPEAKER1_CLIPPING, false}, |
| {WCD9330_IRQ_SPEAKER2_CLIPPING, false}, |
| {WCD9330_IRQ_VBAT_MONITOR_ATTACK, false}, |
| {WCD9330_IRQ_VBAT_MONITOR_RELEASE, false}, |
| }; |
| |
| struct tomtom_priv { |
| struct snd_soc_codec *codec; |
| u32 adc_count; |
| u32 rx_bias_count; |
| s32 dmic_1_2_clk_cnt; |
| s32 dmic_3_4_clk_cnt; |
| s32 dmic_5_6_clk_cnt; |
| s32 ldo_h_users; |
| s32 micb_2_users; |
| |
| u32 anc_slot; |
| bool anc_func; |
| |
| /* cal info for codec */ |
| struct fw_info *fw_data; |
| |
| /*track tomtom interface type*/ |
| u8 intf_type; |
| |
| /* num of slim ports required */ |
| struct wcd9xxx_codec_dai_data dai[NUM_CODEC_DAIS]; |
| |
| /*compander*/ |
| int comp_enabled[COMPANDER_MAX]; |
| u32 comp_fs[COMPANDER_MAX]; |
| |
| /* Maintain the status of AUX PGA */ |
| int aux_pga_cnt; |
| u8 aux_l_gain; |
| u8 aux_r_gain; |
| |
| bool spkr_pa_widget_on; |
| struct regulator *spkdrv_reg; |
| struct regulator *spkdrv2_reg; |
| |
| bool mbhc_started; |
| |
| struct afe_param_cdc_slimbus_slave_cfg slimbus_slave_cfg; |
| |
| /* resmgr module */ |
| struct wcd9xxx_resmgr resmgr; |
| /* mbhc module */ |
| struct wcd9xxx_mbhc mbhc; |
| |
| /* class h specific data */ |
| struct wcd9xxx_clsh_cdc_data clsh_d; |
| |
| int (*machine_codec_event_cb)(struct snd_soc_codec *codec, |
| enum wcd9xxx_codec_event); |
| int (*codec_ext_clk_en_cb)(struct snd_soc_codec *codec, |
| int enable, bool dapm); |
| int (*codec_get_ext_clk_cnt)(void); |
| /* |
| * list used to save/restore registers at start and |
| * end of impedance measurement |
| */ |
| struct list_head reg_save_restore; |
| |
| /* handle to cpe core */ |
| struct wcd_cpe_core *cpe_core; |
| |
| /* UHQA (class AB) mode */ |
| u8 uhqa_mode; |
| |
| /* Multiplication factor used for impedance detection */ |
| int zdet_gain_mul_fact; |
| |
| /* to track the status */ |
| unsigned long status_mask; |
| |
| int ext_clk_users; |
| struct clk *wcd_ext_clk; |
| |
| /* Port values for Rx and Tx codec_dai */ |
| unsigned int rx_port_value; |
| unsigned int tx_port_value; |
| |
| struct mutex codec_mutex; |
| }; |
| |
| static const u32 comp_shift[] = { |
| 4, /* Compander 0's clock source is on interpolator 7 */ |
| 0, |
| 2, |
| }; |
| |
| static const int comp_rx_path[] = { |
| COMPANDER_1, |
| COMPANDER_1, |
| COMPANDER_2, |
| COMPANDER_2, |
| COMPANDER_2, |
| COMPANDER_2, |
| COMPANDER_0, |
| COMPANDER_0, |
| COMPANDER_MAX, |
| }; |
| |
| static const struct comp_sample_dependent_params comp_samp_params[] = { |
| { |
| /* 8 Khz */ |
| .peak_det_timeout = 0x06, |
| .rms_meter_div_fact = 0x09, |
| .rms_meter_resamp_fact = 0x06, |
| }, |
| { |
| /* 16 Khz */ |
| .peak_det_timeout = 0x07, |
| .rms_meter_div_fact = 0x0A, |
| .rms_meter_resamp_fact = 0x0C, |
| }, |
| { |
| /* 32 Khz */ |
| .peak_det_timeout = 0x08, |
| .rms_meter_div_fact = 0x0B, |
| .rms_meter_resamp_fact = 0x1E, |
| }, |
| { |
| /* 48 Khz */ |
| .peak_det_timeout = 0x09, |
| .rms_meter_div_fact = 0x0B, |
| .rms_meter_resamp_fact = 0x28, |
| }, |
| { |
| /* 96 Khz */ |
| .peak_det_timeout = 0x0A, |
| .rms_meter_div_fact = 0x0C, |
| .rms_meter_resamp_fact = 0x50, |
| }, |
| { |
| /* 192 Khz */ |
| .peak_det_timeout = 0x0B, |
| .rms_meter_div_fact = 0xC, |
| .rms_meter_resamp_fact = 0xA0, |
| }, |
| }; |
| |
| static unsigned short rx_digital_gain_reg[] = { |
| TOMTOM_A_CDC_RX1_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX2_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX3_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX4_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX5_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX6_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX7_VOL_CTL_B2_CTL, |
| TOMTOM_A_CDC_RX8_VOL_CTL_B2_CTL, |
| }; |
| |
| |
| static unsigned short tx_digital_gain_reg[] = { |
| TOMTOM_A_CDC_TX1_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX2_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX3_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX4_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX5_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX6_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX7_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX8_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX9_VOL_CTL_GAIN, |
| TOMTOM_A_CDC_TX10_VOL_CTL_GAIN, |
| }; |
| |
| /* |
| * wcd9330_get_codec_info: Get codec specific information |
| * |
| * @wcd9xxx: pointer to wcd9xxx structure |
| * @wcd_type: pointer to wcd9xxx_codec_type structure |
| * |
| * Returns 0 for success or negative error code for failure |
| */ |
| int wcd9330_get_codec_info(struct wcd9xxx *wcd9xxx, |
| struct wcd9xxx_codec_type *wcd_type) |
| { |
| u16 id_minor, id_major; |
| struct regmap *wcd_regmap; |
| int rc, val, version = 0; |
| |
| if (!wcd9xxx || !wcd_type) |
| return -EINVAL; |
| |
| if (!wcd9xxx->regmap) { |
| dev_err(wcd9xxx->dev, "%s: wcd9xxx regmap is null!\n", |
| __func__); |
| return -EINVAL; |
| } |
| wcd_regmap = wcd9xxx->regmap; |
| rc = regmap_bulk_read(wcd_regmap, TOMTOM_A_CHIP_ID_BYTE_0, |
| (u8 *)&id_minor, sizeof(u16)); |
| if (rc) |
| return -EINVAL; |
| |
| rc = regmap_bulk_read(wcd_regmap, TOMTOM_A_CHIP_ID_BYTE_2, |
| (u8 *)&id_major, sizeof(u16)); |
| if (rc) |
| return -EINVAL; |
| |
| dev_info(wcd9xxx->dev, "%s: wcd9xxx chip id major 0x%x, minor 0x%x\n", |
| __func__, id_major, id_minor); |
| |
| if (id_minor == cpu_to_le16(0x1)) |
| version = 2; |
| else if (id_minor == cpu_to_le16(0x0)) |
| version = 1; |
| else |
| dev_err(wcd9xxx->dev, "%s: wcd9330 version unknown (major 0x%x, minor 0x%x)\n", |
| __func__, id_major, id_minor); |
| |
| /* Fill codec type info */ |
| wcd_type->id_major = id_major; |
| wcd_type->id_minor = id_minor; |
| wcd_type->num_irqs = WCD9330_NUM_IRQS; |
| wcd_type->version = version; |
| wcd_type->slim_slave_type = WCD9XXX_SLIM_SLAVE_ADDR_TYPE_1; |
| wcd_type->i2c_chip_status = 0x01; |
| wcd_type->intr_tbl = wcd9330_intr_tbl; |
| wcd_type->intr_tbl_size = ARRAY_SIZE(wcd9330_intr_tbl); |
| |
| wcd_type->intr_reg[WCD9XXX_INTR_STATUS_BASE] = |
| TOMTOM_A_INTR1_STATUS0; |
| wcd_type->intr_reg[WCD9XXX_INTR_CLEAR_BASE] = |
| TOMTOM_A_INTR1_CLEAR0; |
| wcd_type->intr_reg[WCD9XXX_INTR_MASK_BASE] = |
| TOMTOM_A_INTR1_MASK0; |
| wcd_type->intr_reg[WCD9XXX_INTR_LEVEL_BASE] = |
| TOMTOM_A_INTR1_LEVEL0; |
| wcd_type->intr_reg[WCD9XXX_INTR_CLR_COMMIT] = |
| TOMTOM_A_INTR_MODE; |
| |
| return rc; |
| } |
| EXPORT_SYMBOL(wcd9330_get_codec_info); |
| |
| /* |
| * wcd9330_bringdown: Bringdown WCD Codec |
| * |
| * @wcd9xxx: Pointer to wcd9xxx structure |
| * |
| * Returns 0 for success or negative error code for failure |
| */ |
| int wcd9330_bringdown(struct wcd9xxx *wcd9xxx) |
| { |
| if (!wcd9xxx || !wcd9xxx->regmap) |
| return -EINVAL; |
| |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_LEAKAGE_CTL, 0x7); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_LEAKAGE_CTL, 0x6); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_LEAKAGE_CTL, 0xe); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_LEAKAGE_CTL, 0x8); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL(wcd9330_bringdown); |
| |
| /* |
| * wcd9330_bringup: Bring up WCD Codec |
| * |
| * @wcd9xxx: Pointer to wcd9xxx structure |
| * |
| * Returns 0 for success or negative error code for failure |
| */ |
| int wcd9330_bringup(struct wcd9xxx *wcd9xxx) |
| { |
| if (!wcd9xxx || !wcd9xxx->regmap) |
| return -EINVAL; |
| |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_LEAKAGE_CTL, 0x4); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_CDC_CTL, 0x0); |
| /* wait for 5ms after codec reset for it to complete */ |
| usleep_range(5000, 5100); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_CDC_CTL, 0x1); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_LEAKAGE_CTL, 0x3); |
| regmap_write(wcd9xxx->regmap, TOMTOM_A_CDC_CTL, 0x3); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL(wcd9330_bringup); |
| |
| int tomtom_enable_qfuse_sensing(struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| if (tomtom->wcd_ext_clk) |
| tomtom_codec_mclk_enable(codec, true, false); |
| |
| snd_soc_write(codec, TOMTOM_A_QFUSE_CTL, 0x03); |
| /* |
| * 5ms sleep required after enabling qfuse control |
| * before checking the status. |
| */ |
| usleep_range(5000, 5500); |
| if ((snd_soc_read(codec, TOMTOM_A_QFUSE_STATUS) & (0x03)) != 0x03) |
| WARN(1, "%s: Qfuse sense is not complete\n", __func__); |
| |
| if (tomtom->wcd_ext_clk) |
| tomtom_codec_mclk_enable(codec, false, false); |
| return 0; |
| } |
| EXPORT_SYMBOL(tomtom_enable_qfuse_sensing); |
| |
| static int tomtom_get_sample_rate(struct snd_soc_codec *codec, int path) |
| { |
| if (path == RX8_PATH) |
| return snd_soc_read(codec, TOMTOM_A_CDC_RX8_B5_CTL); |
| else |
| return snd_soc_read(codec, |
| (TOMTOM_A_CDC_RX1_B5_CTL + 8 * (path - 1))); |
| } |
| |
| static int tomtom_compare_bit_format(struct snd_soc_codec *codec, |
| int bit_format) |
| { |
| int i = 0; |
| int ret = 0; |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| for (i = 0; i < NUM_CODEC_DAIS; i++) { |
| if (tomtom_p->dai[i].bit_width == bit_format) { |
| ret = 1; |
| break; |
| } |
| } |
| return ret; |
| } |
| |
| static int tomtom_update_uhqa_mode(struct snd_soc_codec *codec, int path) |
| { |
| int ret = 0; |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| /* UHQA path has fs=192KHz & bit=24 bit */ |
| if (((tomtom_get_sample_rate(codec, path) & 0xE0) == 0xA0) && |
| (tomtom_compare_bit_format(codec, 24))) { |
| tomtom_p->uhqa_mode = 1; |
| } else { |
| tomtom_p->uhqa_mode = 0; |
| } |
| dev_dbg(codec->dev, "%s: uhqa_mode=%d", __func__, tomtom_p->uhqa_mode); |
| return ret; |
| } |
| |
| static int tomtom_get_anc_slot(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| ucontrol->value.integer.value[0] = tomtom->anc_slot; |
| return 0; |
| } |
| |
| static int tomtom_put_anc_slot(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| tomtom->anc_slot = ucontrol->value.integer.value[0]; |
| return 0; |
| } |
| |
| static int tomtom_get_anc_func(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| ucontrol->value.integer.value[0] = (tomtom->anc_func == true ? 1 : 0); |
| return 0; |
| } |
| |
| static int tomtom_put_anc_func(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| struct snd_soc_dapm_context *dapm = |
| snd_soc_codec_get_dapm(codec); |
| |
| mutex_lock(&tomtom->codec_mutex); |
| tomtom->anc_func = (!ucontrol->value.integer.value[0] ? false : true); |
| |
| dev_dbg(codec->dev, "%s: anc_func %x", __func__, tomtom->anc_func); |
| |
| if (tomtom->anc_func == true) { |
| snd_soc_dapm_enable_pin(dapm, "ANC HPHR"); |
| snd_soc_dapm_enable_pin(dapm, "ANC HPHL"); |
| snd_soc_dapm_enable_pin(dapm, "ANC HEADPHONE"); |
| snd_soc_dapm_enable_pin(dapm, "ANC EAR PA"); |
| snd_soc_dapm_enable_pin(dapm, "ANC EAR"); |
| snd_soc_dapm_disable_pin(dapm, "HPHR"); |
| snd_soc_dapm_disable_pin(dapm, "HPHL"); |
| snd_soc_dapm_disable_pin(dapm, "HEADPHONE"); |
| snd_soc_dapm_disable_pin(dapm, "EAR PA"); |
| snd_soc_dapm_disable_pin(dapm, "EAR"); |
| } else { |
| snd_soc_dapm_disable_pin(dapm, "ANC HPHR"); |
| snd_soc_dapm_disable_pin(dapm, "ANC HPHL"); |
| snd_soc_dapm_disable_pin(dapm, "ANC HEADPHONE"); |
| snd_soc_dapm_disable_pin(dapm, "ANC EAR PA"); |
| snd_soc_dapm_disable_pin(dapm, "ANC EAR"); |
| snd_soc_dapm_enable_pin(dapm, "HPHR"); |
| snd_soc_dapm_enable_pin(dapm, "HPHL"); |
| snd_soc_dapm_enable_pin(dapm, "HEADPHONE"); |
| snd_soc_dapm_enable_pin(dapm, "EAR PA"); |
| snd_soc_dapm_enable_pin(dapm, "EAR"); |
| } |
| mutex_unlock(&tomtom->codec_mutex); |
| snd_soc_dapm_sync(dapm); |
| return 0; |
| } |
| |
| static int tomtom_get_iir_enable_audio_mixer( |
| struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| int iir_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->reg; |
| int band_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->shift; |
| |
| ucontrol->value.integer.value[0] = |
| (snd_soc_read(codec, (TOMTOM_A_CDC_IIR1_CTL + 16 * iir_idx)) & |
| (1 << band_idx)) != 0; |
| |
| pr_debug("%s: IIR #%d band #%d enable %d\n", __func__, |
| iir_idx, band_idx, |
| (uint32_t)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static int tomtom_put_iir_enable_audio_mixer( |
| struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| int iir_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->reg; |
| int band_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->shift; |
| int value = ucontrol->value.integer.value[0]; |
| |
| /* Mask first 5 bits, 6-8 are reserved */ |
| snd_soc_update_bits(codec, (TOMTOM_A_CDC_IIR1_CTL + 16 * iir_idx), |
| (1 << band_idx), (value << band_idx)); |
| |
| pr_debug("%s: IIR #%d band #%d enable %d\n", __func__, |
| iir_idx, band_idx, |
| ((snd_soc_read(codec, (TOMTOM_A_CDC_IIR1_CTL + 16 * iir_idx)) & |
| (1 << band_idx)) != 0)); |
| return 0; |
| } |
| static uint32_t get_iir_band_coeff(struct snd_soc_codec *codec, |
| int iir_idx, int band_idx, |
| int coeff_idx) |
| { |
| uint32_t value = 0; |
| |
| /* Address does not automatically update if reading */ |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B1_CTL + 16 * iir_idx), |
| ((band_idx * BAND_MAX + coeff_idx) |
| * sizeof(uint32_t)) & 0x7F); |
| |
| value |= snd_soc_read(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx)); |
| |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B1_CTL + 16 * iir_idx), |
| ((band_idx * BAND_MAX + coeff_idx) |
| * sizeof(uint32_t) + 1) & 0x7F); |
| |
| value |= (snd_soc_read(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx)) << 8); |
| |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B1_CTL + 16 * iir_idx), |
| ((band_idx * BAND_MAX + coeff_idx) |
| * sizeof(uint32_t) + 2) & 0x7F); |
| |
| value |= (snd_soc_read(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx)) << 16); |
| |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B1_CTL + 16 * iir_idx), |
| ((band_idx * BAND_MAX + coeff_idx) |
| * sizeof(uint32_t) + 3) & 0x7F); |
| |
| /* Mask bits top 2 bits since they are reserved */ |
| value |= ((snd_soc_read(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx)) & 0x3F) << 24); |
| |
| return value; |
| } |
| |
| static int tomtom_get_iir_band_audio_mixer( |
| struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| int iir_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->reg; |
| int band_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->shift; |
| |
| ucontrol->value.integer.value[0] = |
| get_iir_band_coeff(codec, iir_idx, band_idx, 0); |
| ucontrol->value.integer.value[1] = |
| get_iir_band_coeff(codec, iir_idx, band_idx, 1); |
| ucontrol->value.integer.value[2] = |
| get_iir_band_coeff(codec, iir_idx, band_idx, 2); |
| ucontrol->value.integer.value[3] = |
| get_iir_band_coeff(codec, iir_idx, band_idx, 3); |
| ucontrol->value.integer.value[4] = |
| get_iir_band_coeff(codec, iir_idx, band_idx, 4); |
| |
| pr_debug("%s: IIR #%d band #%d b0 = 0x%x\n" |
| "%s: IIR #%d band #%d b1 = 0x%x\n" |
| "%s: IIR #%d band #%d b2 = 0x%x\n" |
| "%s: IIR #%d band #%d a1 = 0x%x\n" |
| "%s: IIR #%d band #%d a2 = 0x%x\n", |
| __func__, iir_idx, band_idx, |
| (uint32_t)ucontrol->value.integer.value[0], |
| __func__, iir_idx, band_idx, |
| (uint32_t)ucontrol->value.integer.value[1], |
| __func__, iir_idx, band_idx, |
| (uint32_t)ucontrol->value.integer.value[2], |
| __func__, iir_idx, band_idx, |
| (uint32_t)ucontrol->value.integer.value[3], |
| __func__, iir_idx, band_idx, |
| (uint32_t)ucontrol->value.integer.value[4]); |
| return 0; |
| } |
| |
| static void set_iir_band_coeff(struct snd_soc_codec *codec, |
| int iir_idx, int band_idx, |
| uint32_t value) |
| { |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx), |
| (value & 0xFF)); |
| |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx), |
| (value >> 8) & 0xFF); |
| |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx), |
| (value >> 16) & 0xFF); |
| |
| /* Mask top 2 bits, 7-8 are reserved */ |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B2_CTL + 16 * iir_idx), |
| (value >> 24) & 0x3F); |
| } |
| |
| static int tomtom_put_iir_band_audio_mixer( |
| struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| int iir_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->reg; |
| int band_idx = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->shift; |
| |
| /* Mask top bit it is reserved */ |
| /* Updates addr automatically for each B2 write */ |
| snd_soc_write(codec, |
| (TOMTOM_A_CDC_IIR1_COEF_B1_CTL + 16 * iir_idx), |
| (band_idx * BAND_MAX * sizeof(uint32_t)) & 0x7F); |
| |
| set_iir_band_coeff(codec, iir_idx, band_idx, |
| ucontrol->value.integer.value[0]); |
| set_iir_band_coeff(codec, iir_idx, band_idx, |
| ucontrol->value.integer.value[1]); |
| set_iir_band_coeff(codec, iir_idx, band_idx, |
| ucontrol->value.integer.value[2]); |
| set_iir_band_coeff(codec, iir_idx, band_idx, |
| ucontrol->value.integer.value[3]); |
| set_iir_band_coeff(codec, iir_idx, band_idx, |
| ucontrol->value.integer.value[4]); |
| |
| pr_debug("%s: IIR #%d band #%d b0 = 0x%x\n" |
| "%s: IIR #%d band #%d b1 = 0x%x\n" |
| "%s: IIR #%d band #%d b2 = 0x%x\n" |
| "%s: IIR #%d band #%d a1 = 0x%x\n" |
| "%s: IIR #%d band #%d a2 = 0x%x\n", |
| __func__, iir_idx, band_idx, |
| get_iir_band_coeff(codec, iir_idx, band_idx, 0), |
| __func__, iir_idx, band_idx, |
| get_iir_band_coeff(codec, iir_idx, band_idx, 1), |
| __func__, iir_idx, band_idx, |
| get_iir_band_coeff(codec, iir_idx, band_idx, 2), |
| __func__, iir_idx, band_idx, |
| get_iir_band_coeff(codec, iir_idx, band_idx, 3), |
| __func__, iir_idx, band_idx, |
| get_iir_band_coeff(codec, iir_idx, band_idx, 4)); |
| return 0; |
| } |
| |
| static int tomtom_get_compander(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| int comp = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->shift; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| ucontrol->value.integer.value[0] = tomtom->comp_enabled[comp]; |
| return 0; |
| } |
| |
| static int tomtom_set_compander(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| int comp = ((struct soc_multi_mixer_control *) |
| kcontrol->private_value)->shift; |
| int value = ucontrol->value.integer.value[0]; |
| |
| pr_debug("%s: Compander %d enable current %d, new %d\n", |
| __func__, comp, tomtom->comp_enabled[comp], value); |
| tomtom->comp_enabled[comp] = value; |
| |
| if (comp == COMPANDER_1 && |
| tomtom->comp_enabled[comp] == 1) { |
| /* Wavegen to 5 msec */ |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_CNP_WG_CTL, 0xDB); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_CNP_WG_TIME, 0x2A); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_BIAS_WG_OCP, 0x2A); |
| |
| /* Enable Chopper */ |
| snd_soc_update_bits(codec, |
| TOMTOM_A_RX_HPH_CHOP_CTL, 0x80, 0x80); |
| |
| snd_soc_write(codec, TOMTOM_A_NCP_DTEST, 0x20); |
| pr_debug("%s: Enabled Chopper and set wavegen to 5 msec\n", |
| __func__); |
| } else if (comp == COMPANDER_1 && |
| tomtom->comp_enabled[comp] == 0) { |
| /* Wavegen to 20 msec */ |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_CNP_WG_CTL, 0xDB); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_CNP_WG_TIME, 0x58); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_BIAS_WG_OCP, 0x1A); |
| |
| /* Disable CHOPPER block */ |
| snd_soc_update_bits(codec, |
| TOMTOM_A_RX_HPH_CHOP_CTL, 0x80, 0x00); |
| |
| snd_soc_write(codec, TOMTOM_A_NCP_DTEST, 0x10); |
| pr_debug("%s: Disabled Chopper and set wavegen to 20 msec\n", |
| __func__); |
| } |
| return 0; |
| } |
| |
| static int tomtom_config_gain_compander(struct snd_soc_codec *codec, |
| int comp, bool enable) |
| { |
| int ret = 0; |
| |
| switch (comp) { |
| case COMPANDER_0: |
| snd_soc_update_bits(codec, TOMTOM_A_SPKR_DRV1_GAIN, |
| 1 << 2, !enable << 2); |
| snd_soc_update_bits(codec, TOMTOM_A_SPKR_DRV2_GAIN, |
| 1 << 2, !enable << 2); |
| break; |
| case COMPANDER_1: |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_L_GAIN, |
| 1 << 5, !enable << 5); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_R_GAIN, |
| 1 << 5, !enable << 5); |
| break; |
| case COMPANDER_2: |
| snd_soc_update_bits(codec, TOMTOM_A_RX_LINE_1_GAIN, |
| 1 << 5, !enable << 5); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_LINE_3_GAIN, |
| 1 << 5, !enable << 5); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_LINE_2_GAIN, |
| 1 << 5, !enable << 5); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_LINE_4_GAIN, |
| 1 << 5, !enable << 5); |
| break; |
| default: |
| WARN_ON(1); |
| ret = -EINVAL; |
| } |
| |
| return ret; |
| } |
| |
| static void tomtom_discharge_comp(struct snd_soc_codec *codec, int comp) |
| { |
| /* Level meter DIV Factor to 5*/ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_COMP0_B2_CTL + (comp * 8), 0xF0, |
| 0x05 << 4); |
| /* RMS meter Sampling to 0x01 */ |
| snd_soc_write(codec, TOMTOM_A_CDC_COMP0_B3_CTL + (comp * 8), 0x01); |
| |
| /* Worst case timeout for compander CnP sleep timeout */ |
| usleep_range(3000, 3100); |
| } |
| |
| static enum wcd9xxx_buck_volt tomtom_codec_get_buck_mv( |
| struct snd_soc_codec *codec) |
| { |
| int buck_volt = WCD9XXX_CDC_BUCK_UNSUPPORTED; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_pdata *pdata = tomtom->resmgr.pdata; |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(pdata->regulator); i++) { |
| if (!strcmp(pdata->regulator[i].name, |
| WCD9XXX_SUPPLY_BUCK_NAME)) { |
| if ((pdata->regulator[i].min_uV == |
| WCD9XXX_CDC_BUCK_MV_1P8) || |
| (pdata->regulator[i].min_uV == |
| WCD9XXX_CDC_BUCK_MV_2P15)) |
| buck_volt = pdata->regulator[i].min_uV; |
| break; |
| } |
| } |
| return buck_volt; |
| } |
| |
| static int tomtom_config_compander(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| int mask, enable_mask; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| const int comp = w->shift; |
| const u32 rate = tomtom->comp_fs[comp]; |
| const struct comp_sample_dependent_params *comp_params = |
| &comp_samp_params[rate]; |
| enum wcd9xxx_buck_volt buck_mv; |
| |
| pr_debug("%s: %s event %d compander %d, enabled %d", __func__, |
| w->name, event, comp, tomtom->comp_enabled[comp]); |
| |
| if (!tomtom->comp_enabled[comp]) |
| return 0; |
| |
| /* Compander 0 has two channels */ |
| mask = enable_mask = 0x03; |
| buck_mv = tomtom_codec_get_buck_mv(codec); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| /* Set compander Sample rate */ |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_COMP0_FS_CFG + (comp * 8), |
| 0x07, rate); |
| /* Set the static gain offset for HPH Path */ |
| if (comp == COMPANDER_1) { |
| if (buck_mv == WCD9XXX_CDC_BUCK_MV_2P15) { |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_COMP0_B4_CTL + (comp * 8), |
| 0x80, 0x00); |
| } else { |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_COMP0_B4_CTL + (comp * 8), |
| 0x80, 0x80); |
| } |
| } |
| /* Enable RX interpolation path compander clocks */ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_RX_B2_CTL, |
| mask << comp_shift[comp], |
| mask << comp_shift[comp]); |
| /* Toggle compander reset bits */ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_OTHR_RESET_B2_CTL, |
| mask << comp_shift[comp], |
| mask << comp_shift[comp]); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_OTHR_RESET_B2_CTL, |
| mask << comp_shift[comp], 0); |
| |
| /* Set gain source to compander */ |
| tomtom_config_gain_compander(codec, comp, true); |
| |
| /* Compander enable */ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_COMP0_B1_CTL + |
| (comp * 8), enable_mask, enable_mask); |
| |
| tomtom_discharge_comp(codec, comp); |
| |
| /* Set sample rate dependent parameter */ |
| snd_soc_write(codec, TOMTOM_A_CDC_COMP0_B3_CTL + (comp * 8), |
| comp_params->rms_meter_resamp_fact); |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_COMP0_B2_CTL + (comp * 8), |
| 0xF0, comp_params->rms_meter_div_fact << 4); |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_COMP0_B2_CTL + (comp * 8), |
| 0x0F, comp_params->peak_det_timeout); |
| break; |
| case SND_SOC_DAPM_PRE_PMD: |
| /* Disable compander */ |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_COMP0_B1_CTL + (comp * 8), |
| enable_mask, 0x00); |
| |
| /* Toggle compander reset bits */ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_OTHR_RESET_B2_CTL, |
| mask << comp_shift[comp], |
| mask << comp_shift[comp]); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_OTHR_RESET_B2_CTL, |
| mask << comp_shift[comp], 0); |
| |
| /* Turn off the clock for compander in pair */ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_RX_B2_CTL, |
| mask << comp_shift[comp], 0); |
| |
| /* Set gain source to register */ |
| tomtom_config_gain_compander(codec, comp, false); |
| break; |
| } |
| return 0; |
| } |
| |
| |
| |
| static const char *const tomtom_anc_func_text[] = {"OFF", "ON"}; |
| static const struct soc_enum tomtom_anc_func_enum = |
| SOC_ENUM_SINGLE_EXT(2, tomtom_anc_func_text); |
| |
| static const char *const tabla_ear_pa_gain_text[] = {"POS_6_DB", "POS_2_DB"}; |
| static const struct soc_enum tabla_ear_pa_gain_enum[] = { |
| SOC_ENUM_SINGLE_EXT(2, tabla_ear_pa_gain_text), |
| }; |
| |
| /*cut of frequency for high pass filter*/ |
| static const char * const cf_text[] = { |
| "MIN_3DB_4Hz", "MIN_3DB_75Hz", "MIN_3DB_150Hz" |
| }; |
| |
| static const char * const rx_cf_text[] = { |
| "MIN_3DB_4Hz", "MIN_3DB_75Hz", "MIN_3DB_150Hz", |
| "MIN_3DB_0P48Hz" |
| }; |
| |
| static const struct soc_enum cf_dec1_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX1_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec2_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX2_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec3_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX3_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec4_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX4_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec5_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX5_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec6_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX6_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec7_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX7_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec8_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX8_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec9_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX9_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_dec10_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_TX10_MUX_CTL, 4, 3, cf_text); |
| |
| static const struct soc_enum cf_rxmix1_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX1_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const struct soc_enum cf_rxmix2_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX2_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const struct soc_enum cf_rxmix3_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX3_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const struct soc_enum cf_rxmix4_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX4_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const struct soc_enum cf_rxmix5_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX5_B4_CTL, 0, 4, rx_cf_text) |
| ; |
| static const struct soc_enum cf_rxmix6_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX6_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const struct soc_enum cf_rxmix7_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX7_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const struct soc_enum cf_rxmix8_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_RX8_B4_CTL, 0, 4, rx_cf_text); |
| |
| static const char * const class_h_dsm_text[] = { |
| "ZERO", "DSM_HPHL_RX1", "DSM_SPKR_RX7" |
| }; |
| |
| static const struct soc_enum class_h_dsm_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_CLSH_CTL, 4, 3, class_h_dsm_text); |
| |
| static const struct snd_kcontrol_new class_h_dsm_mux = |
| SOC_DAPM_ENUM("CLASS_H_DSM MUX Mux", class_h_dsm_enum); |
| |
| static const char * const rx1_interp_text[] = { |
| "ZERO", "RX1 MIX2" |
| }; |
| |
| static const struct soc_enum rx1_interp_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CLK_RX_B1_CTL, 0, 2, rx1_interp_text); |
| |
| static const struct snd_kcontrol_new rx1_interp_mux = |
| SOC_DAPM_ENUM("RX1 INTERP MUX Mux", rx1_interp_enum); |
| |
| static const char * const rx2_interp_text[] = { |
| "ZERO", "RX2 MIX2" |
| }; |
| |
| static const struct soc_enum rx2_interp_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CLK_RX_B1_CTL, 1, 2, rx2_interp_text); |
| |
| static const struct snd_kcontrol_new rx2_interp_mux = |
| SOC_DAPM_ENUM("RX2 INTERP MUX Mux", rx2_interp_enum); |
| |
| static const char *const tomtom_conn_mad_text[] = { |
| "ADC_MB", "ADC1", "ADC2", "ADC3", "ADC4", "ADC5", "ADC6", "NOTUSED1", |
| "DMIC1", "DMIC2", "DMIC3", "DMIC4", "DMIC5", "DMIC6", "NOTUSED2", |
| "NOTUSED3"}; |
| |
| static const struct soc_enum tomtom_conn_mad_enum = |
| SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(tomtom_conn_mad_text), |
| tomtom_conn_mad_text); |
| |
| |
| static int tomtom_mad_input_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| u8 tomtom_mad_input; |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| |
| tomtom_mad_input = snd_soc_read(codec, TOMTOM_A_CDC_MAD_INP_SEL); |
| |
| tomtom_mad_input = tomtom_mad_input & 0x0F; |
| |
| ucontrol->value.integer.value[0] = tomtom_mad_input; |
| |
| pr_debug("%s: tomtom_mad_input = %s\n", __func__, |
| tomtom_conn_mad_text[tomtom_mad_input]); |
| |
| return 0; |
| } |
| |
| static int tomtom_mad_input_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| u8 tomtom_mad_input; |
| u16 micb_int_reg, micb_4_int_reg; |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct snd_soc_card *card = codec->component.card; |
| char mad_amic_input_widget[6]; |
| u32 adc; |
| const char *mad_input_widget; |
| const char *source_widget = NULL; |
| u32 mic_bias_found = 0; |
| u32 i; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| int ret = 0; |
| char *mad_input; |
| |
| tomtom_mad_input = ucontrol->value.integer.value[0]; |
| micb_4_int_reg = tomtom->resmgr.reg_addr->micb_4_int_rbias; |
| |
| if (tomtom_mad_input >= ARRAY_SIZE(tomtom_conn_mad_text)) { |
| dev_err(codec->dev, |
| "%s: tomtom_mad_input = %d out of bounds\n", |
| __func__, tomtom_mad_input); |
| return -EINVAL; |
| } |
| |
| pr_debug("%s: tomtom_mad_input = %s\n", __func__, |
| tomtom_conn_mad_text[tomtom_mad_input]); |
| |
| if (!strcmp(tomtom_conn_mad_text[tomtom_mad_input], "NOTUSED1") || |
| !strcmp(tomtom_conn_mad_text[tomtom_mad_input], "NOTUSED2") || |
| !strcmp(tomtom_conn_mad_text[tomtom_mad_input], "NOTUSED3") || |
| !strcmp(tomtom_conn_mad_text[tomtom_mad_input], "ADC_MB")) { |
| pr_info("%s: tomtom mad input is set to unsupported input = %s\n", |
| __func__, tomtom_conn_mad_text[tomtom_mad_input]); |
| return -EINVAL; |
| } |
| |
| if (strnstr(tomtom_conn_mad_text[tomtom_mad_input], |
| "ADC", sizeof("ADC"))) { |
| mad_input = strpbrk(tomtom_conn_mad_text[tomtom_mad_input], |
| "123456"); |
| if (!mad_input) { |
| dev_err(codec->dev, "%s: Invalid MAD input %s\n", |
| __func__, tomtom_conn_mad_text[tomtom_mad_input]); |
| return -EINVAL; |
| } |
| ret = kstrtouint(mad_input, 10, &adc); |
| if ((ret < 0) || (adc > 6)) { |
| pr_err("%s: Invalid ADC = %s\n", __func__, |
| tomtom_conn_mad_text[tomtom_mad_input]); |
| ret = -EINVAL; |
| } |
| |
| snprintf(mad_amic_input_widget, 6, "%s%u", "AMIC", adc); |
| |
| mad_input_widget = mad_amic_input_widget; |
| pr_debug("%s: tomtom amic input widget = %s\n", __func__, |
| mad_amic_input_widget); |
| } else { |
| /* DMIC type input widget*/ |
| mad_input_widget = tomtom_conn_mad_text[tomtom_mad_input]; |
| } |
| |
| pr_debug("%s: tomtom input widget = %s\n", __func__, mad_input_widget); |
| |
| for (i = 0; i < card->num_dapm_routes; i++) { |
| |
| if (!strcmp(card->dapm_routes[i].sink, mad_input_widget)) { |
| |
| source_widget = card->dapm_routes[i].source; |
| if (!source_widget) { |
| dev_err(codec->dev, |
| "%s: invalid source widget\n", |
| __func__); |
| return -EINVAL; |
| } |
| |
| if (strnstr(source_widget, |
| "MIC BIAS1", sizeof("MIC BIAS1"))) { |
| mic_bias_found = 1; |
| micb_int_reg = TOMTOM_A_MICB_1_INT_RBIAS; |
| break; |
| } else if (strnstr(source_widget, |
| "MIC BIAS2", sizeof("MIC BIAS2"))) { |
| mic_bias_found = 2; |
| micb_int_reg = TOMTOM_A_MICB_2_INT_RBIAS; |
| break; |
| } else if (strnstr(source_widget, |
| "MIC BIAS3", sizeof("MIC BIAS3"))) { |
| mic_bias_found = 3; |
| micb_int_reg = TOMTOM_A_MICB_3_INT_RBIAS; |
| break; |
| } else if (strnstr(source_widget, |
| "MIC BIAS4", sizeof("MIC BIAS4"))) { |
| mic_bias_found = 4; |
| micb_int_reg = micb_4_int_reg; |
| break; |
| } |
| } |
| } |
| |
| if (mic_bias_found) { |
| pr_debug("%s: source mic bias = %s. sink = %s\n", __func__, |
| card->dapm_routes[i].source, |
| card->dapm_routes[i].sink); |
| |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_INP_SEL, |
| 0x0F, tomtom_mad_input); |
| snd_soc_update_bits(codec, TOMTOM_A_MAD_ANA_CTRL, |
| 0x07, mic_bias_found); |
| |
| /* Setup internal micbias */ |
| |
| if (strnstr(source_widget, "Internal1", strlen(source_widget))) |
| snd_soc_update_bits(codec, |
| micb_int_reg, |
| 0xE0, 0xE0); |
| else if (strnstr(source_widget, "Internal2", |
| strlen(source_widget))) |
| snd_soc_update_bits(codec, |
| micb_int_reg, |
| 0x1C, 0x1C); |
| else if (strnstr(source_widget, "Internal3", |
| strlen(source_widget))) |
| snd_soc_update_bits(codec, |
| micb_int_reg, |
| 0x3, 0x3); |
| else |
| /* |
| * If not internal, make sure to write the |
| * register to default value |
| */ |
| snd_soc_write(codec, micb_int_reg, 0x24); |
| return 0; |
| } |
| |
| pr_err("%s: mic bias source not found for input = %s\n", |
| __func__, mad_input_widget); |
| return -EINVAL; |
| } |
| |
| static int tomtom_tx_hpf_bypass_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| u32 tx_index; |
| |
| tx_index = (u32)kcontrol->private_value; |
| |
| if (tx_index > NUM_DECIMATORS) { |
| pr_err("%s: Invalid TX decimator %d\n", __func__, |
| tx_index); |
| return -EINVAL; |
| } |
| |
| ucontrol->value.integer.value[0] = |
| tx_hpf_work[tx_index-1].tx_hpf_bypass; |
| |
| return 0; |
| } |
| |
| static int tomtom_tx_hpf_bypass_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| bool tx_hpf_bypass_cfg; |
| u32 tx_index; |
| |
| tx_hpf_bypass_cfg = (bool)ucontrol->value.integer.value[0]; |
| |
| pr_debug("%s: tx_hpf_bypass = %d\n", __func__, |
| tx_hpf_bypass_cfg); |
| |
| tx_index = (u32)kcontrol->private_value; |
| |
| if (tx_index > NUM_DECIMATORS) { |
| pr_err("%s: Invalid TX decimator %d\n", __func__, |
| tx_index); |
| return -EINVAL; |
| } |
| if (tx_hpf_work[tx_index-1].tx_hpf_bypass != tx_hpf_bypass_cfg) |
| tx_hpf_work[tx_index-1].tx_hpf_bypass = tx_hpf_bypass_cfg; |
| |
| pr_debug("%s: Set TX%d HPF bypass configuration %d", |
| __func__, tx_index, |
| tx_hpf_work[tx_index-1].tx_hpf_bypass); |
| |
| return 0; |
| } |
| |
| static const struct snd_kcontrol_new tomtom_snd_controls[] = { |
| |
| SOC_SINGLE_SX_TLV("RX1 Digital Volume", TOMTOM_A_CDC_RX1_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX2 Digital Volume", TOMTOM_A_CDC_RX2_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX3 Digital Volume", TOMTOM_A_CDC_RX3_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX4 Digital Volume", TOMTOM_A_CDC_RX4_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX5 Digital Volume", TOMTOM_A_CDC_RX5_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX6 Digital Volume", TOMTOM_A_CDC_RX6_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX7 Digital Volume", TOMTOM_A_CDC_RX7_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("RX8 Digital Volume", TOMTOM_A_CDC_RX8_VOL_CTL_B2_CTL, |
| 0, -84, 40, digital_gain), |
| |
| SOC_SINGLE_SX_TLV("DEC1 Volume", TOMTOM_A_CDC_TX1_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC2 Volume", TOMTOM_A_CDC_TX2_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC3 Volume", TOMTOM_A_CDC_TX3_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC4 Volume", TOMTOM_A_CDC_TX4_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC5 Volume", TOMTOM_A_CDC_TX5_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC6 Volume", TOMTOM_A_CDC_TX6_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC7 Volume", TOMTOM_A_CDC_TX7_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC8 Volume", TOMTOM_A_CDC_TX8_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC9 Volume", TOMTOM_A_CDC_TX9_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("DEC10 Volume", TOMTOM_A_CDC_TX10_VOL_CTL_GAIN, 0, |
| -84, 40, digital_gain), |
| |
| SOC_SINGLE_SX_TLV("IIR1 INP1 Volume", TOMTOM_A_CDC_IIR1_GAIN_B1_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR1 INP2 Volume", TOMTOM_A_CDC_IIR1_GAIN_B2_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR1 INP3 Volume", TOMTOM_A_CDC_IIR1_GAIN_B3_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR1 INP4 Volume", TOMTOM_A_CDC_IIR1_GAIN_B4_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR2 INP1 Volume", TOMTOM_A_CDC_IIR2_GAIN_B1_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR2 INP2 Volume", TOMTOM_A_CDC_IIR2_GAIN_B2_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR2 INP3 Volume", TOMTOM_A_CDC_IIR2_GAIN_B3_CTL, 0, |
| -84, 40, digital_gain), |
| SOC_SINGLE_SX_TLV("IIR2 INP4 Volume", TOMTOM_A_CDC_IIR2_GAIN_B4_CTL, 0, |
| -84, 40, digital_gain), |
| |
| SOC_SINGLE_EXT("ANC Slot", SND_SOC_NOPM, 0, 100, 0, tomtom_get_anc_slot, |
| tomtom_put_anc_slot), |
| SOC_ENUM_EXT("ANC Function", tomtom_anc_func_enum, tomtom_get_anc_func, |
| tomtom_put_anc_func), |
| |
| SOC_ENUM("TX1 HPF cut off", cf_dec1_enum), |
| SOC_ENUM("TX2 HPF cut off", cf_dec2_enum), |
| SOC_ENUM("TX3 HPF cut off", cf_dec3_enum), |
| SOC_ENUM("TX4 HPF cut off", cf_dec4_enum), |
| SOC_ENUM("TX5 HPF cut off", cf_dec5_enum), |
| SOC_ENUM("TX6 HPF cut off", cf_dec6_enum), |
| SOC_ENUM("TX7 HPF cut off", cf_dec7_enum), |
| SOC_ENUM("TX8 HPF cut off", cf_dec8_enum), |
| SOC_ENUM("TX9 HPF cut off", cf_dec9_enum), |
| SOC_ENUM("TX10 HPF cut off", cf_dec10_enum), |
| |
| SOC_SINGLE_BOOL_EXT("TX1 HPF Switch", 1, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX2 HPF Switch", 2, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX3 HPF Switch", 3, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX4 HPF Switch", 4, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX5 HPF Switch", 5, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX6 HPF Switch", 6, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX7 HPF Switch", 7, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX8 HPF Switch", 8, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX9 HPF Switch", 9, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| SOC_SINGLE_BOOL_EXT("TX10 HPF Switch", 10, |
| tomtom_tx_hpf_bypass_get, |
| tomtom_tx_hpf_bypass_put), |
| |
| SOC_SINGLE("RX1 HPF Switch", TOMTOM_A_CDC_RX1_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX2 HPF Switch", TOMTOM_A_CDC_RX2_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX3 HPF Switch", TOMTOM_A_CDC_RX3_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX4 HPF Switch", TOMTOM_A_CDC_RX4_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX5 HPF Switch", TOMTOM_A_CDC_RX5_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX6 HPF Switch", TOMTOM_A_CDC_RX6_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX7 HPF Switch", TOMTOM_A_CDC_RX7_B5_CTL, 2, 1, 0), |
| SOC_SINGLE("RX8 HPF Switch", TOMTOM_A_CDC_RX8_B5_CTL, 2, 1, 0), |
| |
| SOC_ENUM("RX1 HPF cut off", cf_rxmix1_enum), |
| SOC_ENUM("RX2 HPF cut off", cf_rxmix2_enum), |
| SOC_ENUM("RX3 HPF cut off", cf_rxmix3_enum), |
| SOC_ENUM("RX4 HPF cut off", cf_rxmix4_enum), |
| SOC_ENUM("RX5 HPF cut off", cf_rxmix5_enum), |
| SOC_ENUM("RX6 HPF cut off", cf_rxmix6_enum), |
| SOC_ENUM("RX7 HPF cut off", cf_rxmix7_enum), |
| SOC_ENUM("RX8 HPF cut off", cf_rxmix8_enum), |
| |
| SOC_SINGLE_EXT("IIR1 Enable Band1", IIR1, BAND1, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR1 Enable Band2", IIR1, BAND2, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR1 Enable Band3", IIR1, BAND3, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR1 Enable Band4", IIR1, BAND4, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR1 Enable Band5", IIR1, BAND5, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR2 Enable Band1", IIR2, BAND1, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR2 Enable Band2", IIR2, BAND2, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR2 Enable Band3", IIR2, BAND3, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR2 Enable Band4", IIR2, BAND4, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| SOC_SINGLE_EXT("IIR2 Enable Band5", IIR2, BAND5, 1, 0, |
| tomtom_get_iir_enable_audio_mixer, tomtom_put_iir_enable_audio_mixer), |
| |
| SOC_SINGLE_MULTI_EXT("IIR1 Band1", IIR1, BAND1, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR1 Band2", IIR1, BAND2, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR1 Band3", IIR1, BAND3, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR1 Band4", IIR1, BAND4, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR1 Band5", IIR1, BAND5, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR2 Band1", IIR2, BAND1, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR2 Band2", IIR2, BAND2, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR2 Band3", IIR2, BAND3, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR2 Band4", IIR2, BAND4, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| SOC_SINGLE_MULTI_EXT("IIR2 Band5", IIR2, BAND5, 255, 0, 5, |
| tomtom_get_iir_band_audio_mixer, tomtom_put_iir_band_audio_mixer), |
| |
| SOC_SINGLE_EXT("COMP0 Switch", SND_SOC_NOPM, COMPANDER_0, 1, 0, |
| tomtom_get_compander, tomtom_set_compander), |
| SOC_SINGLE_EXT("COMP1 Switch", SND_SOC_NOPM, COMPANDER_1, 1, 0, |
| tomtom_get_compander, tomtom_set_compander), |
| SOC_SINGLE_EXT("COMP2 Switch", SND_SOC_NOPM, COMPANDER_2, 1, 0, |
| tomtom_get_compander, tomtom_set_compander), |
| |
| SOC_ENUM_EXT("MAD Input", tomtom_conn_mad_enum, |
| tomtom_mad_input_get, tomtom_mad_input_put), |
| |
| }; |
| |
| static int tomtom_pa_gain_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| u8 ear_pa_gain; |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| |
| ear_pa_gain = snd_soc_read(codec, TOMTOM_A_RX_EAR_GAIN); |
| |
| ear_pa_gain = ear_pa_gain >> 5; |
| |
| ucontrol->value.integer.value[0] = ear_pa_gain; |
| |
| pr_debug("%s: ear_pa_gain = 0x%x\n", __func__, ear_pa_gain); |
| |
| return 0; |
| } |
| |
| static int tomtom_pa_gain_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| u8 ear_pa_gain; |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| |
| pr_debug("%s: ucontrol->value.integer.value[0] = %ld\n", __func__, |
| ucontrol->value.integer.value[0]); |
| |
| ear_pa_gain = ucontrol->value.integer.value[0] << 5; |
| |
| snd_soc_update_bits(codec, TOMTOM_A_RX_EAR_GAIN, 0xE0, ear_pa_gain); |
| return 0; |
| } |
| |
| static const char * const tomtom_1_x_ear_pa_gain_text[] = { |
| "POS_6_DB", "POS_4P5_DB", "POS_3_DB", "POS_1P5_DB", |
| "POS_0_DB", "NEG_2P5_DB", "UNDEFINED", "NEG_12_DB" |
| }; |
| |
| static const struct soc_enum tomtom_1_x_ear_pa_gain_enum = |
| SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(tomtom_1_x_ear_pa_gain_text), |
| tomtom_1_x_ear_pa_gain_text); |
| |
| static const struct snd_kcontrol_new tomtom_1_x_analog_gain_controls[] = { |
| |
| SOC_ENUM_EXT("EAR PA Gain", tomtom_1_x_ear_pa_gain_enum, |
| tomtom_pa_gain_get, tomtom_pa_gain_put), |
| |
| SOC_SINGLE_TLV("HPHL Volume", TOMTOM_A_RX_HPH_L_GAIN, 0, 20, 1, |
| line_gain), |
| SOC_SINGLE_TLV("HPHR Volume", TOMTOM_A_RX_HPH_R_GAIN, 0, 20, 1, |
| line_gain), |
| |
| SOC_SINGLE_TLV("LINEOUT1 Volume", TOMTOM_A_RX_LINE_1_GAIN, 0, 20, 1, |
| line_gain), |
| SOC_SINGLE_TLV("LINEOUT2 Volume", TOMTOM_A_RX_LINE_2_GAIN, 0, 20, 1, |
| line_gain), |
| SOC_SINGLE_TLV("LINEOUT3 Volume", TOMTOM_A_RX_LINE_3_GAIN, 0, 20, 1, |
| line_gain), |
| SOC_SINGLE_TLV("LINEOUT4 Volume", TOMTOM_A_RX_LINE_4_GAIN, 0, 20, 1, |
| line_gain), |
| |
| SOC_SINGLE_TLV("SPK DRV Volume", TOMTOM_A_SPKR_DRV1_GAIN, 3, 8, 1, |
| line_gain), |
| SOC_SINGLE_TLV("SPK DRV2 Volume", TOMTOM_A_SPKR_DRV2_GAIN, 3, 8, 1, |
| line_gain), |
| |
| SOC_SINGLE_TLV("ADC1 Volume", TOMTOM_A_TX_1_GAIN, 2, 19, 0, |
| analog_gain), |
| SOC_SINGLE_TLV("ADC2 Volume", TOMTOM_A_TX_2_GAIN, 2, 19, 0, |
| analog_gain), |
| SOC_SINGLE_TLV("ADC3 Volume", TOMTOM_A_TX_3_GAIN, 2, 19, 0, |
| analog_gain), |
| SOC_SINGLE_TLV("ADC4 Volume", TOMTOM_A_TX_4_GAIN, 2, 19, 0, |
| analog_gain), |
| SOC_SINGLE_TLV("ADC5 Volume", TOMTOM_A_TX_5_GAIN, 2, 19, 0, |
| analog_gain), |
| SOC_SINGLE_TLV("ADC6 Volume", TOMTOM_A_TX_6_GAIN, 2, 19, 0, |
| analog_gain), |
| }; |
| |
| static int tomtom_hph_impedance_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| uint32_t zl, zr; |
| bool hphr; |
| struct soc_multi_mixer_control *mc; |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| mc = (struct soc_multi_mixer_control *)(kcontrol->private_value); |
| |
| hphr = mc->shift; |
| wcd9xxx_mbhc_get_impedance(&priv->mbhc, &zl, &zr); |
| pr_debug("%s: zl %u, zr %u\n", __func__, zl, zr); |
| ucontrol->value.integer.value[0] = hphr ? zr : zl; |
| |
| return 0; |
| } |
| |
| static const struct snd_kcontrol_new impedance_detect_controls[] = { |
| SOC_SINGLE_EXT("HPHL Impedance", 0, 0, UINT_MAX, 0, |
| tomtom_hph_impedance_get, NULL), |
| SOC_SINGLE_EXT("HPHR Impedance", 0, 1, UINT_MAX, 0, |
| tomtom_hph_impedance_get, NULL), |
| }; |
| |
| static int tomtom_get_hph_type(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_mbhc *mbhc; |
| |
| if (!priv) { |
| pr_debug("%s: wcd9330 private data is NULL\n", __func__); |
| return 0; |
| } |
| |
| mbhc = &priv->mbhc; |
| if (!mbhc) { |
| pr_debug("%s: mbhc not initialized\n", __func__); |
| return 0; |
| } |
| |
| ucontrol->value.integer.value[0] = (u32) mbhc->hph_type; |
| pr_debug("%s: hph_type = %u\n", __func__, mbhc->hph_type); |
| |
| return 0; |
| } |
| |
| static const struct snd_kcontrol_new hph_type_detect_controls[] = { |
| SOC_SINGLE_EXT("HPH Type", 0, 0, UINT_MAX, 0, |
| tomtom_get_hph_type, NULL), |
| }; |
| |
| static const char * const rx_mix1_text[] = { |
| "ZERO", "SRC1", "SRC2", "IIR1", "IIR2", "RX1", "RX2", "RX3", "RX4", |
| "RX5", "RX6", "RX7" |
| }; |
| |
| static const char * const rx8_mix1_text[] = { |
| "ZERO", "IIR1", "IIR2", "RX1", "RX2", "RX3", "RX4", |
| "RX5", "RX6", "RX7", "RX8" |
| }; |
| |
| static const char * const rx_mix2_text[] = { |
| "ZERO", "SRC1", "SRC2", "IIR1", "IIR2" |
| }; |
| |
| static const char * const rx_rdac5_text[] = { |
| "DEM4", "DEM3_INV" |
| }; |
| |
| static const char * const rx_rdac7_text[] = { |
| "DEM6", "DEM5_INV" |
| }; |
| |
| static const char * const mad_sel_text[] = { |
| "SPE", "MSM" |
| }; |
| |
| static const char * const sb_tx1_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC1", "RMIX8" |
| }; |
| |
| static const char * const sb_tx2_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC2", "RMIX8" |
| }; |
| |
| static const char * const sb_tx3_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC3", "RMIX8" |
| }; |
| |
| static const char * const sb_tx4_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC4", "RMIX8" |
| }; |
| |
| static const char * const sb_tx5_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC5", "RMIX8" |
| }; |
| |
| static const char * const sb_tx6_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC6", "RMIX8" |
| }; |
| |
| static const char * const sb_tx7_to_tx10_mux_text[] = { |
| "ZERO", "RMIX1", "RMIX2", "RMIX3", "RMIX4", "RMIX5", "RMIX6", "RMIX7", |
| "DEC1", "DEC2", "DEC3", "DEC4", "DEC5", "DEC6", "DEC7", "DEC8", |
| "DEC9", "DEC10" |
| }; |
| |
| static const char * const dec1_mux_text[] = { |
| "ZERO", "DMIC1", "ADC6", |
| }; |
| |
| static const char * const dec2_mux_text[] = { |
| "ZERO", "DMIC2", "ADC5", |
| }; |
| |
| static const char * const dec3_mux_text[] = { |
| "ZERO", "DMIC3", "ADC4", |
| }; |
| |
| static const char * const dec4_mux_text[] = { |
| "ZERO", "DMIC4", "ADC3", |
| }; |
| |
| static const char * const dec5_mux_text[] = { |
| "ZERO", "DMIC5", "ADC2", |
| }; |
| |
| static const char * const dec6_mux_text[] = { |
| "ZERO", "DMIC6", "ADC1", |
| }; |
| |
| static const char * const dec7_mux_text[] = { |
| "ZERO", "DMIC1", "DMIC6", "ADC1", "ADC6", "ANC1_FB", "ANC2_FB", |
| }; |
| |
| static const char * const dec8_mux_text[] = { |
| "ZERO", "DMIC2", "DMIC5", "ADC2", "ADC5", "ANC1_FB", "ANC2_FB", |
| }; |
| |
| static const char * const dec9_mux_text[] = { |
| "ZERO", "DMIC4", "DMIC5", "ADC2", "ADC3", "ADCMB", "ANC1_FB", "ANC2_FB", |
| }; |
| |
| static const char * const dec10_mux_text[] = { |
| "ZERO", "DMIC3", "DMIC6", "ADC1", "ADC4", "ADCMB", "ANC1_FB", "ANC2_FB", |
| }; |
| |
| static const char * const anc_mux_text[] = { |
| "ZERO", "ADC1", "ADC2", "ADC3", "ADC4", "ADC5", "ADC6", "ADC_MB", |
| "RSVD_1", "DMIC1", "DMIC2", "DMIC3", "DMIC4", "DMIC5", "DMIC6" |
| }; |
| |
| static const char * const anc1_fb_mux_text[] = { |
| "ZERO", "EAR_HPH_L", "EAR_LINE_1", |
| }; |
| |
| static const char * const iir_inp1_text[] = { |
| "ZERO", "DEC1", "DEC2", "DEC3", "DEC4", "DEC5", "DEC6", "DEC7", "DEC8", |
| "DEC9", "DEC10", "RX1", "RX2", "RX3", "RX4", "RX5", "RX6", "RX7" |
| }; |
| |
| static const char * const iir_inp2_text[] = { |
| "ZERO", "DEC1", "DEC2", "DEC3", "DEC4", "DEC5", "DEC6", "DEC7", "DEC8", |
| "DEC9", "DEC10", "RX1", "RX2", "RX3", "RX4", "RX5", "RX6", "RX7" |
| }; |
| |
| static const char * const iir_inp3_text[] = { |
| "ZERO", "DEC1", "DEC2", "DEC3", "DEC4", "DEC5", "DEC6", "DEC7", "DEC8", |
| "DEC9", "DEC10", "RX1", "RX2", "RX3", "RX4", "RX5", "RX6", "RX7" |
| }; |
| |
| static const char * const iir_inp4_text[] = { |
| "ZERO", "DEC1", "DEC2", "DEC3", "DEC4", "DEC5", "DEC6", "DEC7", "DEC8", |
| "DEC9", "DEC10", "RX1", "RX2", "RX3", "RX4", "RX5", "RX6", "RX7" |
| }; |
| |
| static const struct soc_enum rx_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX1_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX1_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx_mix1_inp3_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX1_B2_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx2_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX2_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx2_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX2_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx3_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX3_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx3_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX3_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx4_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX4_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx4_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX4_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx5_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX5_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx5_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX5_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx6_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX6_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx6_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX6_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx7_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX7_B1_CTL, 0, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx7_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX7_B1_CTL, 4, 12, rx_mix1_text); |
| |
| static const struct soc_enum rx8_mix1_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX8_B1_CTL, 0, 11, rx8_mix1_text); |
| |
| static const struct soc_enum rx8_mix1_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX8_B1_CTL, 4, 11, rx8_mix1_text); |
| |
| static const struct soc_enum rx1_mix2_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX1_B3_CTL, 0, 5, rx_mix2_text); |
| |
| static const struct soc_enum rx1_mix2_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX1_B3_CTL, 3, 5, rx_mix2_text); |
| |
| static const struct soc_enum rx2_mix2_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX2_B3_CTL, 0, 5, rx_mix2_text); |
| |
| static const struct soc_enum rx2_mix2_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX2_B3_CTL, 3, 5, rx_mix2_text); |
| |
| static const struct soc_enum rx7_mix2_inp1_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX7_B3_CTL, 0, 5, rx_mix2_text); |
| |
| static const struct soc_enum rx7_mix2_inp2_chain_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_RX7_B3_CTL, 3, 5, rx_mix2_text); |
| |
| static const struct soc_enum rx_rdac5_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_MISC, 2, 2, rx_rdac5_text); |
| |
| static const struct soc_enum rx_rdac7_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_MISC, 1, 2, rx_rdac7_text); |
| |
| static const struct soc_enum mad_sel_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_SVASS_CFG, 0, 2, mad_sel_text); |
| |
| static const struct soc_enum sb_tx1_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B1_CTL, 0, 10, sb_tx1_mux_text); |
| |
| static const struct soc_enum sb_tx2_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B2_CTL, 0, 10, sb_tx2_mux_text); |
| |
| static const struct soc_enum sb_tx3_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B3_CTL, 0, 10, sb_tx3_mux_text); |
| |
| static const struct soc_enum sb_tx4_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B4_CTL, 0, 10, sb_tx4_mux_text); |
| |
| static const struct soc_enum sb_tx5_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B5_CTL, 0, 10, sb_tx5_mux_text); |
| |
| static const struct soc_enum sb_tx6_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B6_CTL, 0, 10, sb_tx6_mux_text); |
| |
| static const struct soc_enum sb_tx7_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B7_CTL, 0, 18, |
| sb_tx7_to_tx10_mux_text); |
| |
| static const struct soc_enum sb_tx8_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B8_CTL, 0, 18, |
| sb_tx7_to_tx10_mux_text); |
| |
| static const struct soc_enum sb_tx9_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B9_CTL, 0, 18, |
| sb_tx7_to_tx10_mux_text); |
| |
| static const struct soc_enum sb_tx10_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_SB_B10_CTL, 0, 18, |
| sb_tx7_to_tx10_mux_text); |
| |
| static const struct soc_enum dec1_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B1_CTL, 0, 3, dec1_mux_text); |
| |
| static const struct soc_enum dec2_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B1_CTL, 2, 3, dec2_mux_text); |
| |
| static const struct soc_enum dec3_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B1_CTL, 4, 3, dec3_mux_text); |
| |
| static const struct soc_enum dec4_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B1_CTL, 6, 3, dec4_mux_text); |
| |
| static const struct soc_enum dec5_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B2_CTL, 0, 3, dec5_mux_text); |
| |
| static const struct soc_enum dec6_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B2_CTL, 2, 3, dec6_mux_text); |
| |
| static const struct soc_enum dec7_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B2_CTL, 4, 7, dec7_mux_text); |
| |
| static const struct soc_enum dec8_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B3_CTL, 0, 7, dec8_mux_text); |
| |
| static const struct soc_enum dec9_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B3_CTL, 3, 8, dec9_mux_text); |
| |
| static const struct soc_enum dec10_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_TX_B4_CTL, 0, 8, dec10_mux_text); |
| |
| static const struct soc_enum anc1_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_ANC_B1_CTL, 0, 15, anc_mux_text); |
| |
| static const struct soc_enum anc2_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_ANC_B1_CTL, 4, 15, anc_mux_text); |
| |
| static const struct soc_enum anc1_fb_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_ANC_B2_CTL, 0, 3, anc1_fb_mux_text); |
| |
| static const struct soc_enum iir1_inp1_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ1_B1_CTL, 0, 18, iir_inp1_text); |
| |
| static const struct soc_enum iir2_inp1_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ2_B1_CTL, 0, 18, iir_inp1_text); |
| |
| static const struct soc_enum iir1_inp2_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ1_B2_CTL, 0, 18, iir_inp2_text); |
| |
| static const struct soc_enum iir2_inp2_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ2_B2_CTL, 0, 18, iir_inp2_text); |
| |
| static const struct soc_enum iir1_inp3_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ1_B3_CTL, 0, 18, iir_inp3_text); |
| |
| static const struct soc_enum iir2_inp3_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ2_B3_CTL, 0, 18, iir_inp3_text); |
| |
| static const struct soc_enum iir1_inp4_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ1_B4_CTL, 0, 18, iir_inp4_text); |
| |
| static const struct soc_enum iir2_inp4_mux_enum = |
| SOC_ENUM_SINGLE(TOMTOM_A_CDC_CONN_EQ2_B4_CTL, 0, 18, iir_inp4_text); |
| |
| static const struct snd_kcontrol_new rx_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX1 MIX1 INP1 Mux", rx_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX1 MIX1 INP2 Mux", rx_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx_mix1_inp3_mux = |
| SOC_DAPM_ENUM("RX1 MIX1 INP3 Mux", rx_mix1_inp3_chain_enum); |
| |
| static const struct snd_kcontrol_new rx2_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX2 MIX1 INP1 Mux", rx2_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx2_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX2 MIX1 INP2 Mux", rx2_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx3_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX3 MIX1 INP1 Mux", rx3_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx3_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX3 MIX1 INP2 Mux", rx3_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx4_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX4 MIX1 INP1 Mux", rx4_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx4_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX4 MIX1 INP2 Mux", rx4_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx5_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX5 MIX1 INP1 Mux", rx5_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx5_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX5 MIX1 INP2 Mux", rx5_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx6_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX6 MIX1 INP1 Mux", rx6_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx6_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX6 MIX1 INP2 Mux", rx6_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx7_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX7 MIX1 INP1 Mux", rx7_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx7_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX7 MIX1 INP2 Mux", rx7_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx8_mix1_inp1_mux = |
| SOC_DAPM_ENUM("RX8 MIX1 INP1 Mux", rx8_mix1_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx8_mix1_inp2_mux = |
| SOC_DAPM_ENUM("RX8 MIX1 INP2 Mux", rx8_mix1_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx1_mix2_inp1_mux = |
| SOC_DAPM_ENUM("RX1 MIX2 INP1 Mux", rx1_mix2_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx1_mix2_inp2_mux = |
| SOC_DAPM_ENUM("RX1 MIX2 INP2 Mux", rx1_mix2_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx2_mix2_inp1_mux = |
| SOC_DAPM_ENUM("RX2 MIX2 INP1 Mux", rx2_mix2_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx2_mix2_inp2_mux = |
| SOC_DAPM_ENUM("RX2 MIX2 INP2 Mux", rx2_mix2_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx7_mix2_inp1_mux = |
| SOC_DAPM_ENUM("RX7 MIX2 INP1 Mux", rx7_mix2_inp1_chain_enum); |
| |
| static const struct snd_kcontrol_new rx7_mix2_inp2_mux = |
| SOC_DAPM_ENUM("RX7 MIX2 INP2 Mux", rx7_mix2_inp2_chain_enum); |
| |
| static const struct snd_kcontrol_new rx_dac5_mux = |
| SOC_DAPM_ENUM("RDAC5 MUX Mux", rx_rdac5_enum); |
| |
| static const struct snd_kcontrol_new rx_dac7_mux = |
| SOC_DAPM_ENUM("RDAC7 MUX Mux", rx_rdac7_enum); |
| |
| static const struct snd_kcontrol_new mad_sel_mux = |
| SOC_DAPM_ENUM("MAD_SEL MUX Mux", mad_sel_enum); |
| |
| static const struct snd_kcontrol_new sb_tx1_mux = |
| SOC_DAPM_ENUM("SLIM TX1 MUX Mux", sb_tx1_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx2_mux = |
| SOC_DAPM_ENUM("SLIM TX2 MUX Mux", sb_tx2_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx3_mux = |
| SOC_DAPM_ENUM("SLIM TX3 MUX Mux", sb_tx3_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx4_mux = |
| SOC_DAPM_ENUM("SLIM TX4 MUX Mux", sb_tx4_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx5_mux = |
| SOC_DAPM_ENUM("SLIM TX5 MUX Mux", sb_tx5_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx6_mux = |
| SOC_DAPM_ENUM("SLIM TX6 MUX Mux", sb_tx6_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx7_mux = |
| SOC_DAPM_ENUM("SLIM TX7 MUX Mux", sb_tx7_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx8_mux = |
| SOC_DAPM_ENUM("SLIM TX8 MUX Mux", sb_tx8_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx9_mux = |
| SOC_DAPM_ENUM("SLIM TX9 MUX Mux", sb_tx9_mux_enum); |
| |
| static const struct snd_kcontrol_new sb_tx10_mux = |
| SOC_DAPM_ENUM("SLIM TX10 MUX Mux", sb_tx10_mux_enum); |
| |
| |
| static int wcd9330_put_dec_enum(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_dapm_widget_list *wlist = |
| dapm_kcontrol_get_wlist(kcontrol); |
| struct snd_soc_dapm_widget *w = wlist->widgets[0]; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| unsigned int dec_mux, decimator; |
| char *dec_name = NULL; |
| char *widget_name = NULL; |
| char *temp; |
| u16 tx_mux_ctl_reg; |
| u8 adc_dmic_sel = 0x0; |
| int ret = 0; |
| char *dec; |
| |
| if (ucontrol->value.enumerated.item[0] >= e->items) |
| return -EINVAL; |
| |
| dec_mux = ucontrol->value.enumerated.item[0]; |
| |
| widget_name = kstrndup(w->name, 15, GFP_KERNEL); |
| if (!widget_name) |
| return -ENOMEM; |
| temp = widget_name; |
| |
| dec_name = strsep(&widget_name, " "); |
| widget_name = temp; |
| if (!dec_name) { |
| pr_err("%s: Invalid decimator = %s\n", __func__, w->name); |
| ret = -EINVAL; |
| goto out; |
| } |
| dec = strpbrk(dec_name, "123456789"); |
| if (!dec) { |
| dev_err(w->dapm->dev, "%s: decimator index not found\n", |
| __func__); |
| ret = -EINVAL; |
| goto out; |
| } |
| ret = kstrtouint(dec, 10, &decimator); |
| if (ret < 0) { |
| pr_err("%s: Invalid decimator = %s\n", __func__, dec_name); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| dev_dbg(w->dapm->dev, "%s(): widget = %s decimator = %u dec_mux = %u\n" |
| , __func__, w->name, decimator, dec_mux); |
| |
| |
| switch (decimator) { |
| case 1: |
| case 2: |
| case 3: |
| case 4: |
| case 5: |
| case 6: |
| if (dec_mux == 1) |
| adc_dmic_sel = 0x1; |
| else |
| adc_dmic_sel = 0x0; |
| break; |
| case 7: |
| case 8: |
| case 9: |
| case 10: |
| if ((dec_mux == 1) || (dec_mux == 2)) |
| adc_dmic_sel = 0x1; |
| else |
| adc_dmic_sel = 0x0; |
| break; |
| default: |
| pr_err("%s: Invalid Decimator = %u\n", __func__, decimator); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| tx_mux_ctl_reg = TOMTOM_A_CDC_TX1_MUX_CTL + 8 * (decimator - 1); |
| |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x1, adc_dmic_sel); |
| |
| ret = snd_soc_dapm_put_enum_double(kcontrol, ucontrol); |
| |
| out: |
| kfree(widget_name); |
| return ret; |
| } |
| |
| #define WCD9330_DEC_ENUM(xname, xenum) \ |
| { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ |
| .info = snd_soc_info_enum_double, \ |
| .get = snd_soc_dapm_get_enum_double, \ |
| .put = wcd9330_put_dec_enum, \ |
| .private_value = (unsigned long)&xenum } |
| |
| static const struct snd_kcontrol_new dec1_mux = |
| WCD9330_DEC_ENUM("DEC1 MUX Mux", dec1_mux_enum); |
| |
| static const struct snd_kcontrol_new dec2_mux = |
| WCD9330_DEC_ENUM("DEC2 MUX Mux", dec2_mux_enum); |
| |
| static const struct snd_kcontrol_new dec3_mux = |
| WCD9330_DEC_ENUM("DEC3 MUX Mux", dec3_mux_enum); |
| |
| static const struct snd_kcontrol_new dec4_mux = |
| WCD9330_DEC_ENUM("DEC4 MUX Mux", dec4_mux_enum); |
| |
| static const struct snd_kcontrol_new dec5_mux = |
| WCD9330_DEC_ENUM("DEC5 MUX Mux", dec5_mux_enum); |
| |
| static const struct snd_kcontrol_new dec6_mux = |
| WCD9330_DEC_ENUM("DEC6 MUX Mux", dec6_mux_enum); |
| |
| static const struct snd_kcontrol_new dec7_mux = |
| WCD9330_DEC_ENUM("DEC7 MUX Mux", dec7_mux_enum); |
| |
| static const struct snd_kcontrol_new dec8_mux = |
| WCD9330_DEC_ENUM("DEC8 MUX Mux", dec8_mux_enum); |
| |
| static const struct snd_kcontrol_new dec9_mux = |
| WCD9330_DEC_ENUM("DEC9 MUX Mux", dec9_mux_enum); |
| |
| static const struct snd_kcontrol_new dec10_mux = |
| WCD9330_DEC_ENUM("DEC10 MUX Mux", dec10_mux_enum); |
| |
| static const struct snd_kcontrol_new iir1_inp1_mux = |
| SOC_DAPM_ENUM("IIR1 INP1 Mux", iir1_inp1_mux_enum); |
| |
| static const struct snd_kcontrol_new iir2_inp1_mux = |
| SOC_DAPM_ENUM("IIR2 INP1 Mux", iir2_inp1_mux_enum); |
| |
| static const struct snd_kcontrol_new iir1_inp2_mux = |
| SOC_DAPM_ENUM("IIR1 INP2 Mux", iir1_inp2_mux_enum); |
| |
| static const struct snd_kcontrol_new iir2_inp2_mux = |
| SOC_DAPM_ENUM("IIR2 INP2 Mux", iir2_inp2_mux_enum); |
| |
| static const struct snd_kcontrol_new iir1_inp3_mux = |
| SOC_DAPM_ENUM("IIR1 INP3 Mux", iir1_inp3_mux_enum); |
| |
| static const struct snd_kcontrol_new iir2_inp3_mux = |
| SOC_DAPM_ENUM("IIR2 INP3 Mux", iir2_inp3_mux_enum); |
| |
| static const struct snd_kcontrol_new iir1_inp4_mux = |
| SOC_DAPM_ENUM("IIR1 INP4 Mux", iir1_inp4_mux_enum); |
| |
| static const struct snd_kcontrol_new iir2_inp4_mux = |
| SOC_DAPM_ENUM("IIR2 INP4 Mux", iir2_inp4_mux_enum); |
| |
| static const struct snd_kcontrol_new anc1_mux = |
| SOC_DAPM_ENUM("ANC1 MUX Mux", anc1_mux_enum); |
| |
| static const struct snd_kcontrol_new anc2_mux = |
| SOC_DAPM_ENUM("ANC2 MUX Mux", anc2_mux_enum); |
| |
| static const struct snd_kcontrol_new anc1_fb_mux = |
| SOC_DAPM_ENUM("ANC1 FB MUX Mux", anc1_fb_mux_enum); |
| |
| static const struct snd_kcontrol_new dac1_switch[] = { |
| SOC_DAPM_SINGLE("Switch", TOMTOM_A_RX_EAR_EN, 5, 1, 0) |
| }; |
| static const struct snd_kcontrol_new hphl_switch[] = { |
| SOC_DAPM_SINGLE("Switch", TOMTOM_A_RX_HPH_L_DAC_CTL, 6, 1, 0) |
| }; |
| |
| static const struct snd_kcontrol_new hphl_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_L Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 7, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new hphr_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_R Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 6, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new ear_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_L Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 5, 1, 0), |
| }; |
| static const struct snd_kcontrol_new lineout1_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_L Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 4, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new lineout2_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_R Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 3, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new lineout3_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_L Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 2, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new lineout4_pa_mix[] = { |
| SOC_DAPM_SINGLE("AUX_PGA_R Switch", TOMTOM_A_RX_PA_AUX_IN_CONN, |
| 1, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new lineout3_ground_switch = |
| SOC_DAPM_SINGLE("Switch", TOMTOM_A_RX_LINE_3_DAC_CTL, 6, 1, 0); |
| |
| static const struct snd_kcontrol_new lineout4_ground_switch = |
| SOC_DAPM_SINGLE("Switch", TOMTOM_A_RX_LINE_4_DAC_CTL, 6, 1, 0); |
| |
| static const struct snd_kcontrol_new aif4_mad_switch = |
| SOC_DAPM_SINGLE("Switch", TOMTOM_A_SVASS_CLKRST_CTL, 0, 1, 0); |
| |
| static const struct snd_kcontrol_new aif4_vi_switch = |
| SOC_DAPM_SINGLE("Switch", TOMTOM_A_SPKR1_PROT_EN, 3, 1, 0); |
| |
| /* virtual port entries */ |
| static int slim_tx_mixer_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_dapm_widget_list *wlist = |
| dapm_kcontrol_get_wlist(kcontrol); |
| struct snd_soc_dapm_widget *widget = wlist->widgets[0]; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(widget->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| ucontrol->value.integer.value[0] = tomtom_p->tx_port_value; |
| return 0; |
| } |
| |
| static int slim_tx_mixer_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_dapm_widget_list *wlist = |
| dapm_kcontrol_get_wlist(kcontrol); |
| struct snd_soc_dapm_widget *widget = wlist->widgets[0]; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(widget->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx *core = dev_get_drvdata(codec->dev->parent); |
| struct snd_soc_dapm_update *update = NULL; |
| struct soc_multi_mixer_control *mixer = |
| ((struct soc_multi_mixer_control *)kcontrol->private_value); |
| u32 dai_id = widget->shift; |
| u32 port_id = mixer->shift; |
| u32 enable = ucontrol->value.integer.value[0]; |
| u32 vtable = vport_check_table[dai_id]; |
| |
| |
| pr_debug("%s: wname %s cname %s value %u shift %d item %ld\n", __func__, |
| widget->name, ucontrol->id.name, tomtom_p->tx_port_value, |
| widget->shift, ucontrol->value.integer.value[0]); |
| |
| mutex_lock(&tomtom_p->codec_mutex); |
| |
| if (tomtom_p->intf_type != WCD9XXX_INTERFACE_TYPE_SLIMBUS) { |
| if (dai_id != AIF1_CAP) { |
| dev_err(codec->dev, "%s: invalid AIF for I2C mode\n", |
| __func__); |
| mutex_unlock(&tomtom_p->codec_mutex); |
| return -EINVAL; |
| } |
| } |
| switch (dai_id) { |
| case AIF1_CAP: |
| case AIF2_CAP: |
| case AIF3_CAP: |
| /* only add to the list if value not set |
| */ |
| if (enable && !(tomtom_p->tx_port_value & 1 << port_id)) { |
| |
| if (tomtom_p->intf_type == |
| WCD9XXX_INTERFACE_TYPE_SLIMBUS) |
| vtable = vport_check_table[dai_id]; |
| if (tomtom_p->intf_type == |
| WCD9XXX_INTERFACE_TYPE_I2C) |
| vtable = vport_i2s_check_table[dai_id]; |
| |
| if (wcd9xxx_tx_vport_validation( |
| vtable, |
| port_id, |
| tomtom_p->dai, NUM_CODEC_DAIS)) { |
| dev_dbg(codec->dev, "%s: TX%u is used by other virtual port\n", |
| __func__, port_id + 1); |
| mutex_unlock(&tomtom_p->codec_mutex); |
| return 0; |
| } |
| tomtom_p->tx_port_value |= 1 << port_id; |
| list_add_tail(&core->tx_chs[port_id].list, |
| &tomtom_p->dai[dai_id].wcd9xxx_ch_list |
| ); |
| } else if (!enable && (tomtom_p->tx_port_value & |
| 1 << port_id)) { |
| tomtom_p->tx_port_value &= ~(1 << port_id); |
| list_del_init(&core->tx_chs[port_id].list); |
| } else { |
| if (enable) |
| dev_dbg(codec->dev, "%s: TX%u port is used by\n" |
| "this virtual port\n", |
| __func__, port_id + 1); |
| else |
| dev_dbg(codec->dev, "%s: TX%u port is not used by\n" |
| "this virtual port\n", |
| __func__, port_id + 1); |
| /* avoid update power function */ |
| mutex_unlock(&tomtom_p->codec_mutex); |
| return 0; |
| } |
| break; |
| default: |
| pr_err("Unknown AIF %d\n", dai_id); |
| mutex_unlock(&tomtom_p->codec_mutex); |
| return -EINVAL; |
| } |
| pr_debug("%s: name %s sname %s updated value %u shift %d\n", __func__, |
| widget->name, widget->sname, tomtom_p->tx_port_value, |
| widget->shift); |
| |
| mutex_unlock(&tomtom_p->codec_mutex); |
| snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, update); |
| |
| return 0; |
| } |
| |
| static int slim_rx_mux_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_dapm_widget_list *wlist = |
| dapm_kcontrol_get_wlist(kcontrol); |
| struct snd_soc_dapm_widget *widget = wlist->widgets[0]; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(widget->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| ucontrol->value.enumerated.item[0] = tomtom_p->rx_port_value; |
| return 0; |
| } |
| |
| static const char *const slim_rx_mux_text[] = { |
| "ZERO", "AIF1_PB", "AIF2_PB", "AIF3_PB" |
| }; |
| |
| static int slim_rx_mux_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_dapm_widget_list *wlist = |
| dapm_kcontrol_get_wlist(kcontrol); |
| struct snd_soc_dapm_widget *widget = wlist->widgets[0]; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(widget->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx *core = dev_get_drvdata(codec->dev->parent); |
| struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; |
| struct snd_soc_dapm_update *update = NULL; |
| u32 port_id = widget->shift; |
| |
| pr_debug("%s: wname %s cname %s value %u shift %d item %ld\n", __func__, |
| widget->name, ucontrol->id.name, tomtom_p->rx_port_value, |
| widget->shift, ucontrol->value.integer.value[0]); |
| |
| tomtom_p->rx_port_value = ucontrol->value.enumerated.item[0]; |
| |
| mutex_lock(&tomtom_p->codec_mutex); |
| |
| if (tomtom_p->intf_type != WCD9XXX_INTERFACE_TYPE_SLIMBUS) { |
| if (tomtom_p->rx_port_value > 2) { |
| dev_err(codec->dev, "%s: invalid AIF for I2C mode\n", |
| __func__); |
| goto err; |
| } |
| } |
| /* value need to match the Virtual port and AIF number |
| */ |
| switch (tomtom_p->rx_port_value) { |
| case 0: |
| list_del_init(&core->rx_chs[port_id].list); |
| break; |
| case 1: |
| if (wcd9xxx_rx_vport_validation(port_id + |
| TOMTOM_RX_PORT_START_NUMBER, |
| &tomtom_p->dai[AIF1_PB].wcd9xxx_ch_list)) { |
| dev_dbg(codec->dev, "%s: RX%u is used by current requesting AIF_PB itself\n", |
| __func__, port_id + 1); |
| goto rtn; |
| } |
| list_add_tail(&core->rx_chs[port_id].list, |
| &tomtom_p->dai[AIF1_PB].wcd9xxx_ch_list); |
| break; |
| case 2: |
| if (wcd9xxx_rx_vport_validation(port_id + |
| TOMTOM_RX_PORT_START_NUMBER, |
| &tomtom_p->dai[AIF2_PB].wcd9xxx_ch_list)) { |
| dev_dbg(codec->dev, "%s: RX%u is used by current requesting AIF_PB itself\n", |
| __func__, port_id + 1); |
| goto rtn; |
| } |
| list_add_tail(&core->rx_chs[port_id].list, |
| &tomtom_p->dai[AIF2_PB].wcd9xxx_ch_list); |
| break; |
| case 3: |
| if (wcd9xxx_rx_vport_validation(port_id + |
| TOMTOM_RX_PORT_START_NUMBER, |
| &tomtom_p->dai[AIF3_PB].wcd9xxx_ch_list)) { |
| dev_dbg(codec->dev, "%s: RX%u is used by current requesting AIF_PB itself\n", |
| __func__, port_id + 1); |
| goto rtn; |
| } |
| list_add_tail(&core->rx_chs[port_id].list, |
| &tomtom_p->dai[AIF3_PB].wcd9xxx_ch_list); |
| break; |
| default: |
| pr_err("Unknown AIF %d\n", tomtom_p->rx_port_value); |
| goto err; |
| } |
| rtn: |
| mutex_unlock(&tomtom_p->codec_mutex); |
| snd_soc_dapm_mux_update_power(widget->dapm, kcontrol, |
| tomtom_p->rx_port_value, e, update); |
| |
| return 0; |
| err: |
| mutex_unlock(&tomtom_p->codec_mutex); |
| return -EINVAL; |
| } |
| |
| static const struct soc_enum slim_rx_mux_enum = |
| SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(slim_rx_mux_text), slim_rx_mux_text); |
| |
| static const struct snd_kcontrol_new slim_rx_mux[TOMTOM_RX_MAX] = { |
| SOC_DAPM_ENUM_EXT("SLIM RX1 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX2 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX3 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX4 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX5 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX6 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX7 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| SOC_DAPM_ENUM_EXT("SLIM RX8 Mux", slim_rx_mux_enum, |
| slim_rx_mux_get, slim_rx_mux_put), |
| }; |
| |
| static const struct snd_kcontrol_new aif1_cap_mixer[] = { |
| SOC_SINGLE_EXT("SLIM TX1", SND_SOC_NOPM, TOMTOM_TX1, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX2", SND_SOC_NOPM, TOMTOM_TX2, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX3", SND_SOC_NOPM, TOMTOM_TX3, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX4", SND_SOC_NOPM, TOMTOM_TX4, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX5", SND_SOC_NOPM, TOMTOM_TX5, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX6", SND_SOC_NOPM, TOMTOM_TX6, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX7", SND_SOC_NOPM, TOMTOM_TX7, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX8", SND_SOC_NOPM, TOMTOM_TX8, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX9", SND_SOC_NOPM, TOMTOM_TX9, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX10", SND_SOC_NOPM, TOMTOM_TX10, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| }; |
| |
| static const struct snd_kcontrol_new aif2_cap_mixer[] = { |
| SOC_SINGLE_EXT("SLIM TX1", SND_SOC_NOPM, TOMTOM_TX1, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX2", SND_SOC_NOPM, TOMTOM_TX2, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX3", SND_SOC_NOPM, TOMTOM_TX3, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX4", SND_SOC_NOPM, TOMTOM_TX4, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX5", SND_SOC_NOPM, TOMTOM_TX5, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX6", SND_SOC_NOPM, TOMTOM_TX6, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX7", SND_SOC_NOPM, TOMTOM_TX7, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX8", SND_SOC_NOPM, TOMTOM_TX8, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX9", SND_SOC_NOPM, TOMTOM_TX9, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX10", SND_SOC_NOPM, TOMTOM_TX10, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| }; |
| |
| static const struct snd_kcontrol_new aif3_cap_mixer[] = { |
| SOC_SINGLE_EXT("SLIM TX1", SND_SOC_NOPM, TOMTOM_TX1, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX2", SND_SOC_NOPM, TOMTOM_TX2, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX3", SND_SOC_NOPM, TOMTOM_TX3, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX4", SND_SOC_NOPM, TOMTOM_TX4, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX5", SND_SOC_NOPM, TOMTOM_TX5, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX6", SND_SOC_NOPM, TOMTOM_TX6, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX7", SND_SOC_NOPM, TOMTOM_TX7, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX8", SND_SOC_NOPM, TOMTOM_TX8, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX9", SND_SOC_NOPM, TOMTOM_TX9, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| SOC_SINGLE_EXT("SLIM TX10", SND_SOC_NOPM, TOMTOM_TX10, 1, 0, |
| slim_tx_mixer_get, slim_tx_mixer_put), |
| }; |
| |
| static void tomtom_codec_enable_adc_block(struct snd_soc_codec *codec, |
| int enable) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s %d\n", __func__, enable); |
| |
| if (enable) { |
| tomtom->adc_count++; |
| snd_soc_update_bits(codec, WCD9XXX_A_CDC_CLK_OTHR_CTL, |
| 0x2, 0x2); |
| } else { |
| tomtom->adc_count--; |
| if (!tomtom->adc_count) |
| snd_soc_update_bits(codec, WCD9XXX_A_CDC_CLK_OTHR_CTL, |
| 0x2, 0x0); |
| } |
| } |
| |
| static int tomtom_codec_enable_adc(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| u16 adc_reg; |
| u16 tx_fe_clkdiv_reg; |
| u8 tx_fe_clkdiv_mask; |
| u8 init_bit_shift; |
| u8 bit_pos; |
| |
| pr_debug("%s %d\n", __func__, event); |
| |
| switch (w->reg) { |
| case TOMTOM_A_TX_1_GAIN: |
| adc_reg = TOMTOM_A_TX_1_2_TEST_CTL; |
| tx_fe_clkdiv_reg = TOMTOM_A_TX_1_2_TXFE_CLKDIV; |
| tx_fe_clkdiv_mask = 0x0F; |
| init_bit_shift = 7; |
| bit_pos = ADC1_TXFE; |
| break; |
| case TOMTOM_A_TX_2_GAIN: |
| adc_reg = TOMTOM_A_TX_1_2_TEST_CTL; |
| tx_fe_clkdiv_reg = TOMTOM_A_TX_1_2_TXFE_CLKDIV; |
| tx_fe_clkdiv_mask = 0xF0; |
| init_bit_shift = 6; |
| bit_pos = ADC2_TXFE; |
| break; |
| case TOMTOM_A_TX_3_GAIN: |
| adc_reg = TOMTOM_A_TX_3_4_TEST_CTL; |
| init_bit_shift = 7; |
| tx_fe_clkdiv_reg = TOMTOM_A_TX_3_4_TXFE_CKDIV; |
| tx_fe_clkdiv_mask = 0x0F; |
| bit_pos = ADC3_TXFE; |
| break; |
| case TOMTOM_A_TX_4_GAIN: |
| adc_reg = TOMTOM_A_TX_3_4_TEST_CTL; |
| init_bit_shift = 6; |
| tx_fe_clkdiv_reg = TOMTOM_A_TX_3_4_TXFE_CKDIV; |
| tx_fe_clkdiv_mask = 0xF0; |
| bit_pos = ADC4_TXFE; |
| break; |
| case TOMTOM_A_TX_5_GAIN: |
| adc_reg = TOMTOM_A_TX_5_6_TEST_CTL; |
| init_bit_shift = 7; |
| tx_fe_clkdiv_reg = TOMTOM_A_TX_5_6_TXFE_CKDIV; |
| tx_fe_clkdiv_mask = 0x0F; |
| bit_pos = ADC5_TXFE; |
| break; |
| case TOMTOM_A_TX_6_GAIN: |
| adc_reg = TOMTOM_A_TX_5_6_TEST_CTL; |
| init_bit_shift = 6; |
| tx_fe_clkdiv_reg = TOMTOM_A_TX_5_6_TXFE_CKDIV; |
| tx_fe_clkdiv_mask = 0xF0; |
| bit_pos = ADC6_TXFE; |
| break; |
| default: |
| pr_err("%s: Error, invalid adc register\n", __func__); |
| return -EINVAL; |
| } |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| snd_soc_update_bits(codec, tx_fe_clkdiv_reg, tx_fe_clkdiv_mask, |
| 0x0); |
| set_bit(bit_pos, &priv->status_mask); |
| tomtom_codec_enable_adc_block(codec, 1); |
| snd_soc_update_bits(codec, adc_reg, 1 << init_bit_shift, |
| 1 << init_bit_shift); |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| snd_soc_update_bits(codec, adc_reg, 1 << init_bit_shift, 0x00); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| tomtom_codec_enable_adc_block(codec, 0); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_ext_clk_en(struct snd_soc_codec *codec, |
| int enable, bool dapm) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| if (!tomtom->codec_ext_clk_en_cb) { |
| dev_err(codec->dev, |
| "%s: Invalid ext_clk_callback\n", |
| __func__); |
| return -EINVAL; |
| } |
| |
| return tomtom->codec_ext_clk_en_cb(codec, enable, dapm); |
| } |
| |
| static int __tomtom_mclk_enable(struct tomtom_priv *tomtom, int mclk_enable) |
| { |
| int ret = 0; |
| |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| if (mclk_enable) { |
| tomtom->ext_clk_users++; |
| if (tomtom->ext_clk_users > 1) |
| goto bg_clk_unlock; |
| ret = clk_prepare_enable(tomtom->wcd_ext_clk); |
| if (ret) { |
| pr_err("%s: ext clk enable failed\n", |
| __func__); |
| tomtom->ext_clk_users--; |
| goto bg_clk_unlock; |
| } |
| wcd9xxx_resmgr_get_bandgap(&tomtom->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| wcd9xxx_resmgr_get_clk_block(&tomtom->resmgr, WCD9XXX_CLK_MCLK); |
| } else { |
| tomtom->ext_clk_users--; |
| if (tomtom->ext_clk_users == 0) { |
| /* Put clock and BG */ |
| wcd9xxx_resmgr_put_clk_block(&tomtom->resmgr, |
| WCD9XXX_CLK_MCLK); |
| wcd9xxx_resmgr_put_bandgap(&tomtom->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| clk_disable_unprepare(tomtom->wcd_ext_clk); |
| } |
| } |
| bg_clk_unlock: |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| |
| return ret; |
| } |
| |
| int tomtom_codec_mclk_enable(struct snd_soc_codec *codec, |
| int enable, bool dapm) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| if (tomtom->wcd_ext_clk) { |
| dev_dbg(codec->dev, "%s: mclk_enable = %u, dapm = %d\n", |
| __func__, enable, dapm); |
| return __tomtom_mclk_enable(tomtom, enable); |
| } else if (tomtom->codec_ext_clk_en_cb) |
| return tomtom_codec_ext_clk_en(codec, enable, dapm); |
| else { |
| dev_err(codec->dev, |
| "%s: Cannot turn on MCLK\n", |
| __func__); |
| return -EINVAL; |
| } |
| } |
| EXPORT_SYMBOL(tomtom_codec_mclk_enable); |
| |
| static int tomtom_codec_get_ext_clk_users(struct tomtom_priv *tomtom) |
| { |
| if (tomtom->wcd_ext_clk) |
| return tomtom->ext_clk_users; |
| else if (tomtom->codec_get_ext_clk_cnt) |
| return tomtom->codec_get_ext_clk_cnt(); |
| else |
| return 0; |
| } |
| |
| /* tomtom_codec_internal_rco_ctrl( ) |
| * Make sure that BG_CLK_LOCK is not acquired. Exit if acquired to avoid |
| * potential deadlock as ext_clk_en_cb() also tries to acquire the same |
| * lock to enable MCLK for RCO calibration |
| */ |
| static int tomtom_codec_internal_rco_ctrl(struct snd_soc_codec *codec, |
| bool enable) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| int ret = 0; |
| |
| if (enable) { |
| if (wcd9xxx_resmgr_get_clk_type(&tomtom->resmgr) == |
| WCD9XXX_CLK_RCO) { |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| wcd9xxx_resmgr_get_clk_block(&tomtom->resmgr, |
| WCD9XXX_CLK_RCO); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| } else { |
| tomtom_codec_mclk_enable(codec, true, false); |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| tomtom->resmgr.ext_clk_users = |
| tomtom_codec_get_ext_clk_users(tomtom); |
| wcd9xxx_resmgr_get_clk_block(&tomtom->resmgr, |
| WCD9XXX_CLK_RCO); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| tomtom_codec_mclk_enable(codec, false, false); |
| } |
| |
| } else { |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| wcd9xxx_resmgr_put_clk_block(&tomtom->resmgr, |
| WCD9XXX_CLK_RCO); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| } |
| |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_aux_pga(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s: %d\n", __func__, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| wcd9xxx_resmgr_get_bandgap(&tomtom->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| /* AUX PGA requires RCO or MCLK */ |
| tomtom_codec_internal_rco_ctrl(codec, true); |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| wcd9xxx_resmgr_enable_rx_bias(&tomtom->resmgr, 1); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| break; |
| |
| case SND_SOC_DAPM_POST_PMD: |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| wcd9xxx_resmgr_enable_rx_bias(&tomtom->resmgr, 0); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| tomtom_codec_internal_rco_ctrl(codec, false); |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| wcd9xxx_resmgr_put_bandgap(&tomtom->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_enable_lineout(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| u16 lineout_gain_reg; |
| |
| pr_debug("%s %d %s\n", __func__, event, w->name); |
| |
| switch (w->shift) { |
| case 0: |
| lineout_gain_reg = TOMTOM_A_RX_LINE_1_GAIN; |
| break; |
| case 1: |
| lineout_gain_reg = TOMTOM_A_RX_LINE_2_GAIN; |
| break; |
| case 2: |
| lineout_gain_reg = TOMTOM_A_RX_LINE_3_GAIN; |
| break; |
| case 3: |
| lineout_gain_reg = TOMTOM_A_RX_LINE_4_GAIN; |
| break; |
| default: |
| pr_err("%s: Error, incorrect lineout register value\n", |
| __func__); |
| return -EINVAL; |
| } |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| snd_soc_update_bits(codec, lineout_gain_reg, 0x40, 0x40); |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| wcd9xxx_clsh_fsm(codec, &tomtom->clsh_d, |
| WCD9XXX_CLSH_STATE_LO, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| pr_debug("%s: sleeping 5 ms after %s PA turn on\n", |
| __func__, w->name); |
| /* Wait for CnP time after PA enable */ |
| usleep_range(5000, 5100); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| snd_soc_update_bits(codec, lineout_gain_reg, 0x40, 0x00); |
| pr_debug("%s: sleeping 5 ms after %s PA turn off\n", |
| __func__, w->name); |
| /* Wait for CnP time after PA disable */ |
| usleep_range(5000, 5100); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_enable_spk_pa(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| u16 spk_drv_reg; |
| |
| pr_debug("%s: %d %s\n", __func__, event, w->name); |
| if (strnstr(w->name, "SPK2 PA", sizeof("SPK2 PA"))) |
| spk_drv_reg = TOMTOM_A_SPKR_DRV2_EN; |
| else |
| spk_drv_reg = TOMTOM_A_SPKR_DRV1_EN; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| tomtom->spkr_pa_widget_on = true; |
| snd_soc_update_bits(codec, spk_drv_reg, 0x80, 0x80); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| tomtom->spkr_pa_widget_on = false; |
| snd_soc_update_bits(codec, spk_drv_reg, 0x80, 0x00); |
| break; |
| } |
| return 0; |
| } |
| |
| static u8 tomtom_get_dmic_clk_val(struct snd_soc_codec *codec, |
| u32 mclk_rate, u32 dmic_clk_rate) |
| { |
| u32 div_factor; |
| u8 dmic_ctl_val; |
| |
| dev_dbg(codec->dev, |
| "%s: mclk_rate = %d, dmic_sample_rate = %d\n", |
| __func__, mclk_rate, dmic_clk_rate); |
| |
| /* Default value to return in case of error */ |
| if (mclk_rate == TOMTOM_MCLK_CLK_9P6MHZ) |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_2; |
| else |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_3; |
| |
| if (dmic_clk_rate == 0) { |
| dev_err(codec->dev, |
| "%s: dmic_sample_rate cannot be 0\n", |
| __func__); |
| goto done; |
| } |
| |
| div_factor = mclk_rate / dmic_clk_rate; |
| switch (div_factor) { |
| case 2: |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_2; |
| break; |
| case 3: |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_3; |
| break; |
| case 4: |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_4; |
| break; |
| case 6: |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_6; |
| break; |
| case 16: |
| dmic_ctl_val = WCD9330_DMIC_CLK_DIV_16; |
| break; |
| default: |
| dev_err(codec->dev, |
| "%s: Invalid div_factor %u, clk_rate(%u), dmic_rate(%u)\n", |
| __func__, div_factor, mclk_rate, dmic_clk_rate); |
| break; |
| } |
| |
| done: |
| return dmic_ctl_val; |
| } |
| |
| static int tomtom_codec_enable_dmic(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_pdata *pdata = tomtom->resmgr.pdata; |
| u8 dmic_clk_en; |
| u16 dmic_clk_reg; |
| s32 *dmic_clk_cnt; |
| u8 dmic_rate_val, dmic_rate_shift; |
| unsigned int dmic; |
| int ret; |
| char *wname; |
| |
| wname = strpbrk(w->name, "123456"); |
| if (!wname) { |
| dev_err(codec->dev, "%s: widget not found\n", __func__); |
| return -EINVAL; |
| } |
| |
| ret = kstrtouint(wname, 10, &dmic); |
| if (ret < 0) { |
| pr_err("%s: Invalid DMIC line on the codec\n", __func__); |
| return -EINVAL; |
| } |
| |
| switch (dmic) { |
| case 1: |
| case 2: |
| dmic_clk_en = 0x01; |
| dmic_clk_cnt = &(tomtom->dmic_1_2_clk_cnt); |
| dmic_clk_reg = TOMTOM_A_DMIC_B1_CTL; |
| dmic_rate_shift = 5; |
| pr_debug("%s() event %d DMIC%d dmic_1_2_clk_cnt %d\n", |
| __func__, event, dmic, *dmic_clk_cnt); |
| |
| break; |
| |
| case 3: |
| case 4: |
| dmic_clk_en = 0x02; |
| dmic_clk_cnt = &(tomtom->dmic_3_4_clk_cnt); |
| dmic_clk_reg = TOMTOM_A_DMIC_B2_CTL; |
| dmic_rate_shift = 1; |
| pr_debug("%s() event %d DMIC%d dmic_3_4_clk_cnt %d\n", |
| __func__, event, dmic, *dmic_clk_cnt); |
| break; |
| |
| case 5: |
| case 6: |
| dmic_clk_en = 0x04; |
| dmic_clk_cnt = &(tomtom->dmic_5_6_clk_cnt); |
| dmic_clk_reg = TOMTOM_A_DMIC_B2_CTL; |
| dmic_rate_shift = 4; |
| pr_debug("%s() event %d DMIC%d dmic_5_6_clk_cnt %d\n", |
| __func__, event, dmic, *dmic_clk_cnt); |
| |
| break; |
| |
| default: |
| pr_err("%s: Invalid DMIC Selection\n", __func__); |
| return -EINVAL; |
| } |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| |
| dmic_rate_val = |
| tomtom_get_dmic_clk_val(codec, |
| pdata->mclk_rate, |
| pdata->dmic_sample_rate); |
| |
| (*dmic_clk_cnt)++; |
| if (*dmic_clk_cnt == 1) { |
| snd_soc_update_bits(codec, dmic_clk_reg, |
| 0x07 << dmic_rate_shift, |
| dmic_rate_val << dmic_rate_shift); |
| snd_soc_update_bits(codec, TOMTOM_A_DMIC_B1_CTL, |
| dmic_clk_en, dmic_clk_en); |
| } |
| |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| |
| dmic_rate_val = |
| tomtom_get_dmic_clk_val(codec, |
| pdata->mclk_rate, |
| pdata->mad_dmic_sample_rate); |
| (*dmic_clk_cnt)--; |
| if (*dmic_clk_cnt == 0) { |
| snd_soc_update_bits(codec, TOMTOM_A_DMIC_B1_CTL, |
| dmic_clk_en, 0); |
| snd_soc_update_bits(codec, dmic_clk_reg, |
| 0x07 << dmic_rate_shift, |
| dmic_rate_val << dmic_rate_shift); |
| } |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_config_mad(struct snd_soc_codec *codec) |
| { |
| int ret = 0; |
| const struct firmware *fw; |
| struct firmware_cal *hwdep_cal = NULL; |
| struct mad_audio_cal *mad_cal; |
| const void *data; |
| const char *filename = TOMTOM_MAD_AUDIO_FIRMWARE_PATH; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| size_t cal_size; |
| int idx; |
| |
| pr_debug("%s: enter\n", __func__); |
| |
| if (!tomtom->fw_data) { |
| dev_err(codec->dev, "%s: invalid cal data\n", |
| __func__); |
| return -ENODEV; |
| } |
| |
| hwdep_cal = wcdcal_get_fw_cal(tomtom->fw_data, WCD9XXX_MAD_CAL); |
| if (hwdep_cal) { |
| data = hwdep_cal->data; |
| cal_size = hwdep_cal->size; |
| dev_dbg(codec->dev, "%s: using hwdep calibration\n", |
| __func__); |
| } else { |
| ret = request_firmware(&fw, filename, codec->dev); |
| if (ret != 0) { |
| pr_err("Failed to acquire MAD firwmare data %s: %d\n", |
| filename, ret); |
| return -ENODEV; |
| } |
| if (!fw) { |
| dev_err(codec->dev, "failed to get mad fw"); |
| return -ENODEV; |
| } |
| data = fw->data; |
| cal_size = fw->size; |
| dev_dbg(codec->dev, "%s: using request_firmware calibration\n", |
| __func__); |
| } |
| if (cal_size < sizeof(struct mad_audio_cal)) { |
| pr_err("%s: incorrect hwdep cal size %zu\n", |
| __func__, cal_size); |
| ret = -ENOMEM; |
| goto err; |
| } |
| |
| mad_cal = (struct mad_audio_cal *)(data); |
| if (!mad_cal) { |
| dev_err(codec->dev, "%s: Invalid calibration data\n", |
| __func__); |
| ret = -EINVAL; |
| goto err; |
| } |
| |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_MAIN_CTL_2, |
| mad_cal->microphone_info.cycle_time); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_MAIN_CTL_1, 0xFF << 3, |
| ((uint16_t)mad_cal->microphone_info.settle_time) |
| << 3); |
| |
| /* Audio */ |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_AUDIO_CTL_8, |
| mad_cal->audio_info.rms_omit_samples); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_AUDIO_CTL_1, |
| 0x07 << 4, mad_cal->audio_info.rms_comp_time << 4); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_AUDIO_CTL_2, 0x03 << 2, |
| mad_cal->audio_info.detection_mechanism << 2); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_AUDIO_CTL_7, |
| mad_cal->audio_info.rms_diff_threshold & 0x3F); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_AUDIO_CTL_5, |
| mad_cal->audio_info.rms_threshold_lsb); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_AUDIO_CTL_6, |
| mad_cal->audio_info.rms_threshold_msb); |
| |
| for (idx = 0; idx < ARRAY_SIZE(mad_cal->audio_info.iir_coefficients); |
| idx++) { |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_AUDIO_IIR_CTL_PTR, |
| 0x3F, idx); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_AUDIO_IIR_CTL_VAL, |
| mad_cal->audio_info.iir_coefficients[idx]); |
| dev_dbg(codec->dev, "%s:MAD Audio IIR Coef[%d] = 0X%x", |
| __func__, idx, |
| mad_cal->audio_info.iir_coefficients[idx]); |
| } |
| |
| /* Beacon */ |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_8, |
| mad_cal->beacon_info.rms_omit_samples); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_1, |
| 0x07 << 4, mad_cal->beacon_info.rms_comp_time); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_2, 0x03 << 2, |
| mad_cal->beacon_info.detection_mechanism << 2); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_7, |
| mad_cal->beacon_info.rms_diff_threshold & 0x1F); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_5, |
| mad_cal->beacon_info.rms_threshold_lsb); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_6, |
| mad_cal->beacon_info.rms_threshold_msb); |
| |
| /* Ultrasound */ |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_BEACON_CTL_1, |
| 0x07 << 4, mad_cal->beacon_info.rms_comp_time); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_MAD_ULTR_CTL_2, 0x03 << 2, |
| mad_cal->ultrasound_info.detection_mechanism); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_ULTR_CTL_7, |
| mad_cal->ultrasound_info.rms_diff_threshold & 0x1F); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_ULTR_CTL_5, |
| mad_cal->ultrasound_info.rms_threshold_lsb); |
| snd_soc_write(codec, TOMTOM_A_CDC_MAD_ULTR_CTL_6, |
| mad_cal->ultrasound_info.rms_threshold_msb); |
| |
| /* Set MAD intr time to 20 msec */ |
| snd_soc_update_bits(codec, 0x4E, 0x01F, 0x13); |
| |
| pr_debug("%s: leave ret %d\n", __func__, ret); |
| err: |
| if (!hwdep_cal) |
| release_firmware(fw); |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_mad(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| int ret = 0; |
| u8 mad_micb, mad_cfilt; |
| u16 mad_cfilt_reg; |
| |
| mad_micb = snd_soc_read(codec, TOMTOM_A_MAD_ANA_CTRL) & 0x07; |
| switch (mad_micb) { |
| case 1: |
| mad_cfilt = tomtom->resmgr.pdata->micbias.bias1_cfilt_sel; |
| break; |
| case 2: |
| mad_cfilt = tomtom->resmgr.pdata->micbias.bias2_cfilt_sel; |
| break; |
| case 3: |
| mad_cfilt = tomtom->resmgr.pdata->micbias.bias3_cfilt_sel; |
| break; |
| case 4: |
| mad_cfilt = tomtom->resmgr.pdata->micbias.bias4_cfilt_sel; |
| break; |
| default: |
| dev_err(codec->dev, |
| "%s: Invalid micbias selection 0x%x\n", |
| __func__, mad_micb); |
| return -EINVAL; |
| } |
| |
| switch (mad_cfilt) { |
| case WCD9XXX_CFILT1_SEL: |
| mad_cfilt_reg = TOMTOM_A_MICB_CFILT_1_VAL; |
| break; |
| case WCD9XXX_CFILT2_SEL: |
| mad_cfilt_reg = TOMTOM_A_MICB_CFILT_2_VAL; |
| break; |
| case WCD9XXX_CFILT3_SEL: |
| mad_cfilt_reg = TOMTOM_A_MICB_CFILT_3_VAL; |
| break; |
| default: |
| dev_err(codec->dev, |
| "%s: invalid cfilt 0x%x for micb 0x%x\n", |
| __func__, mad_cfilt, mad_micb); |
| return -EINVAL; |
| } |
| |
| dev_dbg(codec->dev, |
| "%s event = %d, mad_cfilt_reg = 0x%x\n", |
| __func__, event, mad_cfilt_reg); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| /* Undo reset for MAD */ |
| snd_soc_update_bits(codec, TOMTOM_A_SVASS_CLKRST_CTL, |
| 0x02, 0x00); |
| |
| ret = tomtom_codec_config_mad(codec); |
| if (ret) { |
| pr_err("%s: Failed to config MAD\n", __func__); |
| break; |
| } |
| |
| /* setup MAD micbias to VDDIO */ |
| snd_soc_update_bits(codec, mad_cfilt_reg, |
| 0x02, 0x02); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| /* Reset the MAD block */ |
| snd_soc_update_bits(codec, TOMTOM_A_SVASS_CLKRST_CTL, |
| 0x02, 0x02); |
| |
| /* Undo setup of MAD micbias to VDDIO */ |
| snd_soc_update_bits(codec, mad_cfilt_reg, |
| 0x02, 0x00); |
| } |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_micbias(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| u16 micb_int_reg = 0, micb_ctl_reg = 0; |
| u8 cfilt_sel_val = 0; |
| char *internal1_text = "Internal1"; |
| char *internal2_text = "Internal2"; |
| char *internal3_text = "Internal3"; |
| enum wcd9xxx_notify_event e_post_off, e_pre_on, e_post_on; |
| |
| pr_debug("%s: w->name %s event %d\n", __func__, w->name, event); |
| if (strnstr(w->name, "MIC BIAS1", sizeof("MIC BIAS1"))) { |
| micb_ctl_reg = TOMTOM_A_MICB_1_CTL; |
| micb_int_reg = TOMTOM_A_MICB_1_INT_RBIAS; |
| cfilt_sel_val = tomtom->resmgr.pdata->micbias.bias1_cfilt_sel; |
| e_pre_on = WCD9XXX_EVENT_PRE_MICBIAS_1_ON; |
| e_post_on = WCD9XXX_EVENT_POST_MICBIAS_1_ON; |
| e_post_off = WCD9XXX_EVENT_POST_MICBIAS_1_OFF; |
| } else if (strnstr(w->name, "MIC BIAS2", sizeof("MIC BIAS2"))) { |
| micb_ctl_reg = TOMTOM_A_MICB_2_CTL; |
| micb_int_reg = TOMTOM_A_MICB_2_INT_RBIAS; |
| cfilt_sel_val = tomtom->resmgr.pdata->micbias.bias2_cfilt_sel; |
| e_pre_on = WCD9XXX_EVENT_PRE_MICBIAS_2_ON; |
| e_post_on = WCD9XXX_EVENT_POST_MICBIAS_2_ON; |
| e_post_off = WCD9XXX_EVENT_POST_MICBIAS_2_OFF; |
| } else if (strnstr(w->name, "MIC BIAS3", sizeof("MIC BIAS3"))) { |
| micb_ctl_reg = TOMTOM_A_MICB_3_CTL; |
| micb_int_reg = TOMTOM_A_MICB_3_INT_RBIAS; |
| cfilt_sel_val = tomtom->resmgr.pdata->micbias.bias3_cfilt_sel; |
| e_pre_on = WCD9XXX_EVENT_PRE_MICBIAS_3_ON; |
| e_post_on = WCD9XXX_EVENT_POST_MICBIAS_3_ON; |
| e_post_off = WCD9XXX_EVENT_POST_MICBIAS_3_OFF; |
| } else if (strnstr(w->name, "MIC BIAS4", sizeof("MIC BIAS4"))) { |
| micb_ctl_reg = TOMTOM_A_MICB_4_CTL; |
| micb_int_reg = tomtom->resmgr.reg_addr->micb_4_int_rbias; |
| cfilt_sel_val = tomtom->resmgr.pdata->micbias.bias4_cfilt_sel; |
| e_pre_on = WCD9XXX_EVENT_PRE_MICBIAS_4_ON; |
| e_post_on = WCD9XXX_EVENT_POST_MICBIAS_4_ON; |
| e_post_off = WCD9XXX_EVENT_POST_MICBIAS_4_OFF; |
| } else { |
| pr_err("%s: Error, invalid micbias %s\n", __func__, w->name); |
| return -EINVAL; |
| } |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| /* Let MBHC module know so micbias switch to be off */ |
| wcd9xxx_resmgr_notifier_call(&tomtom->resmgr, e_pre_on); |
| |
| /* Get cfilt */ |
| wcd9xxx_resmgr_cfilt_get(&tomtom->resmgr, cfilt_sel_val); |
| |
| if (strnstr(w->name, internal1_text, 30)) |
| snd_soc_update_bits(codec, micb_int_reg, 0xE0, 0xE0); |
| else if (strnstr(w->name, internal2_text, 30)) |
| snd_soc_update_bits(codec, micb_int_reg, 0x1C, 0x1C); |
| else if (strnstr(w->name, internal3_text, 30)) |
| snd_soc_update_bits(codec, micb_int_reg, 0x3, 0x3); |
| else |
| /* |
| * If not internal, make sure to write the |
| * register to default value |
| */ |
| snd_soc_write(codec, micb_int_reg, 0x24); |
| if (tomtom->mbhc_started && micb_ctl_reg == |
| TOMTOM_A_MICB_2_CTL) { |
| if (++tomtom->micb_2_users == 1) { |
| if (tomtom->resmgr.pdata-> |
| micbias.bias2_is_headset_only) |
| wcd9xxx_resmgr_add_cond_update_bits( |
| &tomtom->resmgr, |
| WCD9XXX_COND_HPH_MIC, |
| micb_ctl_reg, w->shift, |
| false); |
| else |
| snd_soc_update_bits(codec, micb_ctl_reg, |
| 1 << w->shift, |
| 1 << w->shift); |
| } |
| pr_debug("%s: micb_2_users %d\n", __func__, |
| tomtom->micb_2_users); |
| } else { |
| snd_soc_update_bits(codec, micb_ctl_reg, 1 << w->shift, |
| 1 << w->shift); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| usleep_range(5000, 5100); |
| /* Let MBHC module know so micbias is on */ |
| wcd9xxx_resmgr_notifier_call(&tomtom->resmgr, e_post_on); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| if (tomtom->mbhc_started && micb_ctl_reg == |
| TOMTOM_A_MICB_2_CTL) { |
| if (--tomtom->micb_2_users == 0) { |
| if (tomtom->resmgr.pdata-> |
| micbias.bias2_is_headset_only) |
| wcd9xxx_resmgr_rm_cond_update_bits( |
| &tomtom->resmgr, |
| WCD9XXX_COND_HPH_MIC, |
| micb_ctl_reg, 7, false); |
| else |
| snd_soc_update_bits(codec, micb_ctl_reg, |
| 1 << w->shift, 0); |
| } |
| pr_debug("%s: micb_2_users %d\n", __func__, |
| tomtom->micb_2_users); |
| WARN(tomtom->micb_2_users < 0, |
| "Unexpected micbias users %d\n", |
| tomtom->micb_2_users); |
| } else { |
| snd_soc_update_bits(codec, micb_ctl_reg, 1 << w->shift, |
| 0); |
| } |
| |
| /* Let MBHC module know so micbias switch to be off */ |
| wcd9xxx_resmgr_notifier_call(&tomtom->resmgr, e_post_off); |
| |
| if (strnstr(w->name, internal1_text, 30)) |
| snd_soc_update_bits(codec, micb_int_reg, 0x80, 0x00); |
| else if (strnstr(w->name, internal2_text, 30)) |
| snd_soc_update_bits(codec, micb_int_reg, 0x10, 0x00); |
| else if (strnstr(w->name, internal3_text, 30)) |
| snd_soc_update_bits(codec, micb_int_reg, 0x2, 0x0); |
| |
| /* Put cfilt */ |
| wcd9xxx_resmgr_cfilt_put(&tomtom->resmgr, cfilt_sel_val); |
| break; |
| } |
| |
| return 0; |
| } |
| |
| /* called under codec_resource_lock acquisition */ |
| static int tomtom_enable_mbhc_micbias(struct snd_soc_codec *codec, bool enable, |
| enum wcd9xxx_micbias_num micb_num) |
| { |
| int rc; |
| |
| if (micb_num != MBHC_MICBIAS2) { |
| dev_err(codec->dev, "%s: Unsupported micbias, micb_num=%d\n", |
| __func__, micb_num); |
| return -EINVAL; |
| } |
| |
| if (enable) |
| rc = snd_soc_dapm_force_enable_pin( |
| snd_soc_codec_get_dapm(codec), |
| DAPM_MICBIAS2_EXTERNAL_STANDALONE); |
| else |
| rc = snd_soc_dapm_disable_pin(snd_soc_codec_get_dapm(codec), |
| DAPM_MICBIAS2_EXTERNAL_STANDALONE); |
| if (!rc) |
| snd_soc_dapm_sync(snd_soc_codec_get_dapm(codec)); |
| pr_debug("%s: leave ret %d\n", __func__, rc); |
| return rc; |
| } |
| |
| static void txfe_clkdiv_update(struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| if (test_bit(ADC1_TXFE, &priv->status_mask)) { |
| snd_soc_update_bits(codec, TOMTOM_A_TX_1_2_TXFE_CLKDIV, |
| 0x0F, 0x05); |
| clear_bit(ADC1_TXFE, &priv->status_mask); |
| } |
| if (test_bit(ADC2_TXFE, &priv->status_mask)) { |
| snd_soc_update_bits(codec, TOMTOM_A_TX_1_2_TXFE_CLKDIV, |
| 0xF0, 0x50); |
| clear_bit(ADC2_TXFE, &priv->status_mask); |
| } |
| if (test_bit(ADC3_TXFE, &priv->status_mask)) { |
| snd_soc_update_bits(codec, TOMTOM_A_TX_3_4_TXFE_CKDIV, |
| 0x0F, 0x05); |
| clear_bit(ADC3_TXFE, &priv->status_mask); |
| } |
| if (test_bit(ADC4_TXFE, &priv->status_mask)) { |
| snd_soc_update_bits(codec, TOMTOM_A_TX_3_4_TXFE_CKDIV, |
| 0xF0, 0x50); |
| clear_bit(ADC4_TXFE, &priv->status_mask); |
| } |
| if (test_bit(ADC5_TXFE, &priv->status_mask)) { |
| snd_soc_update_bits(codec, TOMTOM_A_TX_5_6_TXFE_CKDIV, |
| 0x0F, 0x05); |
| clear_bit(ADC5_TXFE, &priv->status_mask); |
| } |
| if (test_bit(ADC6_TXFE, &priv->status_mask)) { |
| snd_soc_update_bits(codec, TOMTOM_A_TX_5_6_TXFE_CKDIV, |
| 0xF0, 0x50); |
| clear_bit(ADC6_TXFE, &priv->status_mask); |
| } |
| } |
| |
| static void tx_hpf_corner_freq_callback(struct work_struct *work) |
| { |
| struct delayed_work *hpf_delayed_work; |
| struct hpf_work *hpf_work; |
| struct tomtom_priv *tomtom; |
| struct snd_soc_codec *codec; |
| u16 tx_mux_ctl_reg; |
| u8 hpf_cut_of_freq; |
| |
| hpf_delayed_work = to_delayed_work(work); |
| hpf_work = container_of(hpf_delayed_work, struct hpf_work, dwork); |
| tomtom = hpf_work->tomtom; |
| codec = hpf_work->tomtom->codec; |
| hpf_cut_of_freq = hpf_work->tx_hpf_cut_of_freq; |
| |
| tx_mux_ctl_reg = TOMTOM_A_CDC_TX1_MUX_CTL + |
| (hpf_work->decimator - 1) * 8; |
| |
| pr_debug("%s(): decimator %u hpf_cut_of_freq 0x%x\n", __func__, |
| hpf_work->decimator, (unsigned int)hpf_cut_of_freq); |
| |
| /* |
| * Restore TXFE ClkDiv registers to default. |
| * If any of these registers are modified during analog |
| * front-end enablement, they will be restored back to the |
| * default |
| */ |
| txfe_clkdiv_update(codec); |
| |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x30, hpf_cut_of_freq << 4); |
| } |
| |
| #define TX_MUX_CTL_CUT_OFF_FREQ_MASK 0x30 |
| #define CF_MIN_3DB_4HZ 0x0 |
| #define CF_MIN_3DB_75HZ 0x1 |
| #define CF_MIN_3DB_150HZ 0x2 |
| |
| static int tomtom_codec_enable_dec(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| unsigned int decimator; |
| char *dec_name = NULL; |
| char *widget_name = NULL; |
| char *temp; |
| int ret = 0; |
| u16 dec_reset_reg, tx_vol_ctl_reg, tx_mux_ctl_reg; |
| u8 dec_hpf_cut_of_freq; |
| int offset; |
| char *dec; |
| |
| pr_debug("%s %d\n", __func__, event); |
| |
| widget_name = kstrndup(w->name, 15, GFP_KERNEL); |
| if (!widget_name) |
| return -ENOMEM; |
| temp = widget_name; |
| |
| dec_name = strsep(&widget_name, " "); |
| widget_name = temp; |
| if (!dec_name) { |
| pr_err("%s: Invalid decimator = %s\n", __func__, w->name); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| dec = strpbrk(dec_name, "123456789"); |
| if (!dec) { |
| dev_err(codec->dev, "%s: decimator index not found\n", |
| __func__); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| ret = kstrtouint(dec, 10, &decimator); |
| if (ret < 0) { |
| pr_err("%s: Invalid decimator = %s\n", __func__, dec_name); |
| ret = -EINVAL; |
| goto out; |
| } |
| |
| pr_debug("%s(): widget = %s dec_name = %s decimator = %u\n", __func__, |
| w->name, dec_name, decimator); |
| |
| if (w->reg == TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL) { |
| dec_reset_reg = TOMTOM_A_CDC_CLK_TX_RESET_B1_CTL; |
| offset = 0; |
| } else if (w->reg == TOMTOM_A_CDC_CLK_TX_CLK_EN_B2_CTL) { |
| dec_reset_reg = TOMTOM_A_CDC_CLK_TX_RESET_B2_CTL; |
| offset = 8; |
| } else { |
| pr_err("%s: Error, incorrect dec\n", __func__); |
| return -EINVAL; |
| } |
| |
| tx_vol_ctl_reg = TOMTOM_A_CDC_TX1_VOL_CTL_CFG + 8 * (decimator - 1); |
| tx_mux_ctl_reg = TOMTOM_A_CDC_TX1_MUX_CTL + 8 * (decimator - 1); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| |
| /* Enableable TX digital mute */ |
| snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x01); |
| |
| snd_soc_update_bits(codec, dec_reset_reg, 1 << w->shift, |
| 1 << w->shift); |
| snd_soc_update_bits(codec, dec_reset_reg, 1 << w->shift, 0x0); |
| |
| pr_debug("%s: decimator = %u, bypass = %d\n", __func__, |
| decimator, tx_hpf_work[decimator - 1].tx_hpf_bypass); |
| if (tx_hpf_work[decimator - 1].tx_hpf_bypass != true) { |
| dec_hpf_cut_of_freq = snd_soc_read(codec, |
| tx_mux_ctl_reg); |
| |
| dec_hpf_cut_of_freq = (dec_hpf_cut_of_freq & 0x30) >> 4; |
| |
| tx_hpf_work[decimator - 1].tx_hpf_cut_of_freq = |
| dec_hpf_cut_of_freq; |
| |
| if (dec_hpf_cut_of_freq != CF_MIN_3DB_150HZ) { |
| |
| /* set cut of freq to CF_MIN_3DB_150HZ (0x1); */ |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x30, |
| CF_MIN_3DB_150HZ << 4); |
| } |
| |
| /* enable HPF */ |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x08, 0x00); |
| } else |
| /* bypass HPF */ |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x08, 0x08); |
| |
| break; |
| |
| case SND_SOC_DAPM_POST_PMU: |
| |
| /* Disable TX digital mute */ |
| snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x00); |
| |
| if ((tx_hpf_work[decimator - 1].tx_hpf_cut_of_freq != |
| CF_MIN_3DB_150HZ) && |
| (tx_hpf_work[decimator - 1].tx_hpf_bypass != true)) { |
| |
| schedule_delayed_work(&tx_hpf_work[decimator - 1].dwork, |
| msecs_to_jiffies(300)); |
| } |
| /* apply the digital gain after the decimator is enabled*/ |
| if ((w->shift + offset) < ARRAY_SIZE(tx_digital_gain_reg)) |
| snd_soc_write(codec, |
| tx_digital_gain_reg[w->shift + offset], |
| snd_soc_read(codec, |
| tx_digital_gain_reg[w->shift + offset]) |
| ); |
| |
| break; |
| |
| case SND_SOC_DAPM_PRE_PMD: |
| |
| snd_soc_update_bits(codec, tx_vol_ctl_reg, 0x01, 0x01); |
| cancel_delayed_work_sync(&tx_hpf_work[decimator - 1].dwork); |
| break; |
| |
| case SND_SOC_DAPM_POST_PMD: |
| |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x08, 0x08); |
| snd_soc_update_bits(codec, tx_mux_ctl_reg, 0x30, |
| (tx_hpf_work[decimator - 1].tx_hpf_cut_of_freq) << 4); |
| |
| break; |
| } |
| out: |
| kfree(widget_name); |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_vdd_spkr(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| int ret = 0; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s: %d %s\n", __func__, event, w->name); |
| |
| WARN_ONCE(!priv->spkdrv_reg, "SPKDRV supply %s isn't defined\n", |
| WCD9XXX_VDD_SPKDRV_NAME); |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| if (priv->spkdrv_reg) { |
| ret = regulator_enable(priv->spkdrv_reg); |
| if (ret) |
| pr_err("%s: Failed to enable spkdrv_reg %s\n", |
| __func__, WCD9XXX_VDD_SPKDRV_NAME); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| if (priv->spkdrv_reg) { |
| ret = regulator_disable(priv->spkdrv_reg); |
| if (ret) |
| pr_err("%s: Failed to disable spkdrv_reg %s\n", |
| __func__, WCD9XXX_VDD_SPKDRV_NAME); |
| } |
| break; |
| } |
| |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_vdd_spkr2(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| int ret = 0; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s: %d %s\n", __func__, event, w->name); |
| |
| /* |
| * If on-demand voltage regulators of spkr1 and spkr2 has been derived |
| * from same power rail then same on-demand voltage regulator can be |
| * used by both spkr1 and spkr2, if a separate device tree entry has |
| * not been defined for on-demand voltage regulator for spkr2. |
| */ |
| if (!priv->spkdrv2_reg) { |
| if (priv->spkdrv_reg) { |
| priv->spkdrv2_reg = priv->spkdrv_reg; |
| } else { |
| WARN_ONCE(!priv->spkdrv2_reg, |
| "SPKDRV2 supply %s isn't defined\n", |
| WCD9XXX_VDD_SPKDRV2_NAME); |
| return 0; |
| } |
| } |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| if (priv->spkdrv2_reg) { |
| ret = regulator_enable(priv->spkdrv2_reg); |
| if (ret) |
| pr_err("%s: Failed to enable spkdrv2_reg %s ret:%d\n", |
| __func__, WCD9XXX_VDD_SPKDRV2_NAME, ret); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| if (priv->spkdrv2_reg) { |
| ret = regulator_disable(priv->spkdrv2_reg); |
| if (ret) |
| pr_err("%s: Failed to disable spkdrv2_reg %s ret:%d\n", |
| __func__, WCD9XXX_VDD_SPKDRV2_NAME, ret); |
| } |
| break; |
| } |
| |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_interpolator(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| |
| pr_debug("%s %d %s\n", __func__, event, w->name); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_RX_RESET_CTL, |
| 1 << w->shift, 1 << w->shift); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_RX_RESET_CTL, |
| 1 << w->shift, 0x0); |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| /* apply the digital gain after the interpolator is enabled*/ |
| if ((w->shift) < ARRAY_SIZE(rx_digital_gain_reg)) |
| snd_soc_write(codec, |
| rx_digital_gain_reg[w->shift], |
| snd_soc_read(codec, |
| rx_digital_gain_reg[w->shift]) |
| ); |
| /* Check for Rx1 and Rx2 paths for uhqa mode update */ |
| if (w->shift == 0 || w->shift == 1) |
| tomtom_update_uhqa_mode(codec, (1 << w->shift)); |
| |
| break; |
| } |
| return 0; |
| } |
| |
| /* called under codec_resource_lock acquisition */ |
| static int __tomtom_codec_enable_ldo_h(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s: enter\n", __func__); |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| /* |
| * ldo_h_users is protected by tomtom->codec_mutex, don't need |
| * additional mutex |
| */ |
| if (++priv->ldo_h_users == 1) { |
| WCD9XXX_BG_CLK_LOCK(&priv->resmgr); |
| wcd9xxx_resmgr_get_bandgap(&priv->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| WCD9XXX_BG_CLK_UNLOCK(&priv->resmgr); |
| tomtom_codec_internal_rco_ctrl(codec, true); |
| snd_soc_update_bits(codec, TOMTOM_A_LDO_H_MODE_1, |
| 1 << 7, 1 << 7); |
| tomtom_codec_internal_rco_ctrl(codec, false); |
| pr_debug("%s: ldo_h_users %d\n", __func__, |
| priv->ldo_h_users); |
| /* LDO enable requires 1ms to settle down */ |
| usleep_range(1000, 1100); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| if (--priv->ldo_h_users == 0) { |
| tomtom_codec_internal_rco_ctrl(codec, true); |
| snd_soc_update_bits(codec, TOMTOM_A_LDO_H_MODE_1, |
| 1 << 7, 0); |
| tomtom_codec_internal_rco_ctrl(codec, false); |
| WCD9XXX_BG_CLK_LOCK(&priv->resmgr); |
| wcd9xxx_resmgr_put_bandgap(&priv->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| WCD9XXX_BG_CLK_UNLOCK(&priv->resmgr); |
| pr_debug("%s: ldo_h_users %d\n", __func__, |
| priv->ldo_h_users); |
| } |
| WARN(priv->ldo_h_users < 0, "Unexpected ldo_h users %d\n", |
| priv->ldo_h_users); |
| break; |
| } |
| pr_debug("%s: leave\n", __func__); |
| return 0; |
| } |
| |
| static int tomtom_codec_enable_ldo_h(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| int rc; |
| |
| rc = __tomtom_codec_enable_ldo_h(w, kcontrol, event); |
| return rc; |
| } |
| |
| static int tomtom_codec_enable_rx_bias(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s %d\n", __func__, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| wcd9xxx_resmgr_enable_rx_bias(&tomtom->resmgr, 1); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| wcd9xxx_resmgr_enable_rx_bias(&tomtom->resmgr, 0); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_enable_anc(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| const char *filename; |
| const struct firmware *fw; |
| int i; |
| int ret = 0; |
| int num_anc_slots; |
| struct wcd9xxx_anc_header *anc_head; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| struct firmware_cal *hwdep_cal = NULL; |
| u32 anc_writes_size = 0; |
| u32 anc_cal_size = 0; |
| int anc_size_remaining; |
| u32 *anc_ptr; |
| u16 reg; |
| u8 mask, val, old_val; |
| size_t cal_size; |
| const void *data; |
| |
| if (tomtom->anc_func == 0) |
| return 0; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| filename = "wcd9320/wcd9320_anc.bin"; |
| |
| hwdep_cal = wcdcal_get_fw_cal(tomtom->fw_data, WCD9XXX_ANC_CAL); |
| if (hwdep_cal) { |
| data = hwdep_cal->data; |
| cal_size = hwdep_cal->size; |
| dev_dbg(codec->dev, "%s: using hwdep calibration\n", |
| __func__); |
| } else { |
| ret = request_firmware(&fw, filename, codec->dev); |
| if (ret != 0) { |
| dev_err(codec->dev, "Failed to acquire ANC data: %d\n", |
| ret); |
| return -ENODEV; |
| } |
| if (!fw) { |
| dev_err(codec->dev, "failed to get anc fw"); |
| return -ENODEV; |
| } |
| data = fw->data; |
| cal_size = fw->size; |
| dev_dbg(codec->dev, "%s: using request_firmware calibration\n", |
| __func__); |
| } |
| if (cal_size < sizeof(struct wcd9xxx_anc_header)) { |
| dev_err(codec->dev, "Not enough data\n"); |
| ret = -ENOMEM; |
| goto err; |
| } |
| /* First number is the number of register writes */ |
| anc_head = (struct wcd9xxx_anc_header *)(data); |
| anc_ptr = (u32 *)(data + |
| sizeof(struct wcd9xxx_anc_header)); |
| anc_size_remaining = cal_size - |
| sizeof(struct wcd9xxx_anc_header); |
| num_anc_slots = anc_head->num_anc_slots; |
| |
| if (tomtom->anc_slot >= num_anc_slots) { |
| dev_err(codec->dev, "Invalid ANC slot selected\n"); |
| ret = -EINVAL; |
| goto err; |
| } |
| for (i = 0; i < num_anc_slots; i++) { |
| if (anc_size_remaining < TOMTOM_PACKED_REG_SIZE) { |
| dev_err(codec->dev, "Invalid register format\n"); |
| ret = -EINVAL; |
| goto err; |
| } |
| anc_writes_size = (u32)(*anc_ptr); |
| anc_size_remaining -= sizeof(u32); |
| anc_ptr += 1; |
| |
| if (anc_writes_size * TOMTOM_PACKED_REG_SIZE |
| > anc_size_remaining) { |
| dev_err(codec->dev, "Invalid register format\n"); |
| ret = -EINVAL; |
| goto err; |
| } |
| |
| if (tomtom->anc_slot == i) |
| break; |
| |
| anc_size_remaining -= (anc_writes_size * |
| TOMTOM_PACKED_REG_SIZE); |
| anc_ptr += anc_writes_size; |
| } |
| if (i == num_anc_slots) { |
| dev_err(codec->dev, "Selected ANC slot not present\n"); |
| ret = -EINVAL; |
| goto err; |
| } |
| |
| i = 0; |
| anc_cal_size = anc_writes_size; |
| if (w->reg == TOMTOM_A_RX_HPH_L_DAC_CTL) { |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_ANC_RESET_CTL, 0x03, 0x03); |
| anc_writes_size = (anc_cal_size/2); |
| } |
| |
| if (w->reg == TOMTOM_A_RX_HPH_R_DAC_CTL) { |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_ANC_RESET_CTL, 0x0C, 0x0C); |
| i = (anc_cal_size/2); |
| anc_writes_size = anc_cal_size; |
| } |
| |
| for (; i < anc_writes_size; i++) { |
| TOMTOM_CODEC_UNPACK_ENTRY(anc_ptr[i], reg, |
| mask, val); |
| /* |
| * ANC Soft reset register is ignored from ACDB |
| * because ANC left soft reset bits will be called |
| * while enabling ANC HPH Right DAC. |
| */ |
| if ((reg == TOMTOM_A_CDC_CLK_ANC_RESET_CTL) && |
| ((w->reg == TOMTOM_A_RX_HPH_L_DAC_CTL) || |
| (w->reg == TOMTOM_A_RX_HPH_R_DAC_CTL))) { |
| continue; |
| } |
| old_val = snd_soc_read(codec, reg); |
| snd_soc_write(codec, reg, (old_val & ~mask) | |
| (val & mask)); |
| } |
| if (w->reg == TOMTOM_A_RX_HPH_L_DAC_CTL) |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_ANC_RESET_CTL, 0x03, 0x00); |
| |
| if (w->reg == TOMTOM_A_RX_HPH_R_DAC_CTL) |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_ANC_RESET_CTL, 0x0C, 0x00); |
| if (!hwdep_cal) |
| release_firmware(fw); |
| txfe_clkdiv_update(codec); |
| break; |
| case SND_SOC_DAPM_PRE_PMD: |
| msleep(40); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_ANC1_B1_CTL, 0x01, |
| 0x00); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_ANC2_B1_CTL, 0x02, |
| 0x00); |
| msleep(20); |
| snd_soc_write(codec, TOMTOM_A_CDC_CLK_ANC_RESET_CTL, 0x0F); |
| snd_soc_write(codec, TOMTOM_A_CDC_CLK_ANC_CLK_EN_CTL, 0); |
| snd_soc_write(codec, TOMTOM_A_CDC_CLK_ANC_RESET_CTL, 0x00); |
| break; |
| } |
| return 0; |
| err: |
| if (!hwdep_cal) |
| release_firmware(fw); |
| return ret; |
| } |
| |
| static int tomtom_hphl_dac_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| uint32_t impedl, impedr; |
| int ret = 0; |
| |
| pr_debug("%s %s %d\n", __func__, w->name, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| if (tomtom_p->anc_func) { |
| tomtom_codec_enable_anc(w, kcontrol, event); |
| msleep(50); |
| } |
| |
| if (!high_perf_mode && !tomtom_p->uhqa_mode) { |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_HPHL, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_PRE_DAC); |
| } else { |
| wcd9xxx_enable_high_perf_mode(codec, &tomtom_p->clsh_d, |
| tomtom_p->uhqa_mode, |
| WCD9XXX_CLSAB_STATE_HPHL, |
| WCD9XXX_CLSAB_REQ_ENABLE); |
| } |
| ret = wcd9xxx_mbhc_get_impedance(&tomtom_p->mbhc, |
| &impedl, &impedr); |
| if (!ret) |
| wcd9xxx_clsh_imped_config(codec, impedl); |
| else |
| dev_dbg(codec->dev, "%s: Failed to get mbhc impedance %d\n", |
| __func__, ret); |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX1_B3_CTL, 0xBC, 0x94); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX1_B4_CTL, 0x30, 0x10); |
| break; |
| case SND_SOC_DAPM_PRE_PMD: |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX1_B3_CTL, 0xBC, 0x00); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX1_B4_CTL, 0x30, 0x00); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| if (!high_perf_mode && !tomtom_p->uhqa_mode) { |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_HPHL, |
| WCD9XXX_CLSH_REQ_DISABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| } else { |
| wcd9xxx_enable_high_perf_mode(codec, &tomtom_p->clsh_d, |
| tomtom_p->uhqa_mode, |
| WCD9XXX_CLSAB_STATE_HPHL, |
| WCD9XXX_CLSAB_REQ_DISABLE); |
| } |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_hphr_dac_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s %s %d\n", __func__, w->name, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| if (tomtom_p->anc_func) { |
| tomtom_codec_enable_anc(w, kcontrol, event); |
| msleep(50); |
| } |
| |
| snd_soc_update_bits(codec, w->reg, 0x40, 0x40); |
| if (!high_perf_mode && !tomtom_p->uhqa_mode) { |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_HPHR, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_PRE_DAC); |
| } else { |
| wcd9xxx_enable_high_perf_mode(codec, &tomtom_p->clsh_d, |
| tomtom_p->uhqa_mode, |
| WCD9XXX_CLSAB_STATE_HPHR, |
| WCD9XXX_CLSAB_REQ_ENABLE); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX2_B3_CTL, 0xBC, 0x94); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX2_B4_CTL, 0x30, 0x10); |
| break; |
| case SND_SOC_DAPM_PRE_PMD: |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX2_B3_CTL, 0xBC, 0x00); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX2_B4_CTL, 0x30, 0x00); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| snd_soc_update_bits(codec, w->reg, 0x40, 0x00); |
| if (!high_perf_mode && !tomtom_p->uhqa_mode) { |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_HPHR, |
| WCD9XXX_CLSH_REQ_DISABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| } else { |
| wcd9xxx_enable_high_perf_mode(codec, &tomtom_p->clsh_d, |
| tomtom_p->uhqa_mode, |
| WCD9XXX_CLSAB_STATE_HPHR, |
| WCD9XXX_CLSAB_REQ_DISABLE); |
| } |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_hph_pa_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| enum wcd9xxx_notify_event e_pre_on, e_post_off; |
| u8 req_clsh_state; |
| u32 pa_settle_time = TOMTOM_HPH_PA_SETTLE_COMP_OFF; |
| |
| pr_debug("%s: %s event = %d\n", __func__, w->name, event); |
| if (w->shift == 5) { |
| e_pre_on = WCD9XXX_EVENT_PRE_HPHL_PA_ON; |
| e_post_off = WCD9XXX_EVENT_POST_HPHL_PA_OFF; |
| req_clsh_state = WCD9XXX_CLSH_STATE_HPHL; |
| } else if (w->shift == 4) { |
| e_pre_on = WCD9XXX_EVENT_PRE_HPHR_PA_ON; |
| e_post_off = WCD9XXX_EVENT_POST_HPHR_PA_OFF; |
| req_clsh_state = WCD9XXX_CLSH_STATE_HPHR; |
| } else { |
| pr_err("%s: Invalid w->shift %d\n", __func__, w->shift); |
| return -EINVAL; |
| } |
| |
| if (tomtom->comp_enabled[COMPANDER_1]) |
| pa_settle_time = TOMTOM_HPH_PA_SETTLE_COMP_ON; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| set_bit(HPH_DELAY, &tomtom->status_mask); |
| /* Let MBHC module know PA is turning on */ |
| wcd9xxx_resmgr_notifier_call(&tomtom->resmgr, e_pre_on); |
| break; |
| |
| case SND_SOC_DAPM_POST_PMU: |
| if (test_bit(HPH_DELAY, &tomtom->status_mask)) { |
| /* |
| * Make sure to wait 10ms after enabling HPHR_HPHL |
| * in register 0x1AB |
| */ |
| usleep_range(pa_settle_time, pa_settle_time + 1000); |
| clear_bit(HPH_DELAY, &tomtom->status_mask); |
| pr_debug("%s: sleep %d us after %s PA enable\n", |
| __func__, pa_settle_time, w->name); |
| } |
| if (!high_perf_mode && !tomtom->uhqa_mode) { |
| wcd9xxx_clsh_fsm(codec, &tomtom->clsh_d, |
| req_clsh_state, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| } |
| break; |
| |
| case SND_SOC_DAPM_PRE_PMD: |
| set_bit(HPH_DELAY, &tomtom->status_mask); |
| break; |
| |
| case SND_SOC_DAPM_POST_PMD: |
| /* Let MBHC module know PA turned off */ |
| wcd9xxx_resmgr_notifier_call(&tomtom->resmgr, e_post_off); |
| if (test_bit(HPH_DELAY, &tomtom->status_mask)) { |
| /* |
| * Make sure to wait 10ms after disabling HPHR_HPHL |
| * in register 0x1AB |
| */ |
| usleep_range(pa_settle_time, pa_settle_time + 1000); |
| clear_bit(HPH_DELAY, &tomtom->status_mask); |
| pr_debug("%s: sleep %d us after %s PA disable\n", |
| __func__, pa_settle_time, w->name); |
| } |
| |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_enable_anc_hph(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| int ret = 0; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| ret = tomtom_hph_pa_event(w, kcontrol, event); |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| if ((snd_soc_read(codec, TOMTOM_A_RX_HPH_L_DAC_CTL) & 0x80) && |
| (snd_soc_read(codec, TOMTOM_A_RX_HPH_R_DAC_CTL) |
| & 0x80)) { |
| snd_soc_update_bits(codec, |
| TOMTOM_A_RX_HPH_CNP_EN, 0x30, 0x30); |
| msleep(30); |
| } |
| ret = tomtom_hph_pa_event(w, kcontrol, event); |
| break; |
| case SND_SOC_DAPM_PRE_PMD: |
| if (w->shift == 5) { |
| snd_soc_update_bits(codec, |
| TOMTOM_A_RX_HPH_CNP_EN, 0x30, 0x00); |
| msleep(40); |
| snd_soc_update_bits(codec, |
| TOMTOM_A_TX_7_MBHC_EN, 0x80, 00); |
| ret |= tomtom_codec_enable_anc(w, kcontrol, event); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| ret = tomtom_hph_pa_event(w, kcontrol, event); |
| break; |
| } |
| return ret; |
| } |
| |
| static const struct snd_soc_dapm_widget tomtom_dapm_i2s_widgets[] = { |
| SND_SOC_DAPM_SUPPLY("RX_I2S_CLK", TOMTOM_A_CDC_CLK_RX_I2S_CTL, |
| 4, 0, NULL, 0), |
| SND_SOC_DAPM_SUPPLY("TX_I2S_CLK", TOMTOM_A_CDC_CLK_TX_I2S_CTL, 4, |
| 0, NULL, 0), |
| }; |
| |
| static int tomtom_lineout_dac_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s %s %d\n", __func__, w->name, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| wcd9xxx_clsh_fsm(codec, &tomtom->clsh_d, |
| WCD9XXX_CLSH_STATE_LO, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_PRE_DAC); |
| snd_soc_update_bits(codec, w->reg, 0x40, 0x40); |
| break; |
| |
| case SND_SOC_DAPM_POST_PMD: |
| snd_soc_update_bits(codec, w->reg, 0x40, 0x00); |
| wcd9xxx_clsh_fsm(codec, &tomtom->clsh_d, |
| WCD9XXX_CLSH_STATE_LO, |
| WCD9XXX_CLSH_REQ_DISABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_spk_dac_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| |
| pr_debug("%s %s %d\n", __func__, w->name, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| snd_soc_update_bits(codec, WCD9XXX_A_CDC_CLK_OTHR_CTL, |
| 0x80, 0x80); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| if ((snd_soc_read(codec, w->reg) & 0x03) == 0) |
| snd_soc_update_bits(codec, WCD9XXX_A_CDC_CLK_OTHR_CTL, |
| 0x80, 0x00); |
| break; |
| } |
| return 0; |
| } |
| |
| static const struct snd_soc_dapm_route audio_i2s_map[] = { |
| {"SLIM RX1", NULL, "RX_I2S_CLK"}, |
| {"SLIM RX2", NULL, "RX_I2S_CLK"}, |
| {"SLIM RX3", NULL, "RX_I2S_CLK"}, |
| {"SLIM RX4", NULL, "RX_I2S_CLK"}, |
| |
| {"SLIM TX7 MUX", NULL, "TX_I2S_CLK"}, |
| {"SLIM TX8 MUX", NULL, "TX_I2S_CLK"}, |
| {"SLIM TX9 MUX", NULL, "TX_I2S_CLK"}, |
| {"SLIM TX10 MUX", NULL, "TX_I2S_CLK"}, |
| |
| {"RX_I2S_CLK", NULL, "CDC_I2S_RX_CONN"}, |
| }; |
| |
| static const struct snd_soc_dapm_route audio_map[] = { |
| /* SLIMBUS Connections */ |
| {"AIF1 CAP", NULL, "AIF1_CAP Mixer"}, |
| {"AIF2 CAP", NULL, "AIF2_CAP Mixer"}, |
| {"AIF3 CAP", NULL, "AIF3_CAP Mixer"}, |
| |
| /* VI Feedback */ |
| {"AIF4 VI", NULL, "VIONOFF"}, |
| {"VIONOFF", "Switch", "VIINPUT"}, |
| |
| /* MAD */ |
| {"MAD_SEL MUX", "SPE", "MAD_CPE_INPUT"}, |
| {"MAD_SEL MUX", "MSM", "MADINPUT"}, |
| {"MADONOFF", "Switch", "MAD_SEL MUX"}, |
| {"AIF4 MAD", NULL, "MADONOFF"}, |
| |
| /* SLIM_MIXER("AIF1_CAP Mixer"),*/ |
| {"AIF1_CAP Mixer", "SLIM TX1", "SLIM TX1 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX2", "SLIM TX2 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX3", "SLIM TX3 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX4", "SLIM TX4 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX5", "SLIM TX5 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX6", "SLIM TX6 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX7", "SLIM TX7 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX8", "SLIM TX8 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX9", "SLIM TX9 MUX"}, |
| {"AIF1_CAP Mixer", "SLIM TX10", "SLIM TX10 MUX"}, |
| /* SLIM_MIXER("AIF2_CAP Mixer"),*/ |
| {"AIF2_CAP Mixer", "SLIM TX1", "SLIM TX1 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX2", "SLIM TX2 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX3", "SLIM TX3 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX4", "SLIM TX4 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX5", "SLIM TX5 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX6", "SLIM TX6 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX7", "SLIM TX7 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX8", "SLIM TX8 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX9", "SLIM TX9 MUX"}, |
| {"AIF2_CAP Mixer", "SLIM TX10", "SLIM TX10 MUX"}, |
| /* SLIM_MIXER("AIF3_CAP Mixer"),*/ |
| {"AIF3_CAP Mixer", "SLIM TX1", "SLIM TX1 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX2", "SLIM TX2 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX3", "SLIM TX3 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX4", "SLIM TX4 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX5", "SLIM TX5 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX6", "SLIM TX6 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX7", "SLIM TX7 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX8", "SLIM TX8 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX9", "SLIM TX9 MUX"}, |
| {"AIF3_CAP Mixer", "SLIM TX10", "SLIM TX10 MUX"}, |
| |
| {"SLIM TX1 MUX", "DEC1", "DEC1 MUX"}, |
| {"SLIM TX1 MUX", "RMIX1", "RX1 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX2", "RX2 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX3", "RX3 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX4", "RX4 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX5", "RX5 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX6", "RX6 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX7", "RX7 MIX1"}, |
| {"SLIM TX1 MUX", "RMIX8", "RX8 MIX1"}, |
| |
| {"SLIM TX2 MUX", "DEC2", "DEC2 MUX"}, |
| {"SLIM TX2 MUX", "RMIX1", "RX1 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX2", "RX2 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX3", "RX3 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX4", "RX4 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX5", "RX5 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX6", "RX6 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX7", "RX7 MIX1"}, |
| {"SLIM TX2 MUX", "RMIX8", "RX8 MIX1"}, |
| |
| {"SLIM TX3 MUX", "DEC3", "DEC3 MUX"}, |
| {"SLIM TX3 MUX", "RMIX1", "RX1 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX2", "RX2 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX3", "RX3 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX4", "RX4 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX5", "RX5 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX6", "RX6 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX7", "RX7 MIX1"}, |
| {"SLIM TX3 MUX", "RMIX8", "RX8 MIX1"}, |
| |
| {"SLIM TX4 MUX", "DEC4", "DEC4 MUX"}, |
| {"SLIM TX4 MUX", "RMIX1", "RX1 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX2", "RX2 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX3", "RX3 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX4", "RX4 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX5", "RX5 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX6", "RX6 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX7", "RX7 MIX1"}, |
| {"SLIM TX4 MUX", "RMIX8", "RX8 MIX1"}, |
| |
| {"SLIM TX5 MUX", "DEC5", "DEC5 MUX"}, |
| {"SLIM TX5 MUX", "RMIX1", "RX1 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX2", "RX2 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX3", "RX3 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX4", "RX4 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX5", "RX5 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX6", "RX6 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX7", "RX7 MIX1"}, |
| {"SLIM TX5 MUX", "RMIX8", "RX8 MIX1"}, |
| |
| {"SLIM TX6 MUX", "DEC6", "DEC6 MUX"}, |
| |
| {"SLIM TX7 MUX", "DEC1", "DEC1 MUX"}, |
| {"SLIM TX7 MUX", "DEC2", "DEC2 MUX"}, |
| {"SLIM TX7 MUX", "DEC3", "DEC3 MUX"}, |
| {"SLIM TX7 MUX", "DEC4", "DEC4 MUX"}, |
| {"SLIM TX7 MUX", "DEC5", "DEC5 MUX"}, |
| {"SLIM TX7 MUX", "DEC6", "DEC6 MUX"}, |
| {"SLIM TX7 MUX", "DEC7", "DEC7 MUX"}, |
| {"SLIM TX7 MUX", "DEC8", "DEC8 MUX"}, |
| {"SLIM TX7 MUX", "DEC9", "DEC9 MUX"}, |
| {"SLIM TX7 MUX", "DEC10", "DEC10 MUX"}, |
| {"SLIM TX7 MUX", "RMIX1", "RX1 MIX1"}, |
| {"SLIM TX7 MUX", "RMIX2", "RX2 MIX1"}, |
| {"SLIM TX7 MUX", "RMIX3", "RX3 MIX1"}, |
| {"SLIM TX7 MUX", "RMIX4", "RX4 MIX1"}, |
| {"SLIM TX7 MUX", "RMIX5", "RX5 MIX1"}, |
| {"SLIM TX7 MUX", "RMIX6", "RX6 MIX1"}, |
| {"SLIM TX7 MUX", "RMIX7", "RX7 MIX1"}, |
| |
| {"SLIM TX8 MUX", "DEC1", "DEC1 MUX"}, |
| {"SLIM TX8 MUX", "DEC2", "DEC2 MUX"}, |
| {"SLIM TX8 MUX", "DEC3", "DEC3 MUX"}, |
| {"SLIM TX8 MUX", "DEC4", "DEC4 MUX"}, |
| {"SLIM TX8 MUX", "DEC5", "DEC5 MUX"}, |
| {"SLIM TX8 MUX", "DEC6", "DEC6 MUX"}, |
| {"SLIM TX8 MUX", "DEC7", "DEC7 MUX"}, |
| {"SLIM TX8 MUX", "DEC8", "DEC8 MUX"}, |
| {"SLIM TX8 MUX", "DEC9", "DEC9 MUX"}, |
| {"SLIM TX8 MUX", "DEC10", "DEC10 MUX"}, |
| |
| {"SLIM TX9 MUX", "DEC1", "DEC1 MUX"}, |
| {"SLIM TX9 MUX", "DEC2", "DEC2 MUX"}, |
| {"SLIM TX9 MUX", "DEC3", "DEC3 MUX"}, |
| {"SLIM TX9 MUX", "DEC4", "DEC4 MUX"}, |
| {"SLIM TX9 MUX", "DEC5", "DEC5 MUX"}, |
| {"SLIM TX9 MUX", "DEC6", "DEC6 MUX"}, |
| {"SLIM TX9 MUX", "DEC7", "DEC7 MUX"}, |
| {"SLIM TX9 MUX", "DEC8", "DEC8 MUX"}, |
| {"SLIM TX9 MUX", "DEC9", "DEC9 MUX"}, |
| {"SLIM TX9 MUX", "DEC10", "DEC10 MUX"}, |
| |
| {"SLIM TX10 MUX", "DEC1", "DEC1 MUX"}, |
| {"SLIM TX10 MUX", "DEC2", "DEC2 MUX"}, |
| {"SLIM TX10 MUX", "DEC3", "DEC3 MUX"}, |
| {"SLIM TX10 MUX", "DEC4", "DEC4 MUX"}, |
| {"SLIM TX10 MUX", "DEC5", "DEC5 MUX"}, |
| {"SLIM TX10 MUX", "DEC6", "DEC6 MUX"}, |
| {"SLIM TX10 MUX", "DEC7", "DEC7 MUX"}, |
| {"SLIM TX10 MUX", "DEC8", "DEC8 MUX"}, |
| {"SLIM TX10 MUX", "DEC9", "DEC9 MUX"}, |
| {"SLIM TX10 MUX", "DEC10", "DEC10 MUX"}, |
| |
| /* Earpiece (RX MIX1) */ |
| {"EAR", NULL, "EAR PA"}, |
| {"EAR PA", NULL, "EAR_PA_MIXER"}, |
| {"EAR_PA_MIXER", NULL, "DAC1"}, |
| {"DAC1", NULL, "RX_BIAS"}, |
| |
| {"ANC EAR", NULL, "ANC EAR PA"}, |
| {"ANC EAR PA", NULL, "EAR_PA_MIXER"}, |
| {"ANC1 FB MUX", "EAR_HPH_L", "RX1 MIX2"}, |
| {"ANC1 FB MUX", "EAR_LINE_1", "RX2 MIX2"}, |
| |
| /* Headset (RX MIX1 and RX MIX2) */ |
| {"HEADPHONE", NULL, "HPHL"}, |
| {"HEADPHONE", NULL, "HPHR"}, |
| |
| {"HPHL", NULL, "HPHL_PA_MIXER"}, |
| {"HPHL_PA_MIXER", NULL, "HPHL DAC"}, |
| {"HPHL DAC", NULL, "RX_BIAS"}, |
| |
| {"HPHR", NULL, "HPHR_PA_MIXER"}, |
| {"HPHR_PA_MIXER", NULL, "HPHR DAC"}, |
| {"HPHR DAC", NULL, "RX_BIAS"}, |
| |
| {"ANC HEADPHONE", NULL, "ANC HPHL"}, |
| {"ANC HEADPHONE", NULL, "ANC HPHR"}, |
| |
| {"ANC HPHL", NULL, "HPHL_PA_MIXER"}, |
| {"ANC HPHR", NULL, "HPHR_PA_MIXER"}, |
| |
| {"ANC1 MUX", "ADC1", "ADC1"}, |
| {"ANC1 MUX", "ADC2", "ADC2"}, |
| {"ANC1 MUX", "ADC3", "ADC3"}, |
| {"ANC1 MUX", "ADC4", "ADC4"}, |
| {"ANC1 MUX", "ADC5", "ADC5"}, |
| {"ANC1 MUX", "ADC6", "ADC6"}, |
| {"ANC1 MUX", "DMIC1", "DMIC1"}, |
| {"ANC1 MUX", "DMIC2", "DMIC2"}, |
| {"ANC1 MUX", "DMIC3", "DMIC3"}, |
| {"ANC1 MUX", "DMIC4", "DMIC4"}, |
| {"ANC1 MUX", "DMIC5", "DMIC5"}, |
| {"ANC1 MUX", "DMIC6", "DMIC6"}, |
| {"ANC2 MUX", "ADC1", "ADC1"}, |
| {"ANC2 MUX", "ADC2", "ADC2"}, |
| {"ANC2 MUX", "ADC3", "ADC3"}, |
| {"ANC2 MUX", "ADC4", "ADC4"}, |
| {"ANC2 MUX", "ADC5", "ADC5"}, |
| {"ANC2 MUX", "ADC6", "ADC6"}, |
| {"ANC2 MUX", "DMIC1", "DMIC1"}, |
| {"ANC2 MUX", "DMIC2", "DMIC2"}, |
| {"ANC2 MUX", "DMIC3", "DMIC3"}, |
| {"ANC2 MUX", "DMIC4", "DMIC4"}, |
| {"ANC2 MUX", "DMIC5", "DMIC5"}, |
| {"ANC2 MUX", "DMIC6", "DMIC6"}, |
| |
| {"ANC HPHR", NULL, "CDC_CONN"}, |
| |
| {"DAC1", "Switch", "CLASS_H_DSM MUX"}, |
| {"HPHL DAC", "Switch", "CLASS_H_DSM MUX"}, |
| {"HPHR DAC", NULL, "RX2 CHAIN"}, |
| |
| {"LINEOUT1", NULL, "LINEOUT1 PA"}, |
| {"LINEOUT2", NULL, "LINEOUT2 PA"}, |
| {"LINEOUT3", NULL, "LINEOUT3 PA"}, |
| {"LINEOUT4", NULL, "LINEOUT4 PA"}, |
| {"SPK_OUT", NULL, "SPK PA"}, |
| {"SPK_OUT", NULL, "SPK2 PA"}, |
| |
| {"LINEOUT1 PA", NULL, "LINEOUT1_PA_MIXER"}, |
| {"LINEOUT1_PA_MIXER", NULL, "LINEOUT1 DAC"}, |
| |
| {"LINEOUT2 PA", NULL, "LINEOUT2_PA_MIXER"}, |
| {"LINEOUT2_PA_MIXER", NULL, "LINEOUT2 DAC"}, |
| |
| {"LINEOUT3 PA", NULL, "LINEOUT3_PA_MIXER"}, |
| {"LINEOUT3_PA_MIXER", NULL, "LINEOUT3 DAC"}, |
| |
| {"LINEOUT4 PA", NULL, "LINEOUT4_PA_MIXER"}, |
| {"LINEOUT4_PA_MIXER", NULL, "LINEOUT4 DAC"}, |
| |
| {"LINEOUT1 DAC", NULL, "RX3 MIX1"}, |
| |
| {"RDAC5 MUX", "DEM3_INV", "RX3 MIX1"}, |
| {"RDAC5 MUX", "DEM4", "RX4 MIX1"}, |
| |
| {"LINEOUT3 DAC", NULL, "RDAC5 MUX"}, |
| |
| {"LINEOUT2 DAC", NULL, "RX5 MIX1"}, |
| |
| {"RDAC7 MUX", "DEM5_INV", "RX5 MIX1"}, |
| {"RDAC7 MUX", "DEM6", "RX6 MIX1"}, |
| |
| {"LINEOUT4 DAC", NULL, "RDAC7 MUX"}, |
| |
| {"SPK PA", NULL, "SPK DAC"}, |
| {"SPK DAC", NULL, "RX7 MIX2"}, |
| {"SPK DAC", NULL, "VDD_SPKDRV"}, |
| |
| {"SPK2 PA", NULL, "SPK2 DAC"}, |
| {"SPK2 DAC", NULL, "RX8 MIX1"}, |
| {"SPK2 DAC", NULL, "VDD_SPKDRV2"}, |
| |
| {"CLASS_H_DSM MUX", "DSM_HPHL_RX1", "RX1 CHAIN"}, |
| |
| {"RX1 INTERP", NULL, "RX1 MIX2"}, |
| {"RX1 CHAIN", NULL, "RX1 INTERP"}, |
| {"RX2 INTERP", NULL, "RX2 MIX2"}, |
| {"RX2 CHAIN", NULL, "RX2 INTERP"}, |
| {"RX1 MIX2", NULL, "ANC1 MUX"}, |
| {"RX2 MIX2", NULL, "ANC2 MUX"}, |
| |
| {"LINEOUT1 DAC", NULL, "RX_BIAS"}, |
| {"LINEOUT2 DAC", NULL, "RX_BIAS"}, |
| {"LINEOUT3 DAC", NULL, "RX_BIAS"}, |
| {"LINEOUT4 DAC", NULL, "RX_BIAS"}, |
| {"SPK DAC", NULL, "RX_BIAS"}, |
| {"SPK2 DAC", NULL, "RX_BIAS"}, |
| |
| {"RX7 MIX1", NULL, "COMP0_CLK"}, |
| {"RX8 MIX1", NULL, "COMP0_CLK"}, |
| {"RX1 MIX1", NULL, "COMP1_CLK"}, |
| {"RX2 MIX1", NULL, "COMP1_CLK"}, |
| {"RX3 MIX1", NULL, "COMP2_CLK"}, |
| {"RX5 MIX1", NULL, "COMP2_CLK"}, |
| |
| {"RX1 MIX1", NULL, "RX1 MIX1 INP1"}, |
| {"RX1 MIX1", NULL, "RX1 MIX1 INP2"}, |
| {"RX1 MIX1", NULL, "RX1 MIX1 INP3"}, |
| {"RX2 MIX1", NULL, "RX2 MIX1 INP1"}, |
| {"RX2 MIX1", NULL, "RX2 MIX1 INP2"}, |
| {"RX3 MIX1", NULL, "RX3 MIX1 INP1"}, |
| {"RX3 MIX1", NULL, "RX3 MIX1 INP2"}, |
| {"RX4 MIX1", NULL, "RX4 MIX1 INP1"}, |
| {"RX4 MIX1", NULL, "RX4 MIX1 INP2"}, |
| {"RX5 MIX1", NULL, "RX5 MIX1 INP1"}, |
| {"RX5 MIX1", NULL, "RX5 MIX1 INP2"}, |
| {"RX6 MIX1", NULL, "RX6 MIX1 INP1"}, |
| {"RX6 MIX1", NULL, "RX6 MIX1 INP2"}, |
| {"RX7 MIX1", NULL, "RX7 MIX1 INP1"}, |
| {"RX7 MIX1", NULL, "RX7 MIX1 INP2"}, |
| {"RX8 MIX1", NULL, "RX8 MIX1 INP1"}, |
| {"RX8 MIX1", NULL, "RX8 MIX1 INP2"}, |
| {"RX1 MIX2", NULL, "RX1 MIX1"}, |
| {"RX1 MIX2", NULL, "RX1 MIX2 INP1"}, |
| {"RX1 MIX2", NULL, "RX1 MIX2 INP2"}, |
| {"RX2 MIX2", NULL, "RX2 MIX1"}, |
| {"RX2 MIX2", NULL, "RX2 MIX2 INP1"}, |
| {"RX2 MIX2", NULL, "RX2 MIX2 INP2"}, |
| {"RX7 MIX2", NULL, "RX7 MIX1"}, |
| {"RX7 MIX2", NULL, "RX7 MIX2 INP1"}, |
| {"RX7 MIX2", NULL, "RX7 MIX2 INP2"}, |
| |
| /* SLIM_MUX("AIF1_PB", "AIF1 PB"),*/ |
| {"SLIM RX1 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX2 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX3 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX4 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX5 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX6 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX7 MUX", "AIF1_PB", "AIF1 PB"}, |
| {"SLIM RX8 MUX", "AIF1_PB", "AIF1 PB"}, |
| /* SLIM_MUX("AIF2_PB", "AIF2 PB"),*/ |
| {"SLIM RX1 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX2 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX3 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX4 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX5 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX6 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX7 MUX", "AIF2_PB", "AIF2 PB"}, |
| {"SLIM RX8 MUX", "AIF2_PB", "AIF2 PB"}, |
| /* SLIM_MUX("AIF3_PB", "AIF3 PB"),*/ |
| {"SLIM RX1 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX2 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX3 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX4 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX5 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX6 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX7 MUX", "AIF3_PB", "AIF3 PB"}, |
| {"SLIM RX8 MUX", "AIF3_PB", "AIF3 PB"}, |
| |
| {"SLIM RX1", NULL, "SLIM RX1 MUX"}, |
| {"SLIM RX2", NULL, "SLIM RX2 MUX"}, |
| {"SLIM RX3", NULL, "SLIM RX3 MUX"}, |
| {"SLIM RX4", NULL, "SLIM RX4 MUX"}, |
| {"SLIM RX5", NULL, "SLIM RX5 MUX"}, |
| {"SLIM RX6", NULL, "SLIM RX6 MUX"}, |
| {"SLIM RX7", NULL, "SLIM RX7 MUX"}, |
| {"SLIM RX8", NULL, "SLIM RX8 MUX"}, |
| |
| {"RX1 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX1 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX1 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX1 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX1 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX1 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX1 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX1 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX1 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX1 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX1 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX1 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX1 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX1 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX1 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX1 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX1 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX1 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX1 MIX1 INP3", "RX1", "SLIM RX1"}, |
| {"RX1 MIX1 INP3", "RX2", "SLIM RX2"}, |
| {"RX1 MIX1 INP3", "RX3", "SLIM RX3"}, |
| {"RX1 MIX1 INP3", "RX4", "SLIM RX4"}, |
| {"RX1 MIX1 INP3", "RX5", "SLIM RX5"}, |
| {"RX1 MIX1 INP3", "RX6", "SLIM RX6"}, |
| {"RX1 MIX1 INP3", "RX7", "SLIM RX7"}, |
| {"RX2 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX2 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX2 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX2 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX2 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX2 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX2 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX2 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX2 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX2 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX2 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX2 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX2 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX2 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX2 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX2 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX2 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX2 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX3 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX3 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX3 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX3 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX3 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX3 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX3 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX3 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX3 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX3 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX3 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX3 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX3 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX3 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX3 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX3 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX3 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX3 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX4 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX4 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX4 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX4 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX4 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX4 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX4 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX4 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX4 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX4 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX4 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX4 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX4 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX4 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX4 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX4 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX4 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX4 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX5 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX5 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX5 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX5 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX5 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX5 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX5 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX5 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX5 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX5 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX5 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX5 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX5 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX5 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX5 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX5 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX5 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX5 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX6 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX6 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX6 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX6 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX6 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX6 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX6 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX6 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX6 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX6 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX6 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX6 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX6 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX6 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX6 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX6 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX6 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX6 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX7 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX7 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX7 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX7 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX7 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX7 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX7 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX7 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX7 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX7 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX7 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX7 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX7 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX7 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX7 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX7 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX7 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX7 MIX1 INP2", "IIR2", "IIR2"}, |
| {"RX8 MIX1 INP1", "RX1", "SLIM RX1"}, |
| {"RX8 MIX1 INP1", "RX2", "SLIM RX2"}, |
| {"RX8 MIX1 INP1", "RX3", "SLIM RX3"}, |
| {"RX8 MIX1 INP1", "RX4", "SLIM RX4"}, |
| {"RX8 MIX1 INP1", "RX5", "SLIM RX5"}, |
| {"RX8 MIX1 INP1", "RX6", "SLIM RX6"}, |
| {"RX8 MIX1 INP1", "RX7", "SLIM RX7"}, |
| {"RX8 MIX1 INP1", "RX8", "SLIM RX8"}, |
| {"RX8 MIX1 INP1", "IIR1", "IIR1"}, |
| {"RX8 MIX1 INP1", "IIR2", "IIR2"}, |
| {"RX8 MIX1 INP2", "RX1", "SLIM RX1"}, |
| {"RX8 MIX1 INP2", "RX2", "SLIM RX2"}, |
| {"RX8 MIX1 INP2", "RX3", "SLIM RX3"}, |
| {"RX8 MIX1 INP2", "RX4", "SLIM RX4"}, |
| {"RX8 MIX1 INP2", "RX5", "SLIM RX5"}, |
| {"RX8 MIX1 INP2", "RX6", "SLIM RX6"}, |
| {"RX8 MIX1 INP2", "RX7", "SLIM RX7"}, |
| {"RX8 MIX1 INP2", "RX8", "SLIM RX8"}, |
| {"RX8 MIX1 INP2", "IIR1", "IIR1"}, |
| {"RX8 MIX1 INP2", "IIR2", "IIR2"}, |
| |
| /* IIR1, IIR2 inputs to Second RX Mixer on RX1, RX2 and RX7 chains. */ |
| {"RX1 MIX2 INP1", "IIR1", "IIR1"}, |
| {"RX1 MIX2 INP2", "IIR1", "IIR1"}, |
| {"RX2 MIX2 INP1", "IIR1", "IIR1"}, |
| {"RX2 MIX2 INP2", "IIR1", "IIR1"}, |
| {"RX7 MIX2 INP1", "IIR1", "IIR1"}, |
| {"RX7 MIX2 INP2", "IIR1", "IIR1"}, |
| {"RX1 MIX2 INP1", "IIR2", "IIR2"}, |
| {"RX1 MIX2 INP2", "IIR2", "IIR2"}, |
| {"RX2 MIX2 INP1", "IIR2", "IIR2"}, |
| {"RX2 MIX2 INP2", "IIR2", "IIR2"}, |
| {"RX7 MIX2 INP1", "IIR2", "IIR2"}, |
| {"RX7 MIX2 INP2", "IIR2", "IIR2"}, |
| |
| /* Decimator Inputs */ |
| {"DEC1 MUX", "DMIC1", "DMIC1"}, |
| {"DEC1 MUX", "ADC6", "ADC6"}, |
| {"DEC1 MUX", NULL, "CDC_CONN"}, |
| {"DEC2 MUX", "DMIC2", "DMIC2"}, |
| {"DEC2 MUX", "ADC5", "ADC5"}, |
| {"DEC2 MUX", NULL, "CDC_CONN"}, |
| {"DEC3 MUX", "DMIC3", "DMIC3"}, |
| {"DEC3 MUX", "ADC4", "ADC4"}, |
| {"DEC3 MUX", NULL, "CDC_CONN"}, |
| {"DEC4 MUX", "DMIC4", "DMIC4"}, |
| {"DEC4 MUX", "ADC3", "ADC3"}, |
| {"DEC4 MUX", NULL, "CDC_CONN"}, |
| {"DEC5 MUX", "DMIC5", "DMIC5"}, |
| {"DEC5 MUX", "ADC2", "ADC2"}, |
| {"DEC5 MUX", NULL, "CDC_CONN"}, |
| {"DEC6 MUX", "DMIC6", "DMIC6"}, |
| {"DEC6 MUX", "ADC1", "ADC1"}, |
| {"DEC6 MUX", NULL, "CDC_CONN"}, |
| {"DEC7 MUX", "DMIC1", "DMIC1"}, |
| {"DEC7 MUX", "DMIC6", "DMIC6"}, |
| {"DEC7 MUX", "ADC1", "ADC1"}, |
| {"DEC7 MUX", "ADC6", "ADC6"}, |
| {"DEC7 MUX", "ANC1_FB", "ANC1 MUX"}, |
| {"DEC7 MUX", "ANC2_FB", "ANC2 MUX"}, |
| {"DEC7 MUX", NULL, "CDC_CONN"}, |
| {"DEC8 MUX", "DMIC2", "DMIC2"}, |
| {"DEC8 MUX", "DMIC5", "DMIC5"}, |
| {"DEC8 MUX", "ADC2", "ADC2"}, |
| {"DEC8 MUX", "ADC5", "ADC5"}, |
| {"DEC8 MUX", "ANC1_FB", "ANC1 MUX"}, |
| {"DEC8 MUX", "ANC2_FB", "ANC2 MUX"}, |
| {"DEC8 MUX", NULL, "CDC_CONN"}, |
| {"DEC9 MUX", "DMIC4", "DMIC4"}, |
| {"DEC9 MUX", "DMIC5", "DMIC5"}, |
| {"DEC9 MUX", "ADC2", "ADC2"}, |
| {"DEC9 MUX", "ADC3", "ADC3"}, |
| {"DEC9 MUX", "ANC1_FB", "ANC1 MUX"}, |
| {"DEC9 MUX", "ANC2_FB", "ANC2 MUX"}, |
| {"DEC9 MUX", NULL, "CDC_CONN"}, |
| {"DEC10 MUX", "DMIC3", "DMIC3"}, |
| {"DEC10 MUX", "DMIC6", "DMIC6"}, |
| {"DEC10 MUX", "ADC1", "ADC1"}, |
| {"DEC10 MUX", "ADC4", "ADC4"}, |
| {"DEC10 MUX", "ANC1_FB", "ANC1 MUX"}, |
| {"DEC10 MUX", "ANC2_FB", "ANC2 MUX"}, |
| {"DEC10 MUX", NULL, "CDC_CONN"}, |
| |
| /* ADC Connections */ |
| {"ADC1", NULL, "AMIC1"}, |
| {"ADC2", NULL, "AMIC2"}, |
| {"ADC3", NULL, "AMIC3"}, |
| {"ADC4", NULL, "AMIC4"}, |
| {"ADC5", NULL, "AMIC5"}, |
| {"ADC6", NULL, "AMIC6"}, |
| |
| /* AUX PGA Connections */ |
| {"EAR_PA_MIXER", "AUX_PGA_L Switch", "AUX_PGA_Left"}, |
| {"HPHL_PA_MIXER", "AUX_PGA_L Switch", "AUX_PGA_Left"}, |
| {"HPHR_PA_MIXER", "AUX_PGA_R Switch", "AUX_PGA_Right"}, |
| {"LINEOUT1_PA_MIXER", "AUX_PGA_L Switch", "AUX_PGA_Left"}, |
| {"LINEOUT2_PA_MIXER", "AUX_PGA_R Switch", "AUX_PGA_Right"}, |
| {"LINEOUT3_PA_MIXER", "AUX_PGA_L Switch", "AUX_PGA_Left"}, |
| {"LINEOUT4_PA_MIXER", "AUX_PGA_R Switch", "AUX_PGA_Right"}, |
| {"AUX_PGA_Left", NULL, "AMIC5"}, |
| {"AUX_PGA_Right", NULL, "AMIC6"}, |
| |
| {"IIR1", NULL, "IIR1 INP1 MUX"}, |
| {"IIR1 INP1 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR1 INP1 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR1 INP1 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR1 INP1 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR1 INP1 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR1 INP1 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR1 INP1 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR1 INP1 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR1 INP1 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR1 INP1 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR1 INP1 MUX", "RX1", "SLIM RX1"}, |
| {"IIR1 INP1 MUX", "RX2", "SLIM RX2"}, |
| {"IIR1 INP1 MUX", "RX3", "SLIM RX3"}, |
| {"IIR1 INP1 MUX", "RX4", "SLIM RX4"}, |
| {"IIR1 INP1 MUX", "RX5", "SLIM RX5"}, |
| {"IIR1 INP1 MUX", "RX6", "SLIM RX6"}, |
| {"IIR1 INP1 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR2", NULL, "IIR2 INP1 MUX"}, |
| {"IIR2 INP1 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR2 INP1 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR2 INP1 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR2 INP1 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR2 INP1 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR2 INP1 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR2 INP1 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR2 INP1 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR2 INP1 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR2 INP1 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR2 INP1 MUX", "RX1", "SLIM RX1"}, |
| {"IIR2 INP1 MUX", "RX2", "SLIM RX2"}, |
| {"IIR2 INP1 MUX", "RX3", "SLIM RX3"}, |
| {"IIR2 INP1 MUX", "RX4", "SLIM RX4"}, |
| {"IIR2 INP1 MUX", "RX5", "SLIM RX5"}, |
| {"IIR2 INP1 MUX", "RX6", "SLIM RX6"}, |
| {"IIR2 INP1 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR1", NULL, "IIR1 INP2 MUX"}, |
| {"IIR1 INP2 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR1 INP2 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR1 INP2 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR1 INP2 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR1 INP2 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR1 INP2 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR1 INP2 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR1 INP2 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR1 INP2 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR1 INP2 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR1 INP2 MUX", "RX1", "SLIM RX1"}, |
| {"IIR1 INP2 MUX", "RX2", "SLIM RX2"}, |
| {"IIR1 INP2 MUX", "RX3", "SLIM RX3"}, |
| {"IIR1 INP2 MUX", "RX4", "SLIM RX4"}, |
| {"IIR1 INP2 MUX", "RX5", "SLIM RX5"}, |
| {"IIR1 INP2 MUX", "RX6", "SLIM RX6"}, |
| {"IIR1 INP2 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR2", NULL, "IIR2 INP2 MUX"}, |
| {"IIR2 INP2 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR2 INP2 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR2 INP2 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR2 INP2 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR2 INP2 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR2 INP2 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR2 INP2 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR2 INP2 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR2 INP2 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR2 INP2 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR2 INP2 MUX", "RX1", "SLIM RX1"}, |
| {"IIR2 INP2 MUX", "RX2", "SLIM RX2"}, |
| {"IIR2 INP2 MUX", "RX3", "SLIM RX3"}, |
| {"IIR2 INP2 MUX", "RX4", "SLIM RX4"}, |
| {"IIR2 INP2 MUX", "RX5", "SLIM RX5"}, |
| {"IIR2 INP2 MUX", "RX6", "SLIM RX6"}, |
| {"IIR2 INP2 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR1", NULL, "IIR1 INP3 MUX"}, |
| {"IIR1 INP3 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR1 INP3 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR1 INP3 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR1 INP3 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR1 INP3 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR1 INP3 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR1 INP3 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR1 INP3 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR1 INP3 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR1 INP3 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR1 INP3 MUX", "RX1", "SLIM RX1"}, |
| {"IIR1 INP3 MUX", "RX2", "SLIM RX2"}, |
| {"IIR1 INP3 MUX", "RX3", "SLIM RX3"}, |
| {"IIR1 INP3 MUX", "RX4", "SLIM RX4"}, |
| {"IIR1 INP3 MUX", "RX5", "SLIM RX5"}, |
| {"IIR1 INP3 MUX", "RX6", "SLIM RX6"}, |
| {"IIR1 INP3 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR2", NULL, "IIR2 INP3 MUX"}, |
| {"IIR2 INP3 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR2 INP3 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR2 INP3 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR2 INP3 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR2 INP3 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR2 INP3 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR2 INP3 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR2 INP3 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR2 INP3 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR2 INP3 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR2 INP3 MUX", "RX1", "SLIM RX1"}, |
| {"IIR2 INP3 MUX", "RX2", "SLIM RX2"}, |
| {"IIR2 INP3 MUX", "RX3", "SLIM RX3"}, |
| {"IIR2 INP3 MUX", "RX4", "SLIM RX4"}, |
| {"IIR2 INP3 MUX", "RX5", "SLIM RX5"}, |
| {"IIR2 INP3 MUX", "RX6", "SLIM RX6"}, |
| {"IIR2 INP3 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR1", NULL, "IIR1 INP4 MUX"}, |
| {"IIR1 INP4 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR1 INP4 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR1 INP4 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR1 INP4 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR1 INP4 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR1 INP4 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR1 INP4 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR1 INP4 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR1 INP4 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR1 INP4 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR1 INP4 MUX", "RX1", "SLIM RX1"}, |
| {"IIR1 INP4 MUX", "RX2", "SLIM RX2"}, |
| {"IIR1 INP4 MUX", "RX3", "SLIM RX3"}, |
| {"IIR1 INP4 MUX", "RX4", "SLIM RX4"}, |
| {"IIR1 INP4 MUX", "RX5", "SLIM RX5"}, |
| {"IIR1 INP4 MUX", "RX6", "SLIM RX6"}, |
| {"IIR1 INP4 MUX", "RX7", "SLIM RX7"}, |
| |
| {"IIR2", NULL, "IIR2 INP4 MUX"}, |
| {"IIR2 INP4 MUX", "DEC1", "DEC1 MUX"}, |
| {"IIR2 INP4 MUX", "DEC2", "DEC2 MUX"}, |
| {"IIR2 INP4 MUX", "DEC3", "DEC3 MUX"}, |
| {"IIR2 INP4 MUX", "DEC4", "DEC4 MUX"}, |
| {"IIR2 INP4 MUX", "DEC5", "DEC5 MUX"}, |
| {"IIR2 INP4 MUX", "DEC6", "DEC6 MUX"}, |
| {"IIR2 INP4 MUX", "DEC7", "DEC7 MUX"}, |
| {"IIR2 INP4 MUX", "DEC8", "DEC8 MUX"}, |
| {"IIR2 INP4 MUX", "DEC9", "DEC9 MUX"}, |
| {"IIR2 INP4 MUX", "DEC10", "DEC10 MUX"}, |
| {"IIR2 INP4 MUX", "RX1", "SLIM RX1"}, |
| {"IIR2 INP4 MUX", "RX2", "SLIM RX2"}, |
| {"IIR2 INP4 MUX", "RX3", "SLIM RX3"}, |
| {"IIR2 INP4 MUX", "RX4", "SLIM RX4"}, |
| {"IIR2 INP4 MUX", "RX5", "SLIM RX5"}, |
| {"IIR2 INP4 MUX", "RX6", "SLIM RX6"}, |
| {"IIR2 INP4 MUX", "RX7", "SLIM RX7"}, |
| |
| {"MIC BIAS1 Internal1", NULL, "LDO_H"}, |
| {"MIC BIAS1 Internal2", NULL, "LDO_H"}, |
| {"MIC BIAS1 External", NULL, "LDO_H"}, |
| {"MIC BIAS2 Internal1", NULL, "LDO_H"}, |
| {"MIC BIAS2 Internal2", NULL, "LDO_H"}, |
| {"MIC BIAS2 Internal3", NULL, "LDO_H"}, |
| {"MIC BIAS2 External", NULL, "LDO_H"}, |
| {"MIC BIAS3 Internal1", NULL, "LDO_H"}, |
| {"MIC BIAS3 Internal2", NULL, "LDO_H"}, |
| {"MIC BIAS3 External", NULL, "LDO_H"}, |
| {"MIC BIAS4 External", NULL, "LDO_H"}, |
| {DAPM_MICBIAS2_EXTERNAL_STANDALONE, NULL, "LDO_H Standalone"}, |
| }; |
| |
| static int tomtom_startup(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| pr_debug("%s(): substream = %s stream = %d\n", __func__, |
| substream->name, substream->stream); |
| |
| return 0; |
| } |
| |
| static void tomtom_shutdown(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| pr_debug("%s(): substream = %s stream = %d\n", __func__, |
| substream->name, substream->stream); |
| } |
| |
| int tomtom_mclk_enable(struct snd_soc_codec *codec, int mclk_enable, bool dapm) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s: mclk_enable = %u, dapm = %d\n", __func__, mclk_enable, |
| dapm); |
| |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| if (mclk_enable) { |
| wcd9xxx_resmgr_get_bandgap(&tomtom->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| wcd9xxx_resmgr_get_clk_block(&tomtom->resmgr, WCD9XXX_CLK_MCLK); |
| } else { |
| /* Put clock and BG */ |
| wcd9xxx_resmgr_put_clk_block(&tomtom->resmgr, WCD9XXX_CLK_MCLK); |
| wcd9xxx_resmgr_put_bandgap(&tomtom->resmgr, |
| WCD9XXX_BANDGAP_AUDIO_MODE); |
| } |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| |
| return 0; |
| } |
| |
| static int tomtom_set_dai_sysclk(struct snd_soc_dai *dai, |
| int clk_id, unsigned int freq, int dir) |
| { |
| pr_debug("%s\n", __func__); |
| return 0; |
| } |
| |
| static int tomtom_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt) |
| { |
| u8 val = 0; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(dai->codec); |
| |
| pr_debug("%s\n", __func__); |
| switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { |
| case SND_SOC_DAIFMT_CBS_CFS: |
| /* CPU is master */ |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_I2C) { |
| if (dai->id == AIF1_CAP) |
| snd_soc_update_bits(dai->codec, |
| TOMTOM_A_CDC_CLK_TX_I2S_CTL, |
| TOMTOM_I2S_MASTER_MODE_MASK, 0); |
| else if (dai->id == AIF1_PB) |
| snd_soc_update_bits(dai->codec, |
| TOMTOM_A_CDC_CLK_RX_I2S_CTL, |
| TOMTOM_I2S_MASTER_MODE_MASK, 0); |
| } |
| break; |
| case SND_SOC_DAIFMT_CBM_CFM: |
| /* CPU is slave */ |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_I2C) { |
| val = TOMTOM_I2S_MASTER_MODE_MASK; |
| if (dai->id == AIF1_CAP) |
| snd_soc_update_bits(dai->codec, |
| TOMTOM_A_CDC_CLK_TX_I2S_CTL, val, val); |
| else if (dai->id == AIF1_PB) |
| snd_soc_update_bits(dai->codec, |
| TOMTOM_A_CDC_CLK_RX_I2S_CTL, val, val); |
| } |
| break; |
| default: |
| return -EINVAL; |
| } |
| return 0; |
| } |
| |
| static int tomtom_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 wcd9xxx_codec_dai_data *dai_data = NULL; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(dai->codec); |
| struct wcd9xxx *core = dev_get_drvdata(dai->codec->dev->parent); |
| |
| if (!tx_slot || !rx_slot) { |
| pr_err("%s: Invalid tx_slot=%pK, rx_slot=%pK\n", |
| __func__, tx_slot, rx_slot); |
| return -EINVAL; |
| } |
| pr_debug("%s(): dai_name = %s DAI-ID %x tx_ch %d rx_ch %d\n" |
| "tomtom->intf_type %d\n", |
| __func__, dai->name, dai->id, tx_num, rx_num, |
| tomtom->intf_type); |
| |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_SLIMBUS) { |
| wcd9xxx_init_slimslave(core, core->slim->laddr, |
| tx_num, tx_slot, rx_num, rx_slot); |
| /*Reserve tx11 and tx12 for VI feedback path*/ |
| dai_data = &tomtom->dai[AIF4_VIFEED]; |
| if (dai_data) { |
| list_add_tail(&core->tx_chs[TOMTOM_TX11].list, |
| &dai_data->wcd9xxx_ch_list); |
| list_add_tail(&core->tx_chs[TOMTOM_TX12].list, |
| &dai_data->wcd9xxx_ch_list); |
| } |
| |
| /* Reserve TX13 for MAD data channel */ |
| dai_data = &tomtom->dai[AIF4_MAD_TX]; |
| if (dai_data) |
| list_add_tail(&core->tx_chs[TOMTOM_TX13].list, |
| &dai_data->wcd9xxx_ch_list); |
| } |
| |
| return 0; |
| } |
| |
| static int tomtom_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 tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(dai->codec); |
| u32 i = 0; |
| struct wcd9xxx_ch *ch; |
| |
| switch (dai->id) { |
| case AIF1_PB: |
| case AIF2_PB: |
| case AIF3_PB: |
| if (!rx_slot || !rx_num) { |
| pr_err("%s: Invalid rx_slot %pK or rx_num %pK\n", |
| __func__, rx_slot, rx_num); |
| return -EINVAL; |
| } |
| list_for_each_entry(ch, &tomtom_p->dai[dai->id].wcd9xxx_ch_list, |
| list) { |
| pr_debug("%s: slot_num %u ch->ch_num %d\n", |
| __func__, i, ch->ch_num); |
| rx_slot[i++] = ch->ch_num; |
| } |
| pr_debug("%s: rx_num %d\n", __func__, i); |
| *rx_num = i; |
| break; |
| case AIF1_CAP: |
| case AIF2_CAP: |
| case AIF3_CAP: |
| case AIF4_VIFEED: |
| case AIF4_MAD_TX: |
| if (!tx_slot || !tx_num) { |
| pr_err("%s: Invalid tx_slot %pK or tx_num %pK\n", |
| __func__, tx_slot, tx_num); |
| return -EINVAL; |
| } |
| list_for_each_entry(ch, &tomtom_p->dai[dai->id].wcd9xxx_ch_list, |
| list) { |
| pr_debug("%s: slot_num %u ch->ch_num %d\n", |
| __func__, i, ch->ch_num); |
| tx_slot[i++] = ch->ch_num; |
| } |
| pr_debug("%s: tx_num %d\n", __func__, i); |
| *tx_num = i; |
| break; |
| |
| default: |
| pr_err("%s: Invalid DAI ID %x\n", __func__, dai->id); |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int tomtom_set_interpolator_rate(struct snd_soc_dai *dai, |
| u8 rx_fs_rate_reg_val, u32 compander_fs, u32 sample_rate) |
| { |
| u32 j; |
| u8 rx_mix1_inp, rx8_mix1_inp; |
| u16 rx_mix_1_reg_1, rx_mix_1_reg_2; |
| u16 rx_fs_reg; |
| u8 rx_mix_1_reg_1_val, rx_mix_1_reg_2_val; |
| struct snd_soc_codec *codec = dai->codec; |
| struct wcd9xxx_ch *ch; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| int port_rx_8 = TOMTOM_RX_PORT_START_NUMBER + NUM_INTERPOLATORS - 1; |
| |
| list_for_each_entry(ch, &tomtom->dai[dai->id].wcd9xxx_ch_list, list) { |
| /* for RX port starting from 16 instead of 10 like tabla */ |
| rx_mix1_inp = ch->port + RX_MIX1_INP_SEL_RX1 - |
| TOMTOM_TX_PORT_NUMBER; |
| rx8_mix1_inp = ch->port + RX8_MIX1_INP_SEL_RX1 - |
| TOMTOM_RX_PORT_START_NUMBER; |
| if (((ch->port < port_rx_8) && |
| ((rx_mix1_inp < RX_MIX1_INP_SEL_RX1) || |
| (rx_mix1_inp > RX_MIX1_INP_SEL_RX7))) || |
| ((rx8_mix1_inp < RX8_MIX1_INP_SEL_RX1) || |
| (rx8_mix1_inp > RX8_MIX1_INP_SEL_RX8))) { |
| pr_err("%s: Invalid TOMTOM_RX%u port. Dai ID is %d\n", |
| __func__, rx8_mix1_inp - 2, |
| dai->id); |
| return -EINVAL; |
| } |
| |
| rx_mix_1_reg_1 = TOMTOM_A_CDC_CONN_RX1_B1_CTL; |
| |
| for (j = 0; j < NUM_INTERPOLATORS - 1; j++) { |
| rx_mix_1_reg_2 = rx_mix_1_reg_1 + 1; |
| |
| rx_mix_1_reg_1_val = snd_soc_read(codec, |
| rx_mix_1_reg_1); |
| rx_mix_1_reg_2_val = snd_soc_read(codec, |
| rx_mix_1_reg_2); |
| |
| if (((rx_mix_1_reg_1_val & 0x0F) == rx_mix1_inp) || |
| (((rx_mix_1_reg_1_val >> 4) & 0x0F) |
| == rx_mix1_inp) || |
| ((rx_mix_1_reg_2_val & 0x0F) == rx_mix1_inp)) { |
| |
| rx_fs_reg = TOMTOM_A_CDC_RX1_B5_CTL + 8 * j; |
| |
| pr_debug("%s: AIF_PB DAI(%d) connected to RX%u\n", |
| __func__, dai->id, j + 1); |
| |
| pr_debug("%s: set RX%u sample rate to %u\n", |
| __func__, j + 1, sample_rate); |
| |
| snd_soc_update_bits(codec, rx_fs_reg, |
| 0xE0, rx_fs_rate_reg_val); |
| |
| if (comp_rx_path[j] < COMPANDER_MAX) |
| tomtom->comp_fs[comp_rx_path[j]] |
| = compander_fs; |
| } |
| if (j < 2) |
| rx_mix_1_reg_1 += 3; |
| else |
| rx_mix_1_reg_1 += 2; |
| } |
| |
| /* RX8 interpolator path */ |
| rx_mix_1_reg_1_val = snd_soc_read(codec, |
| TOMTOM_A_CDC_CONN_RX8_B1_CTL); |
| if (((rx_mix_1_reg_1_val & 0x0F) == rx8_mix1_inp) || |
| (((rx_mix_1_reg_1_val >> 4) & 0x0F) == rx8_mix1_inp)) { |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_RX8_B5_CTL, |
| 0xE0, rx_fs_rate_reg_val); |
| pr_debug("%s: AIF_PB DAI(%d) connected to RX%u\n", |
| __func__, dai->id, NUM_INTERPOLATORS); |
| |
| pr_debug("%s: set RX%u sample rate to %u\n", |
| __func__, NUM_INTERPOLATORS, |
| sample_rate); |
| if (comp_rx_path[NUM_INTERPOLATORS - 1] < COMPANDER_MAX) |
| tomtom->comp_fs[comp_rx_path[j]] = |
| compander_fs; |
| } |
| } |
| return 0; |
| } |
| |
| static int tomtom_set_decimator_rate(struct snd_soc_dai *dai, |
| u8 tx_fs_rate_reg_val, u32 sample_rate) |
| { |
| struct snd_soc_codec *codec = dai->codec; |
| struct wcd9xxx_ch *ch; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| u32 tx_port; |
| u16 tx_port_reg, tx_fs_reg; |
| u8 tx_port_reg_val; |
| s8 decimator; |
| |
| list_for_each_entry(ch, &tomtom->dai[dai->id].wcd9xxx_ch_list, list) { |
| |
| tx_port = ch->port + 1; |
| pr_debug("%s: dai->id = %d, tx_port = %d", |
| __func__, dai->id, tx_port); |
| |
| if ((tx_port < 1) || (tx_port > NUM_DECIMATORS)) { |
| pr_err("%s: Invalid SLIM TX%u port. DAI ID is %d\n", |
| __func__, tx_port, dai->id); |
| return -EINVAL; |
| } |
| |
| tx_port_reg = TOMTOM_A_CDC_CONN_TX_SB_B1_CTL + (tx_port - 1); |
| tx_port_reg_val = snd_soc_read(codec, tx_port_reg); |
| |
| decimator = 0; |
| |
| if ((tx_port >= 1) && (tx_port <= 6)) { |
| |
| tx_port_reg_val = tx_port_reg_val & 0x0F; |
| if (tx_port_reg_val == 0x8) |
| decimator = tx_port; |
| |
| } else if ((tx_port >= 7) && (tx_port <= NUM_DECIMATORS)) { |
| |
| tx_port_reg_val = tx_port_reg_val & 0x1F; |
| |
| if ((tx_port_reg_val >= 0x8) && |
| (tx_port_reg_val <= 0x11)) { |
| |
| decimator = (tx_port_reg_val - 0x8) + 1; |
| } |
| } |
| |
| if (decimator) { /* SLIM_TX port has a DEC as input */ |
| |
| tx_fs_reg = TOMTOM_A_CDC_TX1_CLK_FS_CTL + |
| 8 * (decimator - 1); |
| |
| pr_debug("%s: set DEC%u (-> SLIM_TX%u) rate to %u\n", |
| __func__, decimator, tx_port, sample_rate); |
| |
| snd_soc_update_bits(codec, tx_fs_reg, 0x07, |
| tx_fs_rate_reg_val); |
| |
| } else { |
| if ((tx_port_reg_val >= 0x1) && |
| (tx_port_reg_val <= 0x7)) { |
| |
| pr_debug("%s: RMIX%u going to SLIM TX%u\n", |
| __func__, tx_port_reg_val, tx_port); |
| |
| } else if ((tx_port_reg_val >= 0x8) && |
| (tx_port_reg_val <= 0x11)) { |
| |
| pr_err("%s: ERROR: Should not be here\n", |
| __func__); |
| pr_err("%s: ERROR: DEC connected to SLIM TX%u\n", |
| __func__, tx_port); |
| return -EINVAL; |
| |
| } else if (tx_port_reg_val == 0) { |
| pr_debug("%s: no signal to SLIM TX%u\n", |
| __func__, tx_port); |
| } else { |
| pr_err("%s: ERROR: wrong signal to SLIM TX%u\n", |
| __func__, tx_port); |
| pr_err("%s: ERROR: wrong signal = %u\n", |
| __func__, tx_port_reg_val); |
| return -EINVAL; |
| } |
| } |
| } |
| return 0; |
| } |
| |
| static void tomtom_set_rxsb_port_format(struct snd_pcm_hw_params *params, |
| struct snd_soc_dai *dai) |
| { |
| struct snd_soc_codec *codec = dai->codec; |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_codec_dai_data *cdc_dai; |
| struct wcd9xxx_ch *ch; |
| int port; |
| u8 bit_sel; |
| u16 sb_ctl_reg, field_shift; |
| |
| switch (params_width(params)) { |
| case 16: |
| bit_sel = 0x2; |
| tomtom_p->dai[dai->id].bit_width = 16; |
| break; |
| case 24: |
| bit_sel = 0x0; |
| tomtom_p->dai[dai->id].bit_width = 24; |
| break; |
| default: |
| dev_err(codec->dev, "Invalid format\n"); |
| return; |
| } |
| |
| cdc_dai = &tomtom_p->dai[dai->id]; |
| |
| list_for_each_entry(ch, &cdc_dai->wcd9xxx_ch_list, list) { |
| port = wcd9xxx_get_slave_port(ch->ch_num); |
| if (port < 0 || |
| !TOMTOM_VALIDATE_RX_SBPORT_RANGE(port)) { |
| dev_warn(codec->dev, |
| "%s: invalid port ID %d returned for RX DAI\n", |
| __func__, port); |
| return; |
| } |
| |
| port = TOMTOM_CONVERT_RX_SBPORT_ID(port); |
| |
| if (port <= 3) { |
| sb_ctl_reg = TOMTOM_A_CDC_CONN_RX_SB_B1_CTL; |
| field_shift = port << 1; |
| } else if (port <= 7) { |
| sb_ctl_reg = TOMTOM_A_CDC_CONN_RX_SB_B2_CTL; |
| field_shift = (port - 4) << 1; |
| } else { /* should not happen */ |
| dev_warn(codec->dev, |
| "%s: bad port ID %d\n", __func__, port); |
| return; |
| } |
| |
| dev_dbg(codec->dev, "%s: sb_ctl_reg %x field_shift %x\n", |
| __func__, sb_ctl_reg, field_shift); |
| snd_soc_update_bits(codec, sb_ctl_reg, 0x3 << field_shift, |
| bit_sel << field_shift); |
| } |
| } |
| |
| static void tomtom_set_tx_sb_port_format(struct snd_pcm_hw_params *params, |
| struct snd_soc_dai *dai) |
| { |
| struct snd_soc_codec *codec = dai->codec; |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_codec_dai_data *cdc_dai; |
| struct wcd9xxx_ch *ch; |
| int port; |
| u8 bit_sel, bit_shift; |
| u16 sb_ctl_reg; |
| |
| switch (params_width(params)) { |
| case 16: |
| bit_sel = 0x2; |
| tomtom_p->dai[dai->id].bit_width = 16; |
| break; |
| case 24: |
| bit_sel = 0x0; |
| tomtom_p->dai[dai->id].bit_width = 24; |
| break; |
| default: |
| dev_err(codec->dev, "%s: Invalid format %d\n", __func__, |
| params_width(params)); |
| return; |
| } |
| |
| cdc_dai = &tomtom_p->dai[dai->id]; |
| |
| list_for_each_entry(ch, &cdc_dai->wcd9xxx_ch_list, list) { |
| port = wcd9xxx_get_slave_port(ch->ch_num); |
| if (port < 0 || |
| !TOMTOM_VALIDATE_TX_SBPORT_RANGE(port)) { |
| dev_warn(codec->dev, |
| "%s: invalid port ID %d returned for TX DAI\n", |
| __func__, port); |
| return; |
| } |
| |
| if (port < 6) /* 6 = SLIMBUS TX7 */ |
| bit_shift = TOMTOM_BIT_ADJ_SHIFT_PORT1_6; |
| else if (port < 10) |
| bit_shift = TOMTOM_BIT_ADJ_SHIFT_PORT7_10; |
| else { |
| dev_warn(codec->dev, |
| "%s: port ID %d bitwidth is fixed\n", |
| __func__, port); |
| return; |
| } |
| |
| sb_ctl_reg = (TOMTOM_A_CDC_CONN_TX_SB_B1_CTL + port); |
| |
| dev_dbg(codec->dev, "%s: reg %x bit_sel %x bit_shift %x\n", |
| __func__, sb_ctl_reg, bit_sel, bit_shift); |
| snd_soc_update_bits(codec, sb_ctl_reg, 0x3 << |
| bit_shift, bit_sel << bit_shift); |
| } |
| } |
| |
| static int tomtom_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 tomtom_priv *tomtom = snd_soc_codec_get_drvdata(dai->codec); |
| u8 tx_fs_rate, rx_fs_rate, i2s_bit_mode; |
| u32 compander_fs; |
| int ret; |
| |
| pr_debug("%s: dai_name = %s DAI-ID %x rate %d num_ch %d\n", __func__, |
| dai->name, dai->id, params_rate(params), |
| params_channels(params)); |
| |
| switch (params_rate(params)) { |
| case 8000: |
| tx_fs_rate = 0x00; |
| rx_fs_rate = 0x00; |
| compander_fs = COMPANDER_FS_8KHZ; |
| break; |
| case 16000: |
| tx_fs_rate = 0x01; |
| rx_fs_rate = 0x20; |
| compander_fs = COMPANDER_FS_16KHZ; |
| break; |
| case 32000: |
| tx_fs_rate = 0x02; |
| rx_fs_rate = 0x40; |
| compander_fs = COMPANDER_FS_32KHZ; |
| break; |
| case 48000: |
| tx_fs_rate = 0x03; |
| rx_fs_rate = 0x60; |
| compander_fs = COMPANDER_FS_48KHZ; |
| break; |
| case 96000: |
| tx_fs_rate = 0x04; |
| rx_fs_rate = 0x80; |
| compander_fs = COMPANDER_FS_96KHZ; |
| break; |
| case 192000: |
| tx_fs_rate = 0x05; |
| rx_fs_rate = 0xA0; |
| compander_fs = COMPANDER_FS_192KHZ; |
| break; |
| default: |
| pr_err("%s: Invalid sampling rate %d\n", __func__, |
| params_rate(params)); |
| return -EINVAL; |
| } |
| |
| switch (substream->stream) { |
| case SNDRV_PCM_STREAM_CAPTURE: |
| if (dai->id != AIF4_VIFEED && |
| dai->id != AIF4_MAD_TX) { |
| ret = tomtom_set_decimator_rate(dai, tx_fs_rate, |
| params_rate(params)); |
| if (ret < 0) { |
| pr_err("%s: set decimator rate failed %d\n", |
| __func__, ret); |
| return ret; |
| } |
| } |
| |
| tomtom->dai[dai->id].rate = params_rate(params); |
| |
| switch (params_format(params)) { |
| case SNDRV_PCM_FORMAT_S16_LE: |
| i2s_bit_mode = 0x01; |
| tomtom->dai[dai->id].bit_width = 16; |
| break; |
| case SNDRV_PCM_FORMAT_S24_LE: |
| tomtom->dai[dai->id].bit_width = 24; |
| i2s_bit_mode = 0x00; |
| break; |
| case SNDRV_PCM_FORMAT_S32_LE: |
| tomtom->dai[dai->id].bit_width = 32; |
| i2s_bit_mode = 0x00; |
| break; |
| default: |
| dev_err(codec->dev, |
| "%s: Invalid format 0x%x\n", |
| __func__, params_format(params)); |
| return -EINVAL; |
| } |
| |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_I2C) { |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_TX_I2S_CTL, |
| 0x20, i2s_bit_mode << 5); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_TX_I2S_CTL, |
| 0x07, tx_fs_rate); |
| } else { |
| /* only generic ports can have sample bit adjustment */ |
| if (dai->id != AIF4_VIFEED && |
| dai->id != AIF4_MAD_TX) |
| tomtom_set_tx_sb_port_format(params, dai); |
| } |
| |
| break; |
| |
| case SNDRV_PCM_STREAM_PLAYBACK: |
| ret = tomtom_set_interpolator_rate(dai, rx_fs_rate, |
| compander_fs, |
| params_rate(params)); |
| if (ret < 0) { |
| pr_err("%s: set decimator rate failed %d\n", __func__, |
| ret); |
| return ret; |
| } |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_I2C) { |
| switch (params_format(params)) { |
| case SNDRV_PCM_FORMAT_S16_LE: |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_RX_I2S_CTL, |
| 0x20, 0x20); |
| break; |
| case SNDRV_PCM_FORMAT_S32_LE: |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_RX_I2S_CTL, |
| 0x20, 0x00); |
| break; |
| default: |
| pr_err("invalid format\n"); |
| break; |
| } |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_RX_I2S_CTL, |
| 0x03, (rx_fs_rate >> 0x05)); |
| } else { |
| tomtom_set_rxsb_port_format(params, dai); |
| tomtom->dai[dai->id].rate = params_rate(params); |
| } |
| break; |
| default: |
| pr_err("%s: Invalid stream type %d\n", __func__, |
| substream->stream); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static struct snd_soc_dai_ops tomtom_dai_ops = { |
| .startup = tomtom_startup, |
| .shutdown = tomtom_shutdown, |
| .hw_params = tomtom_hw_params, |
| .set_sysclk = tomtom_set_dai_sysclk, |
| .set_fmt = tomtom_set_dai_fmt, |
| .set_channel_map = tomtom_set_channel_map, |
| .get_channel_map = tomtom_get_channel_map, |
| }; |
| |
| static struct snd_soc_dai_driver tomtom_dai[] = { |
| { |
| .name = "tomtom_rx1", |
| .id = AIF1_PB, |
| .playback = { |
| .stream_name = "AIF1 Playback", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS_S16_S24_LE, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 2, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_tx1", |
| .id = AIF1_CAP, |
| .capture = { |
| .stream_name = "AIF1 Capture", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 4, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_rx2", |
| .id = AIF2_PB, |
| .playback = { |
| .stream_name = "AIF2 Playback", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS_S16_S24_LE, |
| .rate_min = 8000, |
| .rate_max = 192000, |
| .channels_min = 1, |
| .channels_max = 2, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_tx2", |
| .id = AIF2_CAP, |
| .capture = { |
| .stream_name = "AIF2 Capture", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 8, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_rx3", |
| .id = AIF3_PB, |
| .playback = { |
| .stream_name = "AIF3 Playback", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS_S16_S24_LE, |
| .rate_min = 8000, |
| .rate_max = 192000, |
| .channels_min = 1, |
| .channels_max = 2, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_tx3", |
| .id = AIF3_CAP, |
| .capture = { |
| .stream_name = "AIF3 Capture", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 48000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 2, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_vifeedback", |
| .id = AIF4_VIFEED, |
| .capture = { |
| .stream_name = "VIfeed", |
| .rates = SNDRV_PCM_RATE_48000, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 48000, |
| .rate_min = 48000, |
| .channels_min = 2, |
| .channels_max = 2, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_mad1", |
| .id = AIF4_MAD_TX, |
| .capture = { |
| .stream_name = "AIF4 MAD TX", |
| .rates = SNDRV_PCM_RATE_16000, |
| .formats = TOMTOM_FORMATS_S16_S24_LE, |
| .rate_min = 16000, |
| .rate_max = 16000, |
| .channels_min = 1, |
| .channels_max = 1, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| }; |
| |
| static struct snd_soc_dai_driver tomtom_i2s_dai[] = { |
| { |
| .name = "tomtom_i2s_rx1", |
| .id = AIF1_PB, |
| .playback = { |
| .stream_name = "AIF1 Playback", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 4, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_i2s_tx1", |
| .id = AIF1_CAP, |
| .capture = { |
| .stream_name = "AIF1 Capture", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 4, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_i2s_rx2", |
| .id = AIF1_PB, |
| .playback = { |
| .stream_name = "AIF2 Playback", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 4, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| { |
| .name = "tomtom_i2s_tx2", |
| .id = AIF1_CAP, |
| .capture = { |
| .stream_name = "AIF2 Capture", |
| .rates = WCD9330_RATES, |
| .formats = TOMTOM_FORMATS, |
| .rate_max = 192000, |
| .rate_min = 8000, |
| .channels_min = 1, |
| .channels_max = 4, |
| }, |
| .ops = &tomtom_dai_ops, |
| }, |
| }; |
| |
| static int tomtom_codec_enable_slim_chmask(struct wcd9xxx_codec_dai_data *dai, |
| bool up) |
| { |
| int ret = 0; |
| struct wcd9xxx_ch *ch; |
| |
| if (up) { |
| list_for_each_entry(ch, &dai->wcd9xxx_ch_list, list) { |
| ret = wcd9xxx_get_slave_port(ch->ch_num); |
| if (ret < 0) { |
| pr_err("%s: Invalid slave port ID: %d\n", |
| __func__, ret); |
| ret = -EINVAL; |
| } else { |
| set_bit(ret, &dai->ch_mask); |
| } |
| } |
| } else { |
| ret = wait_event_timeout(dai->dai_wait, (dai->ch_mask == 0), |
| msecs_to_jiffies( |
| TOMTOM_SLIM_CLOSE_TIMEOUT)); |
| if (!ret) { |
| pr_err("%s: Slim close tx/rx wait timeout\n", __func__); |
| ret = -ETIMEDOUT; |
| } else { |
| ret = 0; |
| } |
| } |
| return ret; |
| } |
| |
| static void tomtom_codec_enable_int_port(struct wcd9xxx_codec_dai_data *dai, |
| struct snd_soc_codec *codec) |
| { |
| struct wcd9xxx_ch *ch; |
| struct wcd9xxx *wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| int port_num = 0; |
| unsigned short reg = 0; |
| u8 val = 0; |
| |
| if (!dai || !codec) { |
| pr_err("%s: Invalid params\n", __func__); |
| return; |
| } |
| list_for_each_entry(ch, &dai->wcd9xxx_ch_list, list) { |
| if (ch->port >= TOMTOM_RX_PORT_START_NUMBER) { |
| port_num = ch->port - TOMTOM_RX_PORT_START_NUMBER; |
| reg = TOMTOM_SLIM_PGD_PORT_INT_EN0 + (port_num / 8); |
| val = wcd9xxx_interface_reg_read(wcd9xxx, |
| reg); |
| if (!(val & (1 << (port_num % 8)))) { |
| val |= (1 << (port_num % 8)); |
| wcd9xxx_interface_reg_write( |
| wcd9xxx, reg, val); |
| val = wcd9xxx_interface_reg_read( |
| wcd9xxx, reg); |
| } |
| } else { |
| port_num = ch->port; |
| reg = TOMTOM_SLIM_PGD_PORT_INT_TX_EN0 + (port_num / 8); |
| val = wcd9xxx_interface_reg_read(wcd9xxx, |
| reg); |
| if (!(val & (1 << (port_num % 8)))) { |
| val |= (1 << (port_num % 8)); |
| wcd9xxx_interface_reg_write(wcd9xxx, |
| reg, val); |
| val = wcd9xxx_interface_reg_read( |
| wcd9xxx, reg); |
| } |
| } |
| } |
| } |
| |
| static int tomtom_codec_enable_slimrx(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct wcd9xxx *core; |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| int ret = 0; |
| struct wcd9xxx_codec_dai_data *dai; |
| |
| core = dev_get_drvdata(codec->dev->parent); |
| |
| pr_debug("%s: event called! codec name %s num_dai %d\n" |
| "stream name %s event %d\n", |
| __func__, codec->component.name, |
| codec->component.num_dai, w->sname, event); |
| |
| /* Execute the callback only if interface type is slimbus */ |
| if (tomtom_p->intf_type != WCD9XXX_INTERFACE_TYPE_SLIMBUS) |
| return 0; |
| |
| dai = &tomtom_p->dai[w->shift]; |
| pr_debug("%s: w->name %s w->shift %d event %d\n", |
| __func__, w->name, w->shift, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_POST_PMU: |
| dai->bus_down_in_recovery = false; |
| tomtom_codec_enable_int_port(dai, codec); |
| (void) tomtom_codec_enable_slim_chmask(dai, true); |
| ret = wcd9xxx_cfg_slim_sch_rx(core, &dai->wcd9xxx_ch_list, |
| dai->rate, dai->bit_width, |
| &dai->grph); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| ret = wcd9xxx_close_slim_sch_rx(core, &dai->wcd9xxx_ch_list, |
| dai->grph); |
| if (!dai->bus_down_in_recovery) |
| ret = tomtom_codec_enable_slim_chmask(dai, false); |
| else |
| pr_debug("%s: bus in recovery skip enable slim_chmask", |
| __func__); |
| if (ret < 0) { |
| ret = wcd9xxx_disconnect_port(core, |
| &dai->wcd9xxx_ch_list, |
| dai->grph); |
| pr_debug("%s: Disconnect RX port, ret = %d\n", |
| __func__, ret); |
| } |
| break; |
| } |
| return ret; |
| } |
| |
| static int tomtom_codec_enable_slimvi_feedback(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct wcd9xxx *core = NULL; |
| struct snd_soc_codec *codec = NULL; |
| struct tomtom_priv *tomtom_p = NULL; |
| u32 ret = 0; |
| struct wcd9xxx_codec_dai_data *dai = NULL; |
| |
| if (!w) { |
| pr_err("%s invalid params\n", __func__); |
| return -EINVAL; |
| } |
| codec = snd_soc_dapm_to_codec(w->dapm); |
| tomtom_p = snd_soc_codec_get_drvdata(codec); |
| core = dev_get_drvdata(codec->dev->parent); |
| |
| pr_debug("%s: event called! codec name %s num_dai %d stream name %s\n", |
| __func__, codec->component.name, |
| codec->component.num_dai, w->sname); |
| |
| /* Execute the callback only if interface type is slimbus */ |
| if (tomtom_p->intf_type != WCD9XXX_INTERFACE_TYPE_SLIMBUS) { |
| pr_err("%s Interface is not correct", __func__); |
| return 0; |
| } |
| |
| pr_debug("%s(): w->name %s event %d w->shift %d\n", |
| __func__, w->name, event, w->shift); |
| if (w->shift != AIF4_VIFEED) { |
| pr_err("%s Error in enabling the tx path\n", __func__); |
| ret = -EINVAL; |
| goto out_vi; |
| } |
| dai = &tomtom_p->dai[w->shift]; |
| switch (event) { |
| case SND_SOC_DAPM_POST_PMU: |
| /*Enable V&I sensing*/ |
| snd_soc_update_bits(codec, TOMTOM_A_SPKR1_PROT_EN, |
| 0x88, 0x88); |
| /*Enable spkr VI clocks*/ |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CLK_TX_CLK_EN_B2_CTL, 0xC, 0xC); |
| dai->bus_down_in_recovery = false; |
| tomtom_codec_enable_int_port(dai, codec); |
| (void) tomtom_codec_enable_slim_chmask(dai, true); |
| ret = wcd9xxx_cfg_slim_sch_tx(core, &dai->wcd9xxx_ch_list, |
| dai->rate, dai->bit_width, |
| &dai->grph); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| ret = wcd9xxx_close_slim_sch_tx(core, &dai->wcd9xxx_ch_list, |
| dai->grph); |
| if (ret) |
| pr_err("%s error in close_slim_sch_tx %d\n", |
| __func__, ret); |
| if (!dai->bus_down_in_recovery) |
| ret = tomtom_codec_enable_slim_chmask(dai, false); |
| if (ret < 0) { |
| ret = wcd9xxx_disconnect_port(core, |
| &dai->wcd9xxx_ch_list, |
| dai->grph); |
| pr_debug("%s: Disconnect TX port, ret = %d\n", |
| __func__, ret); |
| } |
| |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CLK_TX_CLK_EN_B2_CTL, |
| 0xC, 0x0); |
| /*Disable V&I sensing*/ |
| snd_soc_update_bits(codec, TOMTOM_A_SPKR1_PROT_EN, |
| 0x88, 0x00); |
| break; |
| } |
| out_vi: |
| return ret; |
| } |
| |
| /* __tomtom_codec_enable_slimtx: Enable the slimbus slave port |
| * for TX path |
| * @codec: Handle to the codec for which the slave port is to be |
| * enabled. |
| * @dai_data: The dai specific data for dai which is enabled. |
| */ |
| static int __tomtom_codec_enable_slimtx(struct snd_soc_codec *codec, |
| int event, struct wcd9xxx_codec_dai_data *dai_data) |
| { |
| struct wcd9xxx *core; |
| int ret = 0; |
| |
| core = dev_get_drvdata(codec->dev->parent); |
| |
| switch (event) { |
| case SND_SOC_DAPM_POST_PMU: |
| dai_data->bus_down_in_recovery = false; |
| tomtom_codec_enable_int_port(dai_data, codec); |
| (void) tomtom_codec_enable_slim_chmask(dai_data, true); |
| ret = wcd9xxx_cfg_slim_sch_tx(core, &dai_data->wcd9xxx_ch_list, |
| dai_data->rate, |
| dai_data->bit_width, |
| &dai_data->grph); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| ret = wcd9xxx_close_slim_sch_tx(core, |
| &dai_data->wcd9xxx_ch_list, |
| dai_data->grph); |
| if (!dai_data->bus_down_in_recovery) |
| ret = tomtom_codec_enable_slim_chmask(dai_data, false); |
| if (ret < 0) { |
| ret = wcd9xxx_disconnect_port(core, |
| &dai_data->wcd9xxx_ch_list, |
| dai_data->grph); |
| dev_dbg(codec->dev, |
| "%s: Disconnect TX port, ret = %d\n", |
| __func__, ret); |
| } |
| break; |
| } |
| |
| return ret; |
| } |
| |
| /* |
| * tomtom_codec_enable_slimtx_mad: Callback function that will be invoked |
| * to setup the slave port for MAD. |
| * @codec: Handle to the codec |
| * @event: Indicates whether to enable or disable the slave port |
| */ |
| static int tomtom_codec_enable_slimtx_mad(struct snd_soc_codec *codec, |
| u8 event) |
| { |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_codec_dai_data *dai; |
| int dapm_event = SND_SOC_DAPM_POST_PMU; |
| |
| dai = &tomtom_p->dai[AIF4_MAD_TX]; |
| |
| if (event == 0) |
| dapm_event = SND_SOC_DAPM_POST_PMD; |
| |
| dev_dbg(codec->dev, |
| "%s: mad_channel, event = 0x%x\n", |
| __func__, event); |
| return __tomtom_codec_enable_slimtx(codec, dapm_event, dai); |
| } |
| |
| /* |
| * tomtom_codec_enable_slimtx: DAPM widget allback for TX widgets |
| * @w: widget for which this callback is invoked |
| * @kcontrol: kcontrol associated with this widget |
| * @event: DAPM supplied event indicating enable/disable |
| */ |
| static int tomtom_codec_enable_slimtx(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx_codec_dai_data *dai; |
| |
| dev_dbg(codec->dev, "%s: event called! codec name %s num_dai %d stream name %s\n", |
| __func__, codec->component.name, |
| codec->component.num_dai, w->sname); |
| |
| /* Execute the callback only if interface type is slimbus */ |
| if (tomtom_p->intf_type != WCD9XXX_INTERFACE_TYPE_SLIMBUS) |
| return 0; |
| |
| dev_dbg(codec->dev, |
| "%s(): w->name %s event %d w->shift %d\n", |
| __func__, w->name, event, w->shift); |
| |
| dai = &tomtom_p->dai[w->shift]; |
| return __tomtom_codec_enable_slimtx(codec, event, dai); |
| } |
| |
| static int tomtom_codec_enable_ear_pa(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s %s %d\n", __func__, w->name, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_POST_PMU: |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_EAR, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| |
| usleep_range(5000, 5100); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_ear_dac_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| struct tomtom_priv *tomtom_p = snd_soc_codec_get_drvdata(codec); |
| |
| pr_debug("%s %s %d\n", __func__, w->name, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_EAR, |
| WCD9XXX_CLSH_REQ_ENABLE, |
| WCD9XXX_CLSH_EVENT_PRE_DAC); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| wcd9xxx_clsh_fsm(codec, &tomtom_p->clsh_d, |
| WCD9XXX_CLSH_STATE_EAR, |
| WCD9XXX_CLSH_REQ_DISABLE, |
| WCD9XXX_CLSH_EVENT_POST_PA); |
| usleep_range(5000, 5100); |
| break; |
| default: |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_set_iir_gain(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| |
| pr_debug("%s: event = %d\n", __func__, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_POST_PMU: /* fall through */ |
| case SND_SOC_DAPM_PRE_PMD: |
| if (strnstr(w->name, "IIR1", sizeof("IIR1"))) { |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR1_GAIN_B1_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR1_GAIN_B1_CTL)); |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR1_GAIN_B2_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR1_GAIN_B2_CTL)); |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR1_GAIN_B3_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR1_GAIN_B3_CTL)); |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR1_GAIN_B4_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR1_GAIN_B4_CTL)); |
| } else { |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR2_GAIN_B1_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR2_GAIN_B1_CTL)); |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR2_GAIN_B2_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR2_GAIN_B2_CTL)); |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR2_GAIN_B3_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR2_GAIN_B3_CTL)); |
| snd_soc_write(codec, TOMTOM_A_CDC_IIR2_GAIN_B4_CTL, |
| snd_soc_read(codec, |
| TOMTOM_A_CDC_IIR2_GAIN_B4_CTL)); |
| } |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_dsm_mux_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| u8 reg_val, zoh_mux_val = 0x00; |
| |
| pr_debug("%s: event = %d\n", __func__, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_POST_PMU: |
| reg_val = snd_soc_read(codec, TOMTOM_A_CDC_CONN_CLSH_CTL); |
| |
| if ((reg_val & 0x30) == 0x10) |
| zoh_mux_val = 0x04; |
| else if ((reg_val & 0x30) == 0x20) |
| zoh_mux_val = 0x08; |
| |
| if (zoh_mux_val != 0x00) |
| snd_soc_update_bits(codec, |
| TOMTOM_A_CDC_CONN_CLSH_CTL, |
| 0x0C, zoh_mux_val); |
| break; |
| |
| case SND_SOC_DAPM_POST_PMD: |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_CONN_CLSH_CTL, |
| 0x0C, 0x00); |
| break; |
| } |
| return 0; |
| } |
| |
| static int tomtom_codec_enable_anc_ear(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| int ret = 0; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| ret = tomtom_codec_enable_anc(w, kcontrol, event); |
| msleep(50); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_EAR_EN, 0x10, 0x10); |
| break; |
| case SND_SOC_DAPM_POST_PMU: |
| ret = tomtom_codec_enable_ear_pa(w, kcontrol, event); |
| break; |
| case SND_SOC_DAPM_PRE_PMD: |
| snd_soc_update_bits(codec, TOMTOM_A_RX_EAR_EN, 0x10, 0x00); |
| msleep(40); |
| ret |= tomtom_codec_enable_anc(w, kcontrol, event); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| ret = tomtom_codec_enable_ear_pa(w, kcontrol, event); |
| break; |
| } |
| return ret; |
| } |
| |
| /* Todo: Have separate dapm widgets for I2S and Slimbus. |
| * Might Need to have callbacks registered only for slimbus |
| */ |
| static const struct snd_soc_dapm_widget tomtom_dapm_widgets[] = { |
| /*RX stuff */ |
| SND_SOC_DAPM_OUTPUT("EAR"), |
| |
| SND_SOC_DAPM_PGA_E("EAR PA", TOMTOM_A_RX_EAR_EN, 4, 0, NULL, 0, |
| tomtom_codec_enable_ear_pa, SND_SOC_DAPM_POST_PMU), |
| |
| SND_SOC_DAPM_MIXER_E("DAC1", TOMTOM_A_RX_EAR_EN, 6, 0, dac1_switch, |
| ARRAY_SIZE(dac1_switch), tomtom_codec_ear_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_AIF_IN_E("AIF1 PB", "AIF1 Playback", 0, SND_SOC_NOPM, |
| AIF1_PB, 0, tomtom_codec_enable_slimrx, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_AIF_IN_E("AIF2 PB", "AIF2 Playback", 0, SND_SOC_NOPM, |
| AIF2_PB, 0, tomtom_codec_enable_slimrx, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_AIF_IN_E("AIF3 PB", "AIF3 Playback", 0, SND_SOC_NOPM, |
| AIF3_PB, 0, tomtom_codec_enable_slimrx, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX("SLIM RX1 MUX", SND_SOC_NOPM, TOMTOM_RX1, 0, |
| &slim_rx_mux[TOMTOM_RX1]), |
| SND_SOC_DAPM_MUX("SLIM RX2 MUX", SND_SOC_NOPM, TOMTOM_RX2, 0, |
| &slim_rx_mux[TOMTOM_RX2]), |
| SND_SOC_DAPM_MUX("SLIM RX3 MUX", SND_SOC_NOPM, TOMTOM_RX3, 0, |
| &slim_rx_mux[TOMTOM_RX3]), |
| SND_SOC_DAPM_MUX("SLIM RX4 MUX", SND_SOC_NOPM, TOMTOM_RX4, 0, |
| &slim_rx_mux[TOMTOM_RX4]), |
| SND_SOC_DAPM_MUX("SLIM RX5 MUX", SND_SOC_NOPM, TOMTOM_RX5, 0, |
| &slim_rx_mux[TOMTOM_RX5]), |
| SND_SOC_DAPM_MUX("SLIM RX6 MUX", SND_SOC_NOPM, TOMTOM_RX6, 0, |
| &slim_rx_mux[TOMTOM_RX6]), |
| SND_SOC_DAPM_MUX("SLIM RX7 MUX", SND_SOC_NOPM, TOMTOM_RX7, 0, |
| &slim_rx_mux[TOMTOM_RX7]), |
| SND_SOC_DAPM_MUX("SLIM RX8 MUX", SND_SOC_NOPM, TOMTOM_RX8, 0, |
| &slim_rx_mux[TOMTOM_RX8]), |
| |
| SND_SOC_DAPM_MIXER("SLIM RX1", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX2", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX3", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX4", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX5", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX6", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX7", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("SLIM RX8", SND_SOC_NOPM, 0, 0, NULL, 0), |
| |
| /* Headphone */ |
| SND_SOC_DAPM_OUTPUT("HEADPHONE"), |
| SND_SOC_DAPM_PGA_E("HPHL", TOMTOM_A_RX_HPH_CNP_EN, 5, 0, NULL, 0, |
| tomtom_hph_pa_event, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MIXER_E("HPHL DAC", TOMTOM_A_RX_HPH_L_DAC_CTL, 7, 0, |
| hphl_switch, ARRAY_SIZE(hphl_switch), tomtom_hphl_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_PGA_E("HPHR", TOMTOM_A_RX_HPH_CNP_EN, 4, 0, NULL, 0, |
| tomtom_hph_pa_event, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_DAC_E("HPHR DAC", NULL, TOMTOM_A_RX_HPH_R_DAC_CTL, 7, 0, |
| tomtom_hphr_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| /* Speaker */ |
| SND_SOC_DAPM_OUTPUT("LINEOUT1"), |
| SND_SOC_DAPM_OUTPUT("LINEOUT2"), |
| SND_SOC_DAPM_OUTPUT("LINEOUT3"), |
| SND_SOC_DAPM_OUTPUT("LINEOUT4"), |
| SND_SOC_DAPM_OUTPUT("SPK_OUT"), |
| |
| SND_SOC_DAPM_PGA_E("LINEOUT1 PA", TOMTOM_A_RX_LINE_CNP_EN, 0, 0, NULL, |
| 0, tomtom_codec_enable_lineout, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_PGA_E("LINEOUT2 PA", TOMTOM_A_RX_LINE_CNP_EN, 1, 0, NULL, |
| 0, tomtom_codec_enable_lineout, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_PGA_E("LINEOUT3 PA", TOMTOM_A_RX_LINE_CNP_EN, 2, 0, NULL, |
| 0, tomtom_codec_enable_lineout, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_PGA_E("LINEOUT4 PA", TOMTOM_A_RX_LINE_CNP_EN, 3, 0, NULL, |
| 0, tomtom_codec_enable_lineout, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_PGA_E("SPK PA", SND_SOC_NOPM, 0, 0, NULL, |
| 0, tomtom_codec_enable_spk_pa, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_PGA_E("SPK2 PA", SND_SOC_NOPM, 0, 0, NULL, |
| 0, tomtom_codec_enable_spk_pa, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_DAC_E("LINEOUT1 DAC", NULL, TOMTOM_A_RX_LINE_1_DAC_CTL, 7, |
| 0, tomtom_lineout_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_DAC_E("LINEOUT2 DAC", NULL, TOMTOM_A_RX_LINE_2_DAC_CTL, 7, |
| 0, tomtom_lineout_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_DAC_E("LINEOUT3 DAC", NULL, TOMTOM_A_RX_LINE_3_DAC_CTL, 7, |
| 0, tomtom_lineout_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_SWITCH("LINEOUT3 DAC GROUND", SND_SOC_NOPM, 0, 0, |
| &lineout3_ground_switch), |
| SND_SOC_DAPM_DAC_E("LINEOUT4 DAC", NULL, TOMTOM_A_RX_LINE_4_DAC_CTL, 7, |
| 0, tomtom_lineout_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_SWITCH("LINEOUT4 DAC GROUND", SND_SOC_NOPM, 0, 0, |
| &lineout4_ground_switch), |
| |
| SND_SOC_DAPM_DAC_E("SPK DAC", NULL, TOMTOM_A_CDC_BOOST_TRGR_EN, 0, 0, |
| tomtom_spk_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_DAC_E("SPK2 DAC", NULL, TOMTOM_A_CDC_BOOST_TRGR_EN, 1, 0, |
| tomtom_spk_dac_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY("VDD_SPKDRV", SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_vdd_spkr, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY("VDD_SPKDRV2", SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_vdd_spkr2, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MIXER("RX1 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("RX2 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("RX7 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0), |
| |
| SND_SOC_DAPM_MIXER("RX1 MIX2", SND_SOC_NOPM, 0, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("RX2 MIX2", SND_SOC_NOPM, 0, 0, NULL, 0), |
| |
| SND_SOC_DAPM_MIXER_E("RX3 MIX1", TOMTOM_A_CDC_CLK_RX_B1_CTL, 2, 0, NULL, |
| 0, tomtom_codec_enable_interpolator, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_MIXER_E("RX4 MIX1", TOMTOM_A_CDC_CLK_RX_B1_CTL, 3, 0, NULL, |
| 0, tomtom_codec_enable_interpolator, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_MIXER_E("RX5 MIX1", TOMTOM_A_CDC_CLK_RX_B1_CTL, 4, 0, NULL, |
| 0, tomtom_codec_enable_interpolator, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_MIXER_E("RX6 MIX1", TOMTOM_A_CDC_CLK_RX_B1_CTL, 5, 0, NULL, |
| 0, tomtom_codec_enable_interpolator, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_MIXER_E("RX7 MIX2", TOMTOM_A_CDC_CLK_RX_B1_CTL, 6, 0, NULL, |
| 0, tomtom_codec_enable_interpolator, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_MIXER_E("RX8 MIX1", TOMTOM_A_CDC_CLK_RX_B1_CTL, 7, 0, NULL, |
| 0, tomtom_codec_enable_interpolator, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU), |
| |
| SND_SOC_DAPM_MUX_E("RX1 INTERP", TOMTOM_A_CDC_CLK_RX_B1_CTL, 0, 0, |
| &rx1_interp_mux, tomtom_codec_enable_interpolator, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_MUX_E("RX2 INTERP", TOMTOM_A_CDC_CLK_RX_B1_CTL, 1, 0, |
| &rx2_interp_mux, tomtom_codec_enable_interpolator, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU), |
| |
| |
| SND_SOC_DAPM_MIXER("RX1 CHAIN", TOMTOM_A_CDC_RX1_B6_CTL, 5, 0, NULL, 0), |
| SND_SOC_DAPM_MIXER("RX2 CHAIN", TOMTOM_A_CDC_RX2_B6_CTL, 5, 0, NULL, 0), |
| |
| SND_SOC_DAPM_MUX("RX1 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX1 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX1 MIX1 INP3", SND_SOC_NOPM, 0, 0, |
| &rx_mix1_inp3_mux), |
| SND_SOC_DAPM_MUX("RX2 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx2_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX2 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx2_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX3 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx3_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX3 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx3_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX4 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx4_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX4 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx4_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX5 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx5_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX5 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx5_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX6 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx6_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX6 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx6_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX7 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx7_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX7 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx7_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX8 MIX1 INP1", SND_SOC_NOPM, 0, 0, |
| &rx8_mix1_inp1_mux), |
| SND_SOC_DAPM_MUX("RX8 MIX1 INP2", SND_SOC_NOPM, 0, 0, |
| &rx8_mix1_inp2_mux), |
| SND_SOC_DAPM_MUX("RX1 MIX2 INP1", SND_SOC_NOPM, 0, 0, |
| &rx1_mix2_inp1_mux), |
| SND_SOC_DAPM_MUX("RX1 MIX2 INP2", SND_SOC_NOPM, 0, 0, |
| &rx1_mix2_inp2_mux), |
| SND_SOC_DAPM_MUX("RX2 MIX2 INP1", SND_SOC_NOPM, 0, 0, |
| &rx2_mix2_inp1_mux), |
| SND_SOC_DAPM_MUX("RX2 MIX2 INP2", SND_SOC_NOPM, 0, 0, |
| &rx2_mix2_inp2_mux), |
| SND_SOC_DAPM_MUX("RX7 MIX2 INP1", SND_SOC_NOPM, 0, 0, |
| &rx7_mix2_inp1_mux), |
| SND_SOC_DAPM_MUX("RX7 MIX2 INP2", SND_SOC_NOPM, 0, 0, |
| &rx7_mix2_inp2_mux), |
| |
| SND_SOC_DAPM_MUX("RDAC5 MUX", SND_SOC_NOPM, 0, 0, |
| &rx_dac5_mux), |
| SND_SOC_DAPM_MUX("RDAC7 MUX", SND_SOC_NOPM, 0, 0, |
| &rx_dac7_mux), |
| |
| SND_SOC_DAPM_MUX("MAD_SEL MUX", SND_SOC_NOPM, 0, 0, |
| &mad_sel_mux), |
| |
| SND_SOC_DAPM_MUX_E("CLASS_H_DSM MUX", SND_SOC_NOPM, 0, 0, |
| &class_h_dsm_mux, tomtom_codec_dsm_mux_event, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY("RX_BIAS", SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_rx_bias, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY("CDC_I2S_RX_CONN", WCD9XXX_A_CDC_CLK_OTHR_CTL, 5, 0, |
| NULL, 0), |
| |
| /* TX */ |
| |
| SND_SOC_DAPM_SUPPLY("CDC_CONN", WCD9XXX_A_CDC_CLK_OTHR_CTL, 2, 0, NULL, |
| 0), |
| |
| SND_SOC_DAPM_SUPPLY("LDO_H", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_ldo_h, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| /* |
| * DAPM 'LDO_H Standalone' is to be powered by mbhc driver after |
| * acquring codec_resource lock. |
| * So call __tomtom_codec_enable_ldo_h instead and avoid deadlock. |
| */ |
| SND_SOC_DAPM_SUPPLY("LDO_H Standalone", SND_SOC_NOPM, 7, 0, |
| __tomtom_codec_enable_ldo_h, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY("COMP0_CLK", SND_SOC_NOPM, 0, 0, |
| tomtom_config_compander, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_PRE_PMD), |
| SND_SOC_DAPM_SUPPLY("COMP1_CLK", SND_SOC_NOPM, 1, 0, |
| tomtom_config_compander, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_PRE_PMD), |
| SND_SOC_DAPM_SUPPLY("COMP2_CLK", SND_SOC_NOPM, 2, 0, |
| tomtom_config_compander, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_PRE_PMD), |
| |
| |
| SND_SOC_DAPM_INPUT("AMIC1"), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS1 External", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS1 Internal1", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS1 Internal2", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_INPUT("AMIC3"), |
| |
| SND_SOC_DAPM_INPUT("AMIC4"), |
| |
| SND_SOC_DAPM_INPUT("AMIC5"), |
| |
| SND_SOC_DAPM_INPUT("AMIC6"), |
| |
| SND_SOC_DAPM_MUX_E("DEC1 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 0, 0, |
| &dec1_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC2 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 1, 0, |
| &dec2_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC3 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 2, 0, |
| &dec3_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC4 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 3, 0, |
| &dec4_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC5 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 4, 0, |
| &dec5_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC6 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 5, 0, |
| &dec6_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC7 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 6, 0, |
| &dec7_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC8 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B1_CTL, 7, 0, |
| &dec8_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC9 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B2_CTL, 0, 0, |
| &dec9_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX_E("DEC10 MUX", TOMTOM_A_CDC_CLK_TX_CLK_EN_B2_CTL, 1, 0, |
| &dec10_mux, tomtom_codec_enable_dec, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_MUX("ANC1 MUX", SND_SOC_NOPM, 0, 0, &anc1_mux), |
| SND_SOC_DAPM_MUX("ANC2 MUX", SND_SOC_NOPM, 0, 0, &anc2_mux), |
| |
| SND_SOC_DAPM_OUTPUT("ANC HEADPHONE"), |
| SND_SOC_DAPM_PGA_E("ANC HPHL", SND_SOC_NOPM, 5, 0, NULL, 0, |
| tomtom_codec_enable_anc_hph, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD | |
| SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_PGA_E("ANC HPHR", SND_SOC_NOPM, 4, 0, NULL, 0, |
| tomtom_codec_enable_anc_hph, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD | |
| SND_SOC_DAPM_POST_PMU), |
| SND_SOC_DAPM_OUTPUT("ANC EAR"), |
| SND_SOC_DAPM_PGA_E("ANC EAR PA", SND_SOC_NOPM, 0, 0, NULL, 0, |
| tomtom_codec_enable_anc_ear, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_PRE_PMD | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MUX("ANC1 FB MUX", SND_SOC_NOPM, 0, 0, &anc1_fb_mux), |
| |
| SND_SOC_DAPM_INPUT("AMIC2"), |
| SND_SOC_DAPM_MICBIAS_E(DAPM_MICBIAS2_EXTERNAL_STANDALONE, SND_SOC_NOPM, |
| 7, 0, tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS2 External", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS2 Internal1", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS2 Internal2", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS2 Internal3", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS3 External", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS3 Internal1", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS3 Internal2", SND_SOC_NOPM, 7, 0, |
| tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MICBIAS_E("MIC BIAS4 External", SND_SOC_NOPM, 7, |
| 0, tomtom_codec_enable_micbias, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_AIF_OUT_E("AIF1 CAP", "AIF1 Capture", 0, SND_SOC_NOPM, |
| AIF1_CAP, 0, tomtom_codec_enable_slimtx, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_AIF_OUT_E("AIF2 CAP", "AIF2 Capture", 0, SND_SOC_NOPM, |
| AIF2_CAP, 0, tomtom_codec_enable_slimtx, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_AIF_OUT_E("AIF3 CAP", "AIF3 Capture", 0, SND_SOC_NOPM, |
| AIF3_CAP, 0, tomtom_codec_enable_slimtx, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_AIF_OUT_E("AIF4 VI", "VIfeed", 0, SND_SOC_NOPM, |
| AIF4_VIFEED, 0, tomtom_codec_enable_slimvi_feedback, |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_AIF_OUT_E("AIF4 MAD", "AIF4 MAD TX", 0, |
| SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_mad, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_SWITCH("MADONOFF", SND_SOC_NOPM, 0, 0, |
| &aif4_mad_switch), |
| SND_SOC_DAPM_INPUT("MADINPUT"), |
| SND_SOC_DAPM_INPUT("MAD_CPE_INPUT"), |
| |
| SND_SOC_DAPM_MIXER("AIF1_CAP Mixer", SND_SOC_NOPM, AIF1_CAP, 0, |
| aif1_cap_mixer, ARRAY_SIZE(aif1_cap_mixer)), |
| |
| SND_SOC_DAPM_MIXER("AIF2_CAP Mixer", SND_SOC_NOPM, AIF2_CAP, 0, |
| aif2_cap_mixer, ARRAY_SIZE(aif2_cap_mixer)), |
| |
| SND_SOC_DAPM_MIXER("AIF3_CAP Mixer", SND_SOC_NOPM, AIF3_CAP, 0, |
| aif3_cap_mixer, ARRAY_SIZE(aif3_cap_mixer)), |
| |
| SND_SOC_DAPM_MUX("SLIM TX1 MUX", SND_SOC_NOPM, TOMTOM_TX1, 0, |
| &sb_tx1_mux), |
| SND_SOC_DAPM_MUX("SLIM TX2 MUX", SND_SOC_NOPM, TOMTOM_TX2, 0, |
| &sb_tx2_mux), |
| SND_SOC_DAPM_MUX("SLIM TX3 MUX", SND_SOC_NOPM, TOMTOM_TX3, 0, |
| &sb_tx3_mux), |
| SND_SOC_DAPM_MUX("SLIM TX4 MUX", SND_SOC_NOPM, TOMTOM_TX4, 0, |
| &sb_tx4_mux), |
| SND_SOC_DAPM_MUX("SLIM TX5 MUX", SND_SOC_NOPM, TOMTOM_TX5, 0, |
| &sb_tx5_mux), |
| SND_SOC_DAPM_MUX("SLIM TX6 MUX", SND_SOC_NOPM, TOMTOM_TX6, 0, |
| &sb_tx6_mux), |
| SND_SOC_DAPM_MUX("SLIM TX7 MUX", SND_SOC_NOPM, TOMTOM_TX7, 0, |
| &sb_tx7_mux), |
| SND_SOC_DAPM_MUX("SLIM TX8 MUX", SND_SOC_NOPM, TOMTOM_TX8, 0, |
| &sb_tx8_mux), |
| SND_SOC_DAPM_MUX("SLIM TX9 MUX", SND_SOC_NOPM, TOMTOM_TX9, 0, |
| &sb_tx9_mux), |
| SND_SOC_DAPM_MUX("SLIM TX10 MUX", SND_SOC_NOPM, TOMTOM_TX10, 0, |
| &sb_tx10_mux), |
| |
| /* Digital Mic Inputs */ |
| SND_SOC_DAPM_ADC_E("DMIC1", NULL, SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_ADC_E("DMIC2", NULL, SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_ADC_E("DMIC3", NULL, SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_ADC_E("DMIC4", NULL, SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_ADC_E("DMIC5", NULL, SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_ADC_E("DMIC6", NULL, SND_SOC_NOPM, 0, 0, |
| tomtom_codec_enable_dmic, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| /* Sidetone */ |
| SND_SOC_DAPM_MUX("IIR1 INP1 MUX", SND_SOC_NOPM, 0, 0, &iir1_inp1_mux), |
| |
| SND_SOC_DAPM_MUX("IIR1 INP2 MUX", SND_SOC_NOPM, 0, 0, &iir1_inp2_mux), |
| |
| SND_SOC_DAPM_MUX("IIR1 INP3 MUX", SND_SOC_NOPM, 0, 0, &iir1_inp3_mux), |
| |
| SND_SOC_DAPM_MUX("IIR1 INP4 MUX", SND_SOC_NOPM, 0, 0, &iir1_inp4_mux), |
| |
| SND_SOC_DAPM_MIXER_E("IIR1", TOMTOM_A_CDC_CLK_SD_CTL, 0, 0, NULL, 0, |
| tomtom_codec_set_iir_gain, SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD), |
| |
| SND_SOC_DAPM_MUX("IIR2 INP1 MUX", SND_SOC_NOPM, 0, 0, &iir2_inp1_mux), |
| |
| SND_SOC_DAPM_MUX("IIR2 INP2 MUX", SND_SOC_NOPM, 0, 0, &iir2_inp2_mux), |
| |
| SND_SOC_DAPM_MUX("IIR2 INP3 MUX", SND_SOC_NOPM, 0, 0, &iir2_inp3_mux), |
| |
| SND_SOC_DAPM_MUX("IIR2 INP4 MUX", SND_SOC_NOPM, 0, 0, &iir2_inp4_mux), |
| |
| SND_SOC_DAPM_MIXER_E("IIR2", TOMTOM_A_CDC_CLK_SD_CTL, 1, 0, NULL, 0, |
| tomtom_codec_set_iir_gain, SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_PRE_PMD), |
| |
| /* AUX PGA */ |
| SND_SOC_DAPM_ADC_E("AUX_PGA_Left", NULL, TOMTOM_A_RX_AUX_SW_CTL, 7, 0, |
| tomtom_codec_enable_aux_pga, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_ADC_E("AUX_PGA_Right", NULL, TOMTOM_A_RX_AUX_SW_CTL, 6, 0, |
| tomtom_codec_enable_aux_pga, SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| |
| /* Lineout, ear and HPH PA Mixers */ |
| |
| SND_SOC_DAPM_MIXER("EAR_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| ear_pa_mix, ARRAY_SIZE(ear_pa_mix)), |
| |
| SND_SOC_DAPM_MIXER("HPHL_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| hphl_pa_mix, ARRAY_SIZE(hphl_pa_mix)), |
| |
| SND_SOC_DAPM_MIXER("HPHR_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| hphr_pa_mix, ARRAY_SIZE(hphr_pa_mix)), |
| |
| SND_SOC_DAPM_MIXER("LINEOUT1_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| lineout1_pa_mix, ARRAY_SIZE(lineout1_pa_mix)), |
| |
| SND_SOC_DAPM_MIXER("LINEOUT2_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| lineout2_pa_mix, ARRAY_SIZE(lineout2_pa_mix)), |
| |
| SND_SOC_DAPM_MIXER("LINEOUT3_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| lineout3_pa_mix, ARRAY_SIZE(lineout3_pa_mix)), |
| |
| SND_SOC_DAPM_MIXER("LINEOUT4_PA_MIXER", SND_SOC_NOPM, 0, 0, |
| lineout4_pa_mix, ARRAY_SIZE(lineout4_pa_mix)), |
| |
| SND_SOC_DAPM_SWITCH("VIONOFF", SND_SOC_NOPM, 0, 0, |
| &aif4_vi_switch), |
| |
| SND_SOC_DAPM_INPUT("VIINPUT"), |
| }; |
| |
| static irqreturn_t tomtom_slimbus_irq(int irq, void *data) |
| { |
| struct tomtom_priv *priv = data; |
| struct snd_soc_codec *codec = priv->codec; |
| struct wcd9xxx *wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| unsigned long status = 0; |
| int i, j, port_id, k; |
| u32 bit; |
| u8 val, int_val = 0; |
| bool tx, cleared; |
| unsigned short reg = 0; |
| |
| for (i = TOMTOM_SLIM_PGD_PORT_INT_STATUS_RX_0, j = 0; |
| i <= TOMTOM_SLIM_PGD_PORT_INT_STATUS_TX_1; i++, j++) { |
| val = wcd9xxx_interface_reg_read(wcd9xxx, i); |
| status |= ((u32)val << (8 * j)); |
| } |
| |
| for_each_set_bit(j, &status, 32) { |
| tx = (j >= 16 ? true : false); |
| port_id = (tx ? j - 16 : j); |
| val = wcd9xxx_interface_reg_read(wcd9xxx, |
| TOMTOM_SLIM_PGD_PORT_INT_RX_SOURCE0 + j); |
| if (val) { |
| if (!tx) |
| reg = TOMTOM_SLIM_PGD_PORT_INT_EN0 + |
| (port_id / 8); |
| else |
| reg = TOMTOM_SLIM_PGD_PORT_INT_TX_EN0 + |
| (port_id / 8); |
| int_val = wcd9xxx_interface_reg_read( |
| wcd9xxx, reg); |
| /* |
| * Ignore interrupts for ports for which the |
| * interrupts are not specifically enabled. |
| */ |
| if (!(int_val & (1 << (port_id % 8)))) |
| continue; |
| } |
| if (val & TOMTOM_SLIM_IRQ_OVERFLOW) |
| pr_err_ratelimited( |
| "%s: overflow error on %s port %d, value %x\n", |
| __func__, (tx ? "TX" : "RX"), port_id, val); |
| if (val & TOMTOM_SLIM_IRQ_UNDERFLOW) |
| pr_err_ratelimited( |
| "%s: underflow error on %s port %d, value %x\n", |
| __func__, (tx ? "TX" : "RX"), port_id, val); |
| if ((val & TOMTOM_SLIM_IRQ_OVERFLOW) || |
| (val & TOMTOM_SLIM_IRQ_UNDERFLOW)) { |
| if (!tx) |
| reg = TOMTOM_SLIM_PGD_PORT_INT_EN0 + |
| (port_id / 8); |
| else |
| reg = TOMTOM_SLIM_PGD_PORT_INT_TX_EN0 + |
| (port_id / 8); |
| int_val = wcd9xxx_interface_reg_read(wcd9xxx, reg); |
| if (int_val & (1 << (port_id % 8))) { |
| int_val = int_val ^ (1 << (port_id % 8)); |
| wcd9xxx_interface_reg_write(wcd9xxx, reg, |
| int_val); |
| } |
| } |
| if (val & TOMTOM_SLIM_IRQ_PORT_CLOSED) { |
| /* |
| * INT SOURCE register starts from RX to TX |
| * but port number in the ch_mask is in opposite way |
| */ |
| bit = (tx ? j - 16 : j + 16); |
| pr_debug("%s: %s port %d closed value %x, bit %u\n", |
| __func__, (tx ? "TX" : "RX"), port_id, val, |
| bit); |
| for (k = 0, cleared = false; k < NUM_CODEC_DAIS; k++) { |
| pr_debug("%s: priv->dai[%d].ch_mask = 0x%lx\n", |
| __func__, k, priv->dai[k].ch_mask); |
| if (test_and_clear_bit(bit, |
| &priv->dai[k].ch_mask)) { |
| cleared = true; |
| if (!priv->dai[k].ch_mask) |
| wake_up(&priv->dai[k].dai_wait); |
| /* |
| * There are cases when multiple DAIs |
| * might be using the same slimbus |
| * channel. Hence don't break here. |
| */ |
| } |
| } |
| WARN(!cleared, |
| "Couldn't find slimbus %s port %d for closing\n", |
| (tx ? "TX" : "RX"), port_id); |
| } |
| wcd9xxx_interface_reg_write(wcd9xxx, |
| TOMTOM_SLIM_PGD_PORT_INT_CLR_RX_0 + |
| (j / 8), |
| 1 << (j % 8)); |
| } |
| |
| return IRQ_HANDLED; |
| } |
| |
| static int tomtom_handle_pdata(struct tomtom_priv *tomtom) |
| { |
| struct snd_soc_codec *codec = tomtom->codec; |
| struct wcd9xxx_pdata *pdata = tomtom->resmgr.pdata; |
| int k1, k2, k3, dec, rc = 0; |
| u8 leg_mode, txfe_bypass, txfe_buff, flag; |
| u8 i = 0, j = 0; |
| u8 val_txfe = 0, value = 0; |
| u8 dmic_ctl_val, mad_dmic_ctl_val; |
| u8 anc_ctl_value = 0; |
| u32 def_dmic_rate; |
| u16 tx_dmic_ctl_reg; |
| |
| if (!pdata) { |
| pr_err("%s: NULL pdata\n", __func__); |
| rc = -ENODEV; |
| goto done; |
| } |
| |
| leg_mode = pdata->amic_settings.legacy_mode; |
| txfe_bypass = pdata->amic_settings.txfe_enable; |
| txfe_buff = pdata->amic_settings.txfe_buff; |
| flag = pdata->amic_settings.use_pdata; |
| |
| /* Make sure settings are correct */ |
| if ((pdata->micbias.ldoh_v > WCD9XXX_LDOH_3P0_V) || |
| (pdata->micbias.bias1_cfilt_sel > WCD9XXX_CFILT3_SEL) || |
| (pdata->micbias.bias2_cfilt_sel > WCD9XXX_CFILT3_SEL) || |
| (pdata->micbias.bias3_cfilt_sel > WCD9XXX_CFILT3_SEL) || |
| (pdata->micbias.bias4_cfilt_sel > WCD9XXX_CFILT3_SEL)) { |
| rc = -EINVAL; |
| goto done; |
| } |
| /* figure out k value */ |
| k1 = wcd9xxx_resmgr_get_k_val(&tomtom->resmgr, |
| pdata->micbias.cfilt1_mv); |
| k2 = wcd9xxx_resmgr_get_k_val(&tomtom->resmgr, |
| pdata->micbias.cfilt2_mv); |
| k3 = wcd9xxx_resmgr_get_k_val(&tomtom->resmgr, |
| pdata->micbias.cfilt3_mv); |
| if (k1 < 0 || k2 < 0 || k3 < 0) { |
| rc = -EINVAL; |
| goto done; |
| } |
| /* Set voltage level and always use LDO */ |
| snd_soc_update_bits(codec, TOMTOM_A_LDO_H_MODE_1, 0x0C, |
| (pdata->micbias.ldoh_v << 2)); |
| |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_CFILT_1_VAL, 0xFC, (k1 << 2)); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_CFILT_2_VAL, 0xFC, (k2 << 2)); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_CFILT_3_VAL, 0xFC, (k3 << 2)); |
| |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_1_CTL, 0x60, |
| (pdata->micbias.bias1_cfilt_sel << 5)); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_2_CTL, 0x60, |
| (pdata->micbias.bias2_cfilt_sel << 5)); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_3_CTL, 0x60, |
| (pdata->micbias.bias3_cfilt_sel << 5)); |
| snd_soc_update_bits(codec, tomtom->resmgr.reg_addr->micb_4_ctl, 0x60, |
| (pdata->micbias.bias4_cfilt_sel << 5)); |
| |
| for (i = 0; i < 6; j++, i += 2) { |
| if (flag & (0x01 << i)) { |
| val_txfe = (txfe_bypass & (0x01 << i)) ? 0x20 : 0x00; |
| val_txfe = val_txfe | |
| ((txfe_buff & (0x01 << i)) ? 0x10 : 0x00); |
| snd_soc_update_bits(codec, |
| TOMTOM_A_TX_1_2_TEST_EN + j * 10, |
| 0x30, val_txfe); |
| } |
| if (flag & (0x01 << (i + 1))) { |
| val_txfe = (txfe_bypass & |
| (0x01 << (i + 1))) ? 0x02 : 0x00; |
| val_txfe |= (txfe_buff & |
| (0x01 << (i + 1))) ? 0x01 : 0x00; |
| snd_soc_update_bits(codec, |
| TOMTOM_A_TX_1_2_TEST_EN + j * 10, |
| 0x03, val_txfe); |
| } |
| } |
| if (flag & 0x40) { |
| value = (leg_mode & 0x40) ? 0x10 : 0x00; |
| value = value | ((txfe_bypass & 0x40) ? 0x02 : 0x00); |
| value = value | ((txfe_buff & 0x40) ? 0x01 : 0x00); |
| snd_soc_update_bits(codec, TOMTOM_A_TX_7_MBHC_EN, |
| 0x13, value); |
| } |
| |
| if (pdata->ocp.use_pdata) { |
| /* not defined in CODEC specification */ |
| if (pdata->ocp.hph_ocp_limit == 1 || |
| pdata->ocp.hph_ocp_limit == 5) { |
| rc = -EINVAL; |
| goto done; |
| } |
| snd_soc_update_bits(codec, TOMTOM_A_RX_COM_OCP_CTL, |
| 0x0F, pdata->ocp.num_attempts); |
| snd_soc_write(codec, TOMTOM_A_RX_COM_OCP_COUNT, |
| ((pdata->ocp.run_time << 4) | pdata->ocp.wait_time)); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_OCP_CTL, |
| 0xE0, (pdata->ocp.hph_ocp_limit << 5)); |
| } |
| |
| for (i = 0; i < ARRAY_SIZE(pdata->regulator); i++) { |
| if (pdata->regulator[i].name && |
| !strcmp(pdata->regulator[i].name, "CDC_VDDA_RX")) { |
| if (pdata->regulator[i].min_uV == 1800000 && |
| pdata->regulator[i].max_uV == 1800000) { |
| snd_soc_write(codec, TOMTOM_A_BIAS_REF_CTL, |
| 0x1C); |
| } else if (pdata->regulator[i].min_uV == 2200000 && |
| pdata->regulator[i].max_uV == 2200000) { |
| snd_soc_write(codec, TOMTOM_A_BIAS_REF_CTL, |
| 0x1E); |
| } else { |
| pr_err("%s: unsupported CDC_VDDA_RX voltage\n" |
| "min %d, max %d\n", __func__, |
| pdata->regulator[i].min_uV, |
| pdata->regulator[i].max_uV); |
| rc = -EINVAL; |
| } |
| break; |
| } |
| } |
| |
| /* Set micbias capless mode with tail current */ |
| value = (pdata->micbias.bias1_cap_mode == MICBIAS_EXT_BYP_CAP ? |
| 0x00 : 0x16); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_1_CTL, 0x1E, value); |
| value = (pdata->micbias.bias2_cap_mode == MICBIAS_EXT_BYP_CAP ? |
| 0x00 : 0x16); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_2_CTL, 0x1E, value); |
| value = (pdata->micbias.bias3_cap_mode == MICBIAS_EXT_BYP_CAP ? |
| 0x00 : 0x16); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_3_CTL, 0x1E, value); |
| value = (pdata->micbias.bias4_cap_mode == MICBIAS_EXT_BYP_CAP ? |
| 0x00 : 0x16); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_4_CTL, 0x1E, value); |
| |
| /* Set the DMIC sample rate */ |
| switch (pdata->mclk_rate) { |
| case TOMTOM_MCLK_CLK_9P6MHZ: |
| def_dmic_rate = |
| WCD9XXX_DMIC_SAMPLE_RATE_4P8MHZ; |
| break; |
| case TOMTOM_MCLK_CLK_12P288MHZ: |
| def_dmic_rate = |
| WCD9XXX_DMIC_SAMPLE_RATE_4P096MHZ; |
| break; |
| default: |
| /* should never happen */ |
| pr_err("%s: Invalid mclk_rate %d\n", |
| __func__, pdata->mclk_rate); |
| rc = -EINVAL; |
| goto done; |
| } |
| |
| if (pdata->dmic_sample_rate == |
| WCD9XXX_DMIC_SAMPLE_RATE_UNDEFINED) { |
| pr_info("%s: dmic_rate invalid default = %d\n", |
| __func__, def_dmic_rate); |
| pdata->dmic_sample_rate = def_dmic_rate; |
| } |
| |
| if (pdata->mad_dmic_sample_rate == |
| WCD9XXX_DMIC_SAMPLE_RATE_UNDEFINED) { |
| pr_info("%s: mad_dmic_rate invalid default = %d\n", |
| __func__, def_dmic_rate); |
| /* |
| * use dmic_sample_rate as the default for MAD |
| * if mad dmic sample rate is undefined |
| */ |
| pdata->mad_dmic_sample_rate = pdata->dmic_sample_rate; |
| } |
| |
| /* |
| * Default the DMIC clk rates to mad_dmic_sample_rate, |
| * whereas, the anc/txfe dmic rates to dmic_sample_rate |
| * since the anc/txfe are independent of mad block. |
| */ |
| mad_dmic_ctl_val = tomtom_get_dmic_clk_val(tomtom->codec, |
| pdata->mclk_rate, |
| pdata->mad_dmic_sample_rate); |
| snd_soc_update_bits(codec, TOMTOM_A_DMIC_B1_CTL, |
| 0xE0, mad_dmic_ctl_val << 5); |
| snd_soc_update_bits(codec, TOMTOM_A_DMIC_B2_CTL, |
| 0x70, mad_dmic_ctl_val << 4); |
| snd_soc_update_bits(codec, TOMTOM_A_DMIC_B2_CTL, |
| 0x0E, mad_dmic_ctl_val << 1); |
| |
| dmic_ctl_val = tomtom_get_dmic_clk_val(tomtom->codec, |
| pdata->mclk_rate, |
| pdata->dmic_sample_rate); |
| |
| if (dmic_ctl_val == WCD9330_DMIC_CLK_DIV_2) |
| anc_ctl_value = WCD9XXX_ANC_DMIC_X2_ON; |
| else |
| anc_ctl_value = WCD9XXX_ANC_DMIC_X2_OFF; |
| |
| for (dec = 0; dec < NUM_DECIMATORS; dec++) { |
| tx_dmic_ctl_reg = |
| TOMTOM_A_CDC_TX1_DMIC_CTL + (8 * dec); |
| snd_soc_update_bits(codec, tx_dmic_ctl_reg, |
| 0x07, dmic_ctl_val); |
| } |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_ANC1_B2_CTL, |
| 0x1, anc_ctl_value); |
| snd_soc_update_bits(codec, TOMTOM_A_CDC_ANC2_B2_CTL, |
| 0x1, anc_ctl_value); |
| done: |
| return rc; |
| } |
| |
| static const struct wcd9xxx_reg_mask_val tomtom_reg_defaults[] = { |
| |
| /* set MCLk to 9.6 */ |
| TOMTOM_REG_VAL(TOMTOM_A_CHIP_CTL, 0x02), |
| |
| /* EAR PA deafults */ |
| TOMTOM_REG_VAL(TOMTOM_A_RX_EAR_CMBUFF, 0x05), |
| |
| /* RX deafults */ |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX1_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX2_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX3_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX4_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX5_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX6_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX7_B5_CTL, 0x79), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX8_B5_CTL, 0x79), |
| |
| /* RX1 and RX2 defaults */ |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX1_B6_CTL, 0xA0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX2_B6_CTL, 0xA0), |
| |
| /* RX3 to RX7 defaults */ |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX3_B6_CTL, 0x80), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX4_B6_CTL, 0x80), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX5_B6_CTL, 0x80), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX6_B6_CTL, 0x80), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX7_B6_CTL, 0x80), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX8_B6_CTL, 0x80), |
| |
| /* MAD registers */ |
| TOMTOM_REG_VAL(TOMTOM_A_MAD_ANA_CTRL, 0xF1), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_MAIN_CTL_1, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_MAIN_CTL_2, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_1, 0x00), |
| /* Set SAMPLE_TX_EN bit */ |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_2, 0x03), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_3, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_4, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_5, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_6, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_7, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_CTL_8, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_IIR_CTL_PTR, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_AUDIO_IIR_CTL_VAL, 0x40), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_DEBUG_B7_CTL, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_CLK_OTHR_RESET_B1_CTL, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_CLK_OTHR_CTL, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_INP_SEL, 0x01), |
| |
| /* Set HPH Path to low power mode */ |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_BIAS_PA, 0x57), |
| |
| /* BUCK default */ |
| TOMTOM_REG_VAL(TOMTOM_A_BUCK_CTRL_CCL_4, 0x51), |
| TOMTOM_REG_VAL(TOMTOM_A_BUCK_CTRL_CCL_1, 0x5B), |
| }; |
| |
| /* |
| * Don't update TOMTOM_A_CHIP_CTL, TOMTOM_A_BUCK_CTRL_CCL_1 and |
| * TOMTOM_A_RX_EAR_CMBUFF as those are updated in tomtom_reg_defaults |
| */ |
| static const struct wcd9xxx_reg_mask_val tomtom_1_0_reg_defaults[] = { |
| TOMTOM_REG_VAL(TOMTOM_A_TX_1_GAIN, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_2_GAIN, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_1_2_ADC_IB, 0x44), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_3_GAIN, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_4_GAIN, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_3_4_ADC_IB, 0x44), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_5_GAIN, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_6_GAIN, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_TX_5_6_ADC_IB, 0x44), |
| TOMTOM_REG_VAL(WCD9XXX_A_BUCK_MODE_3, 0xCE), |
| TOMTOM_REG_VAL(WCD9XXX_A_BUCK_CTRL_VCL_1, 0x8), |
| TOMTOM_REG_VAL(TOMTOM_A_BUCK_CTRL_CCL_4, 0x51), |
| TOMTOM_REG_VAL(TOMTOM_A_NCP_DTEST, 0x10), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_CHOP_CTL, 0xA4), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_OCP_CTL, 0x69), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_CNP_WG_CTL, 0xDA), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_CNP_WG_TIME, 0x15), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_EAR_BIAS_PA, 0x76), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_EAR_CNP, 0xC0), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_LINE_BIAS_PA, 0x78), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_LINE_1_TEST, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_LINE_2_TEST, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_LINE_3_TEST, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_LINE_4_TEST, 0x2), |
| TOMTOM_REG_VAL(TOMTOM_A_SPKR_DRV1_OCP_CTL, 0x97), |
| TOMTOM_REG_VAL(TOMTOM_A_SPKR_DRV1_CLIP_DET, 0x1), |
| TOMTOM_REG_VAL(TOMTOM_A_SPKR_DRV1_IEC, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_SPKR_DRV2_OCP_CTL, 0x97), |
| TOMTOM_REG_VAL(TOMTOM_A_SPKR_DRV2_CLIP_DET, 0x1), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX1_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX2_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX3_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX4_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX5_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX6_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX7_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX8_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX9_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX10_MUX_CTL, 0x4A), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX1_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX2_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX3_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX4_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX5_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX6_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX7_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX8_B4_CTL, 0xB), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_VBAT_GAIN_UPD_MON, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_PA_RAMP_B1_CTL, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_PA_RAMP_B2_CTL, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_PA_RAMP_B3_CTL, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_PA_RAMP_B4_CTL, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_SPKR_CLIPDET_B1_CTL, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_SPKR2_CLIPDET_B1_CTL, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_COMP0_B4_CTL, 0x37), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_COMP0_B5_CTL, 0x7f), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_COMP0_B5_CTL, 0x7f), |
| }; |
| |
| static const struct wcd9xxx_reg_mask_val tomtom_2_0_reg_defaults[] = { |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_MAD_MAIN_CTL_2, 0x32), |
| TOMTOM_REG_VAL(TOMTOM_A_RCO_CTRL, 0x10), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_L_TEST, 0x0A), |
| TOMTOM_REG_VAL(TOMTOM_A_RX_HPH_R_TEST, 0x0A), |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_OE0, 0xC3), |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_DATA0, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX_I2S_SCK_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX_I2S_WS_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX_I2S_SCK_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX_I2S_WS_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_OE1, 0xE0), |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_OE2, 0x03), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_JTCK_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_JTDI_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_JTMS_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_JTDO_MODE, 0x04), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_JTRST_MODE, 0x04), |
| }; |
| |
| static const struct wcd9xxx_reg_mask_val tomtom_2_0_reg_i2c_defaults[] = { |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_OE0, 0x00), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX_I2S_SCK_MODE, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_TX_I2S_WS_MODE, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX_I2S_SCK_MODE, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_CDC_RX_I2S_WS_MODE, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_OE1, 0x0), |
| TOMTOM_REG_VAL(TOMTOM_A_PIN_CTL_OE2, 0x0), |
| }; |
| |
| static void tomtom_update_reg_defaults(struct snd_soc_codec *codec) |
| { |
| u32 i; |
| struct wcd9xxx *tomtom_core = dev_get_drvdata(codec->dev->parent); |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| for (i = 0; i < ARRAY_SIZE(tomtom_reg_defaults); i++) |
| snd_soc_write(codec, tomtom_reg_defaults[i].reg, |
| tomtom_reg_defaults[i].val); |
| |
| for (i = 0; i < ARRAY_SIZE(tomtom_1_0_reg_defaults); i++) |
| snd_soc_write(codec, tomtom_1_0_reg_defaults[i].reg, |
| tomtom_1_0_reg_defaults[i].val); |
| |
| if (!TOMTOM_IS_1_0(tomtom_core->version)) { |
| for (i = 0; i < ARRAY_SIZE(tomtom_2_0_reg_defaults); i++) |
| snd_soc_write(codec, tomtom_2_0_reg_defaults[i].reg, |
| tomtom_2_0_reg_defaults[i].val); |
| |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_I2C) { |
| for (i = 0; i < ARRAY_SIZE(tomtom_2_0_reg_i2c_defaults); |
| i++) |
| snd_soc_write(codec, |
| tomtom_2_0_reg_i2c_defaults[i].reg, |
| tomtom_2_0_reg_i2c_defaults[i].val); |
| } |
| } |
| } |
| |
| static const struct wcd9xxx_reg_mask_val tomtom_codec_reg_init_val[] = { |
| /* Initialize current threshold to 350MA |
| * number of wait and run cycles to 4096 |
| */ |
| {TOMTOM_A_RX_HPH_OCP_CTL, 0xE1, 0x61}, |
| {TOMTOM_A_RX_COM_OCP_COUNT, 0xFF, 0xFF}, |
| {TOMTOM_A_RX_HPH_L_TEST, 0x01, 0x01}, |
| {TOMTOM_A_RX_HPH_R_TEST, 0x01, 0x01}, |
| |
| /* Initialize gain registers to use register gain */ |
| {TOMTOM_A_RX_HPH_L_GAIN, 0x20, 0x20}, |
| {TOMTOM_A_RX_HPH_R_GAIN, 0x20, 0x20}, |
| {TOMTOM_A_RX_LINE_1_GAIN, 0x20, 0x20}, |
| {TOMTOM_A_RX_LINE_2_GAIN, 0x20, 0x20}, |
| {TOMTOM_A_RX_LINE_3_GAIN, 0x20, 0x20}, |
| {TOMTOM_A_RX_LINE_4_GAIN, 0x20, 0x20}, |
| {TOMTOM_A_SPKR_DRV1_GAIN, 0x04, 0x04}, |
| {TOMTOM_A_SPKR_DRV2_GAIN, 0x04, 0x04}, |
| |
| /* Use 16 bit sample size for TX1 to TX6 */ |
| {TOMTOM_A_CDC_CONN_TX_SB_B1_CTL, 0x30, 0x20}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B2_CTL, 0x30, 0x20}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B3_CTL, 0x30, 0x20}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B4_CTL, 0x30, 0x20}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B5_CTL, 0x30, 0x20}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B6_CTL, 0x30, 0x20}, |
| |
| /* Use 16 bit sample size for TX7 to TX10 */ |
| {TOMTOM_A_CDC_CONN_TX_SB_B7_CTL, 0x60, 0x40}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B8_CTL, 0x60, 0x40}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B9_CTL, 0x60, 0x40}, |
| {TOMTOM_A_CDC_CONN_TX_SB_B10_CTL, 0x60, 0x40}, |
| |
| /*enable HPF filter for TX paths */ |
| {TOMTOM_A_CDC_TX1_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX2_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX3_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX4_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX5_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX6_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX7_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX8_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX9_MUX_CTL, 0x8, 0x0}, |
| {TOMTOM_A_CDC_TX10_MUX_CTL, 0x8, 0x0}, |
| |
| /* Compander zone selection */ |
| {TOMTOM_A_CDC_COMP0_B4_CTL, 0x3F, 0x37}, |
| {TOMTOM_A_CDC_COMP1_B4_CTL, 0x3F, 0x37}, |
| {TOMTOM_A_CDC_COMP2_B4_CTL, 0x3F, 0x37}, |
| {TOMTOM_A_CDC_COMP0_B5_CTL, 0x7F, 0x7F}, |
| {TOMTOM_A_CDC_COMP1_B5_CTL, 0x7F, 0x7F}, |
| {TOMTOM_A_CDC_COMP2_B5_CTL, 0x7F, 0x7F}, |
| |
| /* |
| * Setup wavegen timer to 20msec and disable chopper |
| * as default. This corresponds to Compander OFF |
| */ |
| {TOMTOM_A_RX_HPH_CNP_WG_CTL, 0xFF, 0xDB}, |
| {TOMTOM_A_RX_HPH_CNP_WG_TIME, 0xFF, 0x58}, |
| {TOMTOM_A_RX_HPH_BIAS_WG_OCP, 0xFF, 0x1A}, |
| {TOMTOM_A_RX_HPH_CHOP_CTL, 0xFF, 0x24}, |
| |
| /* Choose max non-overlap time for NCP */ |
| {TOMTOM_A_NCP_CLK, 0xFF, 0xFC}, |
| |
| /* Program the 0.85 volt VBG_REFERENCE */ |
| {TOMTOM_A_BIAS_CURR_CTL_2, 0xFF, 0x04}, |
| |
| /* set MAD input MIC to DMIC1 */ |
| {TOMTOM_A_CDC_MAD_INP_SEL, 0x0F, 0x08}, |
| |
| {TOMTOM_A_INTR_MODE, 0x04, 0x04}, |
| }; |
| |
| static const struct wcd9xxx_reg_mask_val tomtom_codec_2_0_reg_init_val[] = { |
| {TOMTOM_A_RX_HPH_L_TEST, 0x08, 0x00}, |
| {TOMTOM_A_RX_HPH_R_TEST, 0x08, 0x00}, |
| {TOMTOM_A_CDC_CLIP_ADJ_SPKR_MIN_CLIP_THRESHOLD, 0xFF, 0x00}, |
| {TOMTOM_A_CDC_CLIP_ADJ_SPKR2_MIN_CLIP_THRESHOLD, 0xFF, 0x00}, |
| {TOMTOM_A_CDC_CLIP_ADJ_SPKR_BOOST_GATING, 0x01, 0x01}, |
| {TOMTOM_A_CDC_CLIP_ADJ_SPKR2_BOOST_GATING, 0x01, 0x01}, |
| {TOMTOM_A_CDC_CLIP_ADJ_SPKR_B1_CTL, 0x01, 0x00}, |
| {TOMTOM_A_CDC_CLIP_ADJ_SPKR2_B1_CTL, 0x01, 0x00}, |
| }; |
| |
| static void tomtom_codec_init_reg(struct snd_soc_codec *codec) |
| { |
| u32 i; |
| struct wcd9xxx *tomtom_core = dev_get_drvdata(codec->dev->parent); |
| |
| for (i = 0; i < ARRAY_SIZE(tomtom_codec_reg_init_val); i++) |
| snd_soc_update_bits(codec, tomtom_codec_reg_init_val[i].reg, |
| tomtom_codec_reg_init_val[i].mask, |
| tomtom_codec_reg_init_val[i].val); |
| |
| if (!TOMTOM_IS_1_0(tomtom_core->version)) { |
| for (i = 0; i < ARRAY_SIZE(tomtom_codec_2_0_reg_init_val); i++) |
| snd_soc_update_bits(codec, |
| tomtom_codec_2_0_reg_init_val[i].reg, |
| tomtom_codec_2_0_reg_init_val[i].mask, |
| tomtom_codec_2_0_reg_init_val[i].val); |
| } |
| |
| } |
| |
| static void tomtom_slim_interface_init_reg(struct snd_soc_codec *codec) |
| { |
| int i; |
| struct wcd9xxx *wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| |
| for (i = 0; i < WCD9XXX_SLIM_NUM_PORT_REG; i++) |
| wcd9xxx_interface_reg_write(wcd9xxx, |
| TOMTOM_SLIM_PGD_PORT_INT_EN0 + i, |
| 0xFF); |
| } |
| |
| static int tomtom_setup_irqs(struct tomtom_priv *tomtom) |
| { |
| int ret = 0; |
| struct snd_soc_codec *codec = tomtom->codec; |
| struct wcd9xxx *wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| struct wcd9xxx_core_resource *core_res = |
| &wcd9xxx->core_res; |
| |
| ret = wcd9xxx_request_irq(core_res, WCD9XXX_IRQ_SLIMBUS, |
| tomtom_slimbus_irq, "SLIMBUS Slave", tomtom); |
| if (ret) |
| pr_err("%s: Failed to request irq %d\n", __func__, |
| WCD9XXX_IRQ_SLIMBUS); |
| else |
| tomtom_slim_interface_init_reg(codec); |
| |
| return ret; |
| } |
| |
| static void tomtom_cleanup_irqs(struct tomtom_priv *tomtom) |
| { |
| struct snd_soc_codec *codec = tomtom->codec; |
| struct wcd9xxx *wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| struct wcd9xxx_core_resource *core_res = |
| &wcd9xxx->core_res; |
| |
| wcd9xxx_free_irq(core_res, WCD9XXX_IRQ_SLIMBUS, tomtom); |
| } |
| |
| static |
| struct firmware_cal *tomtom_get_hwdep_fw_cal(struct snd_soc_codec *codec, |
| enum wcd_cal_type type) |
| { |
| struct tomtom_priv *tomtom; |
| struct firmware_cal *hwdep_cal; |
| |
| if (!codec) { |
| pr_err("%s: NULL codec pointer\n", __func__); |
| return NULL; |
| } |
| tomtom = snd_soc_codec_get_drvdata(codec); |
| hwdep_cal = wcdcal_get_fw_cal(tomtom->fw_data, type); |
| if (!hwdep_cal) { |
| dev_err(codec->dev, "%s: cal not sent by %d\n", |
| __func__, type); |
| return NULL; |
| } else { |
| return hwdep_cal; |
| } |
| } |
| |
| int tomtom_hs_detect(struct snd_soc_codec *codec, |
| struct wcd9xxx_mbhc_config *mbhc_cfg) |
| { |
| int rc; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| if (mbhc_cfg->insert_detect) { |
| rc = wcd9xxx_mbhc_start(&tomtom->mbhc, mbhc_cfg); |
| if (!rc) |
| tomtom->mbhc_started = true; |
| } else { |
| /* MBHC is disabled, so disable Auto pulldown */ |
| snd_soc_update_bits(codec, TOMTOM_A_MBHC_INSERT_DETECT2, 0xC0, |
| 0x00); |
| snd_soc_update_bits(codec, TOMTOM_A_MICB_CFILT_2_CTL, 0x01, |
| 0x00); |
| tomtom->mbhc.mbhc_cfg = NULL; |
| rc = 0; |
| } |
| return rc; |
| } |
| EXPORT_SYMBOL(tomtom_hs_detect); |
| |
| void tomtom_hs_detect_exit(struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| wcd9xxx_mbhc_stop(&tomtom->mbhc); |
| tomtom->mbhc_started = false; |
| } |
| EXPORT_SYMBOL(tomtom_hs_detect_exit); |
| |
| void tomtom_event_register( |
| int (*machine_event_cb)(struct snd_soc_codec *codec, |
| enum wcd9xxx_codec_event), |
| struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| tomtom->machine_codec_event_cb = machine_event_cb; |
| } |
| EXPORT_SYMBOL(tomtom_event_register); |
| |
| void tomtom_register_ext_clk_cb( |
| int (*codec_ext_clk_en)(struct snd_soc_codec *codec, |
| int enable, bool dapm), |
| int (*get_ext_clk_cnt)(void), |
| struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| tomtom->codec_ext_clk_en_cb = codec_ext_clk_en; |
| tomtom->codec_get_ext_clk_cnt = get_ext_clk_cnt; |
| } |
| EXPORT_SYMBOL(tomtom_register_ext_clk_cb); |
| |
| static void tomtom_init_slim_slave_cfg(struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| struct afe_param_cdc_slimbus_slave_cfg *cfg; |
| struct wcd9xxx *wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| uint64_t eaddr = 0; |
| |
| cfg = &priv->slimbus_slave_cfg; |
| cfg->minor_version = 1; |
| cfg->tx_slave_port_offset = 0; |
| cfg->rx_slave_port_offset = 16; |
| |
| memcpy(&eaddr, &wcd9xxx->slim->e_addr, sizeof(wcd9xxx->slim->e_addr)); |
| WARN_ON(sizeof(wcd9xxx->slim->e_addr) != 6); |
| cfg->device_enum_addr_lsw = eaddr & 0xFFFFFFFF; |
| cfg->device_enum_addr_msw = eaddr >> 32; |
| |
| pr_debug("%s: slimbus logical address 0x%llx\n", __func__, eaddr); |
| } |
| |
| static int tomtom_device_down(struct wcd9xxx *wcd9xxx) |
| { |
| int count; |
| struct snd_soc_codec *codec; |
| struct tomtom_priv *priv; |
| |
| codec = (struct snd_soc_codec *)(wcd9xxx->ssr_priv); |
| priv = snd_soc_codec_get_drvdata(codec); |
| wcd_cpe_ssr_event(priv->cpe_core, WCD_CPE_BUS_DOWN_EVENT); |
| snd_soc_card_change_online_state(codec->component.card, 0); |
| set_bit(BUS_DOWN, &priv->status_mask); |
| |
| for (count = 0; count < NUM_CODEC_DAIS; count++) |
| priv->dai[count].bus_down_in_recovery = true; |
| return 0; |
| } |
| |
| static int wcd9xxx_prepare_static_pa(struct wcd9xxx_mbhc *mbhc, |
| struct list_head *lh) |
| { |
| int i; |
| struct snd_soc_codec *codec = mbhc->codec; |
| u32 delay; |
| |
| const struct wcd9xxx_reg_mask_val reg_set_paon[] = { |
| {TOMTOM_A_TX_COM_BIAS, 0xff, 0xF0}, |
| {WCD9XXX_A_CDC_RX1_B6_CTL, 0xff, 0x81}, |
| {WCD9XXX_A_CDC_CLK_RX_B1_CTL, 0x01, 0x01}, |
| {WCD9XXX_A_BUCK_MODE_2, 0xff, 0xEF}, |
| {WCD9XXX_A_BUCK_MODE_2, 0xff, 0xEE}, |
| {TOMTOM_A_NCP_DTEST, 0xff, 0x20}, |
| {WCD9XXX_A_CDC_CLK_OTHR_CTL, 0xff, 0x21}, |
| {WCD9XXX_A_CDC_RX2_B6_CTL, 0xff, 0x81}, |
| {WCD9XXX_A_CDC_CLK_RX_B1_CTL, 0x02, 0x02}, |
| |
| {WCD9XXX_A_BUCK_MODE_2, 0xff, 0xAE}, |
| {WCD9XXX_A_BUCK_MODE_2, 0xff, 0xAA}, |
| {WCD9XXX_A_NCP_CLK, 0xff, 0x9C}, |
| {WCD9XXX_A_NCP_CLK, 0xff, 0xFC}, |
| {WCD9XXX_A_RX_COM_BIAS, 0xff, 0xA0}, |
| {WCD9XXX_A_BUCK_MODE_3, 0xff, 0xC6}, |
| {WCD9XXX_A_BUCK_MODE_4, 0xff, 0xE6}, |
| {WCD9XXX_A_BUCK_MODE_5, 0xff, 0x02}, |
| {WCD9XXX_A_BUCK_MODE_1, 0xff, 0xA1}, |
| /* Add a delay of 1ms after this reg write */ |
| |
| {WCD9XXX_A_NCP_STATIC, 0xff, 0x28}, |
| {WCD9XXX_A_NCP_EN, 0xff, 0xFF}, |
| /* Add a delay of 1ms after this reg write */ |
| |
| /* set HPHL */ |
| {WCD9XXX_A_RX_HPH_L_TEST, 0xff, 0x00}, |
| {TOMTOM_A_RX_HPH_L_PA_CTL, 0xff, 0x42}, |
| {TOMTOM_A_RX_HPH_BIAS_LDO, 0xff, 0x8C}, |
| {TOMTOM_A_RX_HPH_CHOP_CTL, 0xff, 0xA4}, |
| {WCD9XXX_A_RX_HPH_L_GAIN, 0xff, 0xE0}, |
| {WCD9XXX_A_RX_HPH_L_GAIN, 0xff, 0xEC}, |
| |
| /* set HPHR */ |
| {WCD9XXX_A_RX_HPH_R_TEST, 0xff, 0x00}, |
| {TOMTOM_A_RX_HPH_R_PA_CTL, 0xff, 0x42}, |
| {WCD9XXX_A_RX_HPH_R_GAIN, 0xff, 0x20}, |
| {WCD9XXX_A_RX_HPH_R_GAIN, 0xff, 0x2C}, |
| |
| /* set HPH PAs */ |
| {WCD9XXX_A_RX_HPH_BIAS_WG_OCP, 0xff, 0x2A}, |
| {WCD9XXX_A_RX_HPH_CNP_WG_CTL, 0xff, 0xDA}, |
| {WCD9XXX_A_RX_HPH_CNP_WG_TIME, 0xff, 0x15}, |
| {WCD9XXX_A_CDC_CLSH_B1_CTL, 0xff, 0xE6}, |
| {WCD9XXX_A_RX_HPH_L_DAC_CTL, 0xff, 0x40}, |
| {WCD9XXX_A_RX_HPH_L_DAC_CTL, 0xff, 0xC0}, |
| {WCD9XXX_A_RX_HPH_R_DAC_CTL, 0xff, 0x40}, |
| {WCD9XXX_A_RX_HPH_R_DAC_CTL, 0xff, 0xC0}, |
| |
| {TOMTOM_A_RX_HPH_L_ATEST, 0xff, 0x00}, |
| {TOMTOM_A_RX_HPH_R_ATEST, 0xff, 0x00}, |
| }; |
| |
| for (i = 0; i < ARRAY_SIZE(reg_set_paon); i++) { |
| /* |
| * Some of the codec registers like BUCK_MODE_1 |
| * and NCP_EN requires 1ms wait time for them |
| * to take effect. Other register writes for |
| * PA configuration do not require any wait time. |
| */ |
| if (reg_set_paon[i].reg == WCD9XXX_A_BUCK_MODE_1 || |
| reg_set_paon[i].reg == WCD9XXX_A_NCP_EN) |
| delay = 1000; |
| else |
| delay = 0; |
| wcd9xxx_soc_update_bits_push(codec, lh, |
| reg_set_paon[i].reg, |
| reg_set_paon[i].mask, |
| reg_set_paon[i].val, delay); |
| } |
| pr_debug("%s: PAs are prepared\n", __func__); |
| |
| return 0; |
| } |
| |
| static int wcd9xxx_enable_static_pa(struct wcd9xxx_mbhc *mbhc, bool enable, |
| u8 hph_pa) |
| { |
| struct snd_soc_codec *codec = mbhc->codec; |
| const int wg_time = snd_soc_read(codec, WCD9XXX_A_RX_HPH_CNP_WG_TIME) * |
| TOMTOM_WG_TIME_FACTOR_US; |
| u8 mask = (hph_pa << 4); |
| u8 pa_en = enable ? mask : ~mask; |
| |
| snd_soc_update_bits(codec, WCD9XXX_A_RX_HPH_CNP_EN, mask, pa_en); |
| /* Wait for wave gen time to avoid pop noise */ |
| usleep_range(wg_time, wg_time + WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| pr_debug("%s: PAs are %s as static mode (wg_time %d)\n", __func__, |
| enable ? "enabled" : "disabled", wg_time); |
| return 0; |
| } |
| |
| static int tomtom_setup_zdet(struct wcd9xxx_mbhc *mbhc, |
| enum mbhc_impedance_detect_stages stage) |
| { |
| int ret = 0; |
| struct snd_soc_codec *codec = mbhc->codec; |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| #define __wr(reg, mask, value) \ |
| do { \ |
| ret = wcd9xxx_soc_update_bits_push(codec, \ |
| &tomtom->reg_save_restore, \ |
| reg, mask, value, 0); \ |
| if (ret < 0) \ |
| return ret; \ |
| } while (0) |
| |
| switch (stage) { |
| |
| case MBHC_ZDET_PRE_MEASURE: |
| INIT_LIST_HEAD(&tomtom->reg_save_restore); |
| wcd9xxx_prepare_static_pa(mbhc, &tomtom->reg_save_restore); |
| /* Set HPH_MBHC for zdet */ |
| __wr(WCD9XXX_A_MBHC_HPH, 0xff, 0xC4); |
| usleep_range(10, 10 + WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| wcd9xxx_enable_static_pa(mbhc, HPH_PA_ENABLE, HPH_PA_L_R); |
| |
| /* save old value of registers and write the new value */ |
| __wr(WCD9XXX_A_RX_HPH_OCP_CTL, 0xff, 0x69); |
| __wr(WCD9XXX_A_CDC_RX1_B6_CTL, 0xff, 0x80); |
| __wr(WCD9XXX_A_CDC_RX2_B6_CTL, 0xff, 0x80); |
| /* Enable MBHC MUX, Set MUX current to 37.5uA and ADC7 */ |
| __wr(WCD9XXX_A_MBHC_SCALING_MUX_1, 0xff, 0xC0); |
| __wr(WCD9XXX_A_MBHC_SCALING_MUX_2, 0xff, 0xF0); |
| __wr(TOMTOM_A_TX_7_TXFE_CLKDIV, 0xff, 0x8B); |
| __wr(WCD9XXX_A_TX_7_MBHC_TEST_CTL, 0xff, 0x78); |
| __wr(WCD9XXX_A_TX_7_MBHC_EN, 0xff, 0x8C); |
| __wr(WCD9XXX_A_CDC_MBHC_B1_CTL, 0xff, 0xDC); |
| /* Reset MBHC and set it up for STA */ |
| __wr(WCD9XXX_A_CDC_MBHC_CLK_CTL, 0xff, 0x0A); |
| snd_soc_write(codec, WCD9XXX_A_CDC_MBHC_EN_CTL, 0x00); |
| __wr(WCD9XXX_A_CDC_MBHC_CLK_CTL, 0xff, 0x02); |
| __wr(WCD9XXX_A_CDC_MBHC_TIMER_B5_CTL, 0xff, 0x80); |
| __wr(WCD9XXX_A_CDC_MBHC_TIMER_B4_CTL, 0xff, 0x25); |
| /* Wait for ~50us to let MBHC hardware settle down */ |
| usleep_range(50, 50 + WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| break; |
| case MBHC_ZDET_POST_MEASURE: |
| /* 0x69 for 105 number of samples for PA RAMP */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B4_CTL, 0x69); |
| /* Program the PA Ramp to FS_16K, L shift 1 */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B3_CTL, |
| 0x1 << 4 | 0x6); |
| /* Reset the PA Ramp */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x1C); |
| /* |
| * Connect the PA Ramp to PA chain and release reset with |
| * keep it connected. |
| */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x1F); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x03); |
| |
| /* Start the PA ramp on HPH L and R */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x05); |
| /* Ramp generator takes ~30ms */ |
| usleep_range(TOMTOM_HPH_PA_RAMP_DELAY, |
| TOMTOM_HPH_PA_RAMP_DELAY + |
| WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| |
| /* |
| * Set the multiplication factor for zdet calculation |
| * based on the Ramp voltage and Gain used |
| */ |
| tomtom->zdet_gain_mul_fact = TOMTOM_ZDET_MUL_FACTOR_1X; |
| break; |
| case MBHC_ZDET_GAIN_0: |
| /* Set Gain at 1x */ |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_L_ATEST, 0x00); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_R_ATEST, 0x00); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_L_PA_CTL, 0x42); |
| /* Allow 100us for gain registers to settle */ |
| usleep_range(100, |
| 100 + WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| break; |
| case MBHC_ZDET_GAIN_UPDATE_1X: |
| /* |
| * Set the multiplication factor for zdet calculation |
| * based on the Gain value used |
| */ |
| tomtom->zdet_gain_mul_fact = TOMTOM_ZDET_MUL_FACTOR_1X; |
| break; |
| case MBHC_ZDET_GAIN_1: |
| /* Set Gain at 10x */ |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_L_ATEST, 0x10); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_R_ATEST, 0x00); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_L_PA_CTL, 0x42); |
| /* Allow 100us for gain registers to settle */ |
| usleep_range(100, |
| 100 + WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| |
| /* |
| * Set the multiplication factor for zdet calculation |
| * based on the Gain value used |
| */ |
| tomtom->zdet_gain_mul_fact = TOMTOM_ZDET_MUL_FACTOR_10X; |
| break; |
| case MBHC_ZDET_GAIN_2: |
| /* Set Gain at 100x */ |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_L_ATEST, 0x00); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_R_ATEST, 0x10); |
| snd_soc_write(codec, TOMTOM_A_RX_HPH_L_PA_CTL, 0x43); |
| /* Allow 100us for gain registers to settle */ |
| usleep_range(100, |
| 100 + WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| |
| /* |
| * Set the multiplication factor for zdet calculation |
| * based on the Gain value used |
| */ |
| tomtom->zdet_gain_mul_fact = TOMTOM_ZDET_MUL_FACTOR_100X; |
| break; |
| case MBHC_ZDET_RAMP_DISABLE: |
| /* Ramp HPH L & R back to Zero */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x00); |
| /* 0x69 for 105 number of samples for PA RAMP */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B4_CTL, 0x69); |
| /* Program the PA Ramp to FS_16K, L shift 1 */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B3_CTL, |
| 0x1 << 4 | 0x6); |
| /* Reset the PA Ramp */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x17); |
| /* |
| * Connect the PA Ramp to PA chain and release reset with |
| * keep it connected. |
| */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x03); |
| /* Start the PA ramp on HPH L and R */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x0A); |
| /* Ramp generator takes ~30ms to settle down */ |
| usleep_range(TOMTOM_HPH_PA_RAMP_DELAY, |
| TOMTOM_HPH_PA_RAMP_DELAY + |
| WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| break; |
| case MBHC_ZDET_HPHR_RAMP_DISABLE: |
| /* Ramp HPHR back to Zero */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x00); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B4_CTL, 0x69); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B3_CTL, |
| 0x1 << 4 | 0x6); |
| /* Reset the PA Ramp */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x17); |
| /* |
| * Connect the PA Ramp to PA chain and release reset with |
| * keep it connected. |
| */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x03); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x08); |
| /* Ramp generator takes ~30ms to settle down */ |
| usleep_range(TOMTOM_HPH_PA_RAMP_DELAY, |
| TOMTOM_HPH_PA_RAMP_DELAY + |
| WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| break; |
| case MBHC_ZDET_HPHL_RAMP_DISABLE: |
| /* Ramp back to Zero */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x00); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B4_CTL, 0x69); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B3_CTL, |
| 0x1 << 4 | 0x6); |
| /* Reset the PA Ramp */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x17); |
| /* |
| * Connect the PA Ramp to PA chain and release reset with |
| * keep it connected. |
| */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x03); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x02); |
| /* Ramp generator takes ~30ms to settle down */ |
| usleep_range(TOMTOM_HPH_PA_RAMP_DELAY, |
| TOMTOM_HPH_PA_RAMP_DELAY + |
| WCD9XXX_USLEEP_RANGE_MARGIN_US); |
| break; |
| case MBHC_ZDET_HPHR_PA_DISABLE: |
| /* Disable PA */ |
| wcd9xxx_enable_static_pa(mbhc, HPH_PA_DISABLE, HPH_PA_R); |
| break; |
| case MBHC_ZDET_PA_DISABLE: |
| /* Disable PA */ |
| if (!mbhc->hph_pa_dac_state && |
| (!(test_bit(MBHC_EVENT_PA_HPHL, &mbhc->event_state) || |
| test_bit(MBHC_EVENT_PA_HPHR, &mbhc->event_state)))) |
| wcd9xxx_enable_static_pa(mbhc, HPH_PA_DISABLE, |
| HPH_PA_L_R); |
| else if (!(snd_soc_read(codec, WCD9XXX_A_RX_HPH_CNP_EN) & 0x10)) |
| wcd9xxx_enable_static_pa(mbhc, HPH_PA_ENABLE, HPH_PA_R); |
| |
| /* Turn off PA ramp generator */ |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B1_CTL, 0x00); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B2_CTL, 0x00); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B3_CTL, 0x00); |
| snd_soc_write(codec, WCD9XXX_A_CDC_PA_RAMP_B4_CTL, 0x00); |
| |
| /* Restore registers */ |
| wcd9xxx_restore_registers(codec, &tomtom->reg_save_restore); |
| break; |
| } |
| #undef __wr |
| |
| return ret; |
| } |
| |
| /* Calculate final impedance values for HPH left and right based on formulae */ |
| static void tomtom_compute_impedance(struct wcd9xxx_mbhc *mbhc, s16 *l, s16 *r, |
| uint32_t *zl, uint32_t *zr) |
| { |
| s64 zln, zrn; |
| int zld, zrd; |
| s64 rl = 0, rr = 0; |
| struct snd_soc_codec *codec; |
| struct tomtom_priv *tomtom; |
| |
| if (!mbhc) { |
| pr_err("%s: Invalid parameters mbhc = %pK\n", |
| __func__, mbhc); |
| return; |
| } |
| codec = mbhc->codec; |
| tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| if (l && zl) { |
| zln = (s64) (l[1] - l[0]) * tomtom->zdet_gain_mul_fact; |
| zld = (l[2] - l[0]); |
| if (zld) |
| rl = div_s64(zln, zld); |
| else |
| /* If L0 and L2 are same, Z has to be on Zone 3. |
| * Assign a default value so that atleast the value |
| * is read again with Ramp-up |
| */ |
| rl = TOMTOM_ZDET_ZONE_3_DEFAULT_VAL; |
| |
| /* 32-bit LSBs are enough to hold Impedance values */ |
| *zl = (u32) rl; |
| } |
| if (r && zr) { |
| zrn = (s64) (r[1] - r[0]) * tomtom->zdet_gain_mul_fact; |
| zrd = (r[2] - r[0]); |
| if (zrd) |
| rr = div_s64(zrn, zrd); |
| else |
| /* If R0 and R2 are same, Z has to be on Zone 3. |
| * Assign a default value so that atleast the value |
| * is read again with Ramp-up |
| */ |
| rr = TOMTOM_ZDET_ZONE_3_DEFAULT_VAL; |
| |
| /* 32-bit LSBs are enough to hold Impedance values */ |
| *zr = (u32) rr; |
| } |
| } |
| |
| /* |
| * Calculate error approximation of impedance values for HPH left |
| * and HPH right based on QFuse values |
| */ |
| static void tomtom_zdet_error_approx(struct wcd9xxx_mbhc *mbhc, uint32_t *zl, |
| uint32_t *zr) |
| { |
| struct snd_soc_codec *codec; |
| struct tomtom_priv *tomtom; |
| s8 q1_t, q2_t; |
| s8 q1_m, q2_m; |
| s8 q1, q2; |
| u8 div_shift; |
| int rl_alpha = 0, rr_alpha = 0; |
| int rl_beta = 0, rr_beta = 0; |
| u64 rl = 0, rr = 0; |
| const int mult_factor = TOMTOM_ZDET_ERROR_APPROX_MUL_FACTOR; |
| const int shift = TOMTOM_ZDET_ERROR_APPROX_SHIFT; |
| |
| if (!zl || !zr || !mbhc) { |
| pr_err("%s: Invalid parameters zl = %pK zr = %pK, mbhc = %pK\n", |
| __func__, zl, zr, mbhc); |
| return; |
| } |
| codec = mbhc->codec; |
| tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| if ((tomtom->zdet_gain_mul_fact == TOMTOM_ZDET_MUL_FACTOR_1X) || |
| (tomtom->zdet_gain_mul_fact == TOMTOM_ZDET_MUL_FACTOR_10X)) { |
| q1_t = ((snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT0) & |
| 0x3) << 0x5); |
| q1_t |= ((snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT1) & |
| 0xF8) >> 0x3); |
| q2_t = ((snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT1) & |
| 0x7) << 0x4); |
| q2_t |= ((snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT2) & |
| 0xF0) >> 0x4); |
| /* Take out the numeric part of the Qfuse value */ |
| q1_m = q1_t & 0x3F; |
| q2_m = q2_t & 0x3F; |
| /* Check the sign part of the Qfuse and adjust value */ |
| q1 = (q1_t & 0x40) ? -q1_m : q1_m; |
| q2 = (q2_t & 0x40) ? -q2_m : q2_m; |
| div_shift = 1; |
| } else { |
| q1_t = ((snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT2) & |
| 0xF) << 0x2); |
| q1_t |= ((snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT3) & |
| 0xC0) >> 0x6); |
| q2_t = (snd_soc_read(codec, TOMTOM_A_QFUSE_DATA_OUT3) & 0x3F); |
| /* Take out the numeric part of the Qfuse value */ |
| q1_m = q1_t & 0x1F; |
| q2_m = q2_t & 0x1F; |
| /* Check the sign part of the Qfuse and adjust value */ |
| q1 = (q1_t & 0x20) ? -q1_m : q1_m; |
| q2 = (q2_t & 0x20) ? -q2_m : q2_m; |
| div_shift = 0; |
| } |
| |
| dev_dbg(codec->dev, "%s: qfuse1 = %d, qfuse2 = %d\n", |
| __func__, q1, q2); |
| if (!q1 && !q2) { |
| dev_dbg(codec->dev, "%s: qfuse1 and qfuse2 are 0. Exiting\n", |
| __func__); |
| return; |
| } |
| |
| /* |
| * Use multiplication and shift to avoid floating point math |
| * The Z value is calculated with the below formulae using |
| * the Qfuse value- |
| * zl = zl * [1 - {(Q1 / div) / 100}] (Include sign for Q1) |
| * zr = zr * [1 - {(Q2 / div) / 100}] (Include sign for Q2) |
| * We multiply by 65536 and shift 16 times to get the approx result |
| * div = 4 for 1x gain, div = 2 for 10x/100x gain |
| */ |
| /* Q1/4 */ |
| rl_alpha = q1 >> div_shift; |
| rl_alpha = 100 - rl_alpha; |
| /* {rl_alpha/100} * 65536 */ |
| rl_beta = rl_alpha * mult_factor; |
| rl = (u64) *zl * rl_beta; |
| /* rl/65536 */ |
| rl = (u64) rl >> shift; |
| |
| rr_alpha = q2 >> div_shift; |
| rr_alpha = 100 - rr_alpha; |
| rr_beta = rr_alpha * mult_factor; |
| rr = (u64) *zr * rr_beta; |
| rr = (u64) rr >> shift; |
| |
| dev_dbg(codec->dev, "%s: rl = 0x%llx (%lld) \t rr = 0x%llx (%lld)\n", |
| __func__, rl, rl, rr, rr); |
| |
| *zl = (u32) rl; |
| *zr = (u32) rr; |
| } |
| |
| static enum wcd9xxx_cdc_type tomtom_get_cdc_type(void) |
| { |
| return WCD9XXX_CDC_TYPE_TOMTOM; |
| } |
| |
| static bool tomtom_mbhc_ins_rem_status(struct snd_soc_codec *codec) |
| { |
| return !(snd_soc_read(codec, WCD9XXX_A_MBHC_INSERT_DET_STATUS) & |
| (1 << 4)); |
| } |
| |
| static void tomtom_mbhc_micb_pulldown_ctrl(struct wcd9xxx_mbhc *mbhc, |
| bool enable) |
| { |
| struct snd_soc_codec *codec = mbhc->codec; |
| |
| if (!enable) { |
| /* Remove automatic pulldown on micbias */ |
| snd_soc_update_bits(codec, mbhc->mbhc_bias_regs.cfilt_ctl, |
| 0x01, 0x00); |
| } else { |
| /* Enable automatic pulldown on micbias */ |
| snd_soc_update_bits(codec, mbhc->mbhc_bias_regs.cfilt_ctl, |
| 0x01, 0x01); |
| } |
| } |
| |
| static void tomtom_codec_hph_auto_pull_down(struct snd_soc_codec *codec, |
| bool enable) |
| { |
| struct wcd9xxx *tomtom_core = dev_get_drvdata(codec->dev->parent); |
| |
| if (TOMTOM_IS_1_0(tomtom_core->version)) |
| return; |
| |
| dev_dbg(codec->dev, "%s: %s auto pull down\n", __func__, |
| enable ? "enable" : "disable"); |
| if (enable) { |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_L_TEST, 0x08, 0x08); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_R_TEST, 0x08, 0x08); |
| } else { |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_L_TEST, 0x08, 0x00); |
| snd_soc_update_bits(codec, TOMTOM_A_RX_HPH_R_TEST, 0x08, 0x00); |
| } |
| } |
| |
| static const struct wcd9xxx_mbhc_cb mbhc_cb = { |
| .get_cdc_type = tomtom_get_cdc_type, |
| .setup_zdet = tomtom_setup_zdet, |
| .compute_impedance = tomtom_compute_impedance, |
| .zdet_error_approx = tomtom_zdet_error_approx, |
| .insert_rem_status = tomtom_mbhc_ins_rem_status, |
| .micbias_pulldown_ctrl = tomtom_mbhc_micb_pulldown_ctrl, |
| .codec_rco_ctrl = tomtom_codec_internal_rco_ctrl, |
| .hph_auto_pulldown_ctrl = tomtom_codec_hph_auto_pull_down, |
| .get_hwdep_fw_cal = tomtom_get_hwdep_fw_cal, |
| }; |
| |
| static const struct wcd9xxx_mbhc_intr cdc_intr_ids = { |
| .poll_plug_rem = WCD9XXX_IRQ_MBHC_REMOVAL, |
| .shortavg_complete = WCD9XXX_IRQ_MBHC_SHORT_TERM, |
| .potential_button_press = WCD9XXX_IRQ_MBHC_PRESS, |
| .button_release = WCD9XXX_IRQ_MBHC_RELEASE, |
| .dce_est_complete = WCD9XXX_IRQ_MBHC_POTENTIAL, |
| .insertion = WCD9XXX_IRQ_MBHC_INSERTION, |
| .hph_left_ocp = WCD9XXX_IRQ_HPH_PA_OCPL_FAULT, |
| .hph_right_ocp = WCD9XXX_IRQ_HPH_PA_OCPR_FAULT, |
| .hs_jack_switch = WCD9330_IRQ_MBHC_JACK_SWITCH, |
| }; |
| |
| static int tomtom_post_reset_cb(struct wcd9xxx *wcd9xxx) |
| { |
| int ret = 0; |
| struct snd_soc_codec *codec; |
| struct tomtom_priv *tomtom; |
| int rco_clk_rate; |
| |
| codec = (struct snd_soc_codec *)(wcd9xxx->ssr_priv); |
| tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| snd_soc_card_change_online_state(codec->component.card, 1); |
| clear_bit(BUS_DOWN, &tomtom->status_mask); |
| |
| mutex_lock(&tomtom->codec_mutex); |
| |
| tomtom_update_reg_defaults(codec); |
| if (wcd9xxx->mclk_rate == TOMTOM_MCLK_CLK_12P288MHZ) |
| snd_soc_update_bits(codec, TOMTOM_A_CHIP_CTL, 0x06, 0x0); |
| else if (wcd9xxx->mclk_rate == TOMTOM_MCLK_CLK_9P6MHZ) |
| snd_soc_update_bits(codec, TOMTOM_A_CHIP_CTL, 0x06, 0x2); |
| tomtom_codec_init_reg(codec); |
| |
| snd_soc_cache_sync(codec); |
| |
| ret = tomtom_handle_pdata(tomtom); |
| if (ret < 0) |
| pr_err("%s: bad pdata\n", __func__); |
| |
| tomtom_init_slim_slave_cfg(codec); |
| tomtom_slim_interface_init_reg(codec); |
| wcd_cpe_ssr_event(tomtom->cpe_core, WCD_CPE_BUS_UP_EVENT); |
| wcd9xxx_resmgr_post_ssr(&tomtom->resmgr); |
| |
| if (tomtom->mbhc_started) { |
| wcd9xxx_mbhc_deinit(&tomtom->mbhc); |
| tomtom->mbhc_started = false; |
| |
| if (wcd9xxx->mclk_rate == TOMTOM_MCLK_CLK_12P288MHZ) |
| rco_clk_rate = TOMTOM_MCLK_CLK_12P288MHZ; |
| else |
| rco_clk_rate = TOMTOM_MCLK_CLK_9P6MHZ; |
| |
| ret = wcd9xxx_mbhc_init(&tomtom->mbhc, &tomtom->resmgr, codec, |
| tomtom_enable_mbhc_micbias, |
| &mbhc_cb, &cdc_intr_ids, |
| rco_clk_rate, TOMTOM_ZDET_SUPPORTED); |
| if (ret) |
| pr_err("%s: mbhc init failed %d\n", __func__, ret); |
| else |
| tomtom_hs_detect(codec, tomtom->mbhc.mbhc_cfg); |
| } |
| |
| if (tomtom->machine_codec_event_cb) |
| tomtom->machine_codec_event_cb(codec, |
| WCD9XXX_CODEC_EVENT_CODEC_UP); |
| |
| tomtom_cleanup_irqs(tomtom); |
| ret = tomtom_setup_irqs(tomtom); |
| if (ret) |
| pr_err("%s: Failed to setup irq: %d\n", __func__, ret); |
| |
| /* |
| * After SSR, the qfuse sensing is lost. |
| * Perform qfuse sensing again after SSR |
| * handling is finished. |
| */ |
| tomtom_enable_qfuse_sensing(codec); |
| mutex_unlock(&tomtom->codec_mutex); |
| return ret; |
| } |
| |
| void *tomtom_get_afe_config(struct snd_soc_codec *codec, |
| enum afe_config_type config_type) |
| { |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| switch (config_type) { |
| case AFE_SLIMBUS_SLAVE_CONFIG: |
| return &priv->slimbus_slave_cfg; |
| case AFE_CDC_REGISTERS_CONFIG: |
| return &tomtom_audio_reg_cfg; |
| case AFE_SLIMBUS_SLAVE_PORT_CONFIG: |
| return &tomtom_slimbus_slave_port_cfg; |
| case AFE_AANC_VERSION: |
| return &tomtom_cdc_aanc_version; |
| case AFE_CLIP_BANK_SEL: |
| return &clip_bank_sel; |
| case AFE_CDC_CLIP_REGISTERS_CONFIG: |
| return &tomtom_clip_reg_cfg; |
| default: |
| pr_err("%s: Unknown config_type 0x%x\n", __func__, config_type); |
| return NULL; |
| } |
| } |
| |
| static struct wcd9xxx_reg_address tomtom_reg_address = { |
| .micb_4_mbhc = TOMTOM_A_MICB_4_MBHC, |
| .micb_4_int_rbias = TOMTOM_A_MICB_4_INT_RBIAS, |
| .micb_4_ctl = TOMTOM_A_MICB_4_CTL, |
| }; |
| |
| static int wcd9xxx_ssr_register(struct wcd9xxx *control, |
| int (*device_down_cb)(struct wcd9xxx *wcd9xxx), |
| int (*device_up_cb)(struct wcd9xxx *wcd9xxx), |
| void *priv) |
| { |
| control->dev_down = device_down_cb; |
| control->post_reset = device_up_cb; |
| control->ssr_priv = priv; |
| return 0; |
| } |
| |
| static const struct snd_soc_dapm_widget tomtom_1_dapm_widgets[] = { |
| SND_SOC_DAPM_ADC_E("ADC1", NULL, TOMTOM_A_TX_1_GAIN, 7, 0, |
| tomtom_codec_enable_adc, |
| SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_ADC_E("ADC2", NULL, TOMTOM_A_TX_2_GAIN, 7, 0, |
| tomtom_codec_enable_adc, |
| SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_ADC_E("ADC3", NULL, TOMTOM_A_TX_3_GAIN, 7, 0, |
| tomtom_codec_enable_adc, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_ADC_E("ADC4", NULL, TOMTOM_A_TX_4_GAIN, 7, 0, |
| tomtom_codec_enable_adc, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_ADC_E("ADC5", NULL, TOMTOM_A_TX_5_GAIN, 7, 0, |
| tomtom_codec_enable_adc, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_ADC_E("ADC6", NULL, TOMTOM_A_TX_6_GAIN, 7, 0, |
| tomtom_codec_enable_adc, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| }; |
| |
| static struct regulator *tomtom_codec_find_regulator(struct snd_soc_codec *cdc, |
| const char *name) |
| { |
| int i; |
| struct wcd9xxx *core = dev_get_drvdata(cdc->dev->parent); |
| |
| for (i = 0; i < core->num_of_supplies; i++) { |
| if (core->supplies[i].supply && |
| !strcmp(core->supplies[i].supply, name)) |
| return core->supplies[i].consumer; |
| } |
| |
| return NULL; |
| } |
| |
| static struct wcd_cpe_core *tomtom_codec_get_cpe_core( |
| struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *priv = snd_soc_codec_get_drvdata(codec); |
| |
| return priv->cpe_core; |
| } |
| |
| static int tomtom_codec_fll_enable(struct snd_soc_codec *codec, |
| bool enable) |
| { |
| struct wcd9xxx *wcd9xxx; |
| |
| if (!codec || !codec->control_data) { |
| pr_err("%s: Invalid codec handle, %pK\n", |
| __func__, codec); |
| return -EINVAL; |
| } |
| |
| wcd9xxx = codec->control_data; |
| |
| dev_dbg(codec->dev, "%s: %s, mclk_rate = %d\n", |
| __func__, (enable ? "enable" : "disable"), |
| wcd9xxx->mclk_rate); |
| |
| switch (wcd9xxx->mclk_rate) { |
| case TOMTOM_MCLK_CLK_9P6MHZ: |
| snd_soc_update_bits(codec, TOMTOM_A_FLL_NREF, |
| 0x1F, 0x15); |
| snd_soc_update_bits(codec, TOMTOM_A_FLL_KDCO_TUNE, |
| 0x07, 0x06); |
| snd_soc_write(codec, TOMTOM_A_FLL_LOCK_THRESH, 0xD1); |
| snd_soc_write(codec, TOMTOM_A_FLL_LOCK_DET_COUNT, |
| 0x40); |
| break; |
| case TOMTOM_MCLK_CLK_12P288MHZ: |
| snd_soc_update_bits(codec, TOMTOM_A_FLL_NREF, |
| 0x1F, 0x11); |
| snd_soc_update_bits(codec, TOMTOM_A_FLL_KDCO_TUNE, |
| 0x07, 0x05); |
| snd_soc_write(codec, TOMTOM_A_FLL_LOCK_THRESH, 0xB1); |
| snd_soc_write(codec, TOMTOM_A_FLL_LOCK_DET_COUNT, |
| 0x40); |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int tomtom_codec_slim_reserve_bw(struct snd_soc_codec *codec, |
| u32 bw_ops, bool commit) |
| { |
| struct wcd9xxx *wcd9xxx; |
| |
| if (!codec) { |
| pr_err("%s: Invalid handle to codec\n", |
| __func__); |
| return -EINVAL; |
| } |
| |
| wcd9xxx = dev_get_drvdata(codec->dev->parent); |
| |
| if (!wcd9xxx) { |
| dev_err(codec->dev, "%s: Invalid parent drv_data\n", |
| __func__); |
| return -EINVAL; |
| } |
| |
| return wcd9xxx_slim_reserve_bw(wcd9xxx, bw_ops, commit); |
| } |
| |
| static int tomtom_codec_vote_max_bw(struct snd_soc_codec *codec, |
| bool vote) |
| { |
| u32 bw_ops; |
| |
| if (vote) |
| bw_ops = SLIM_BW_CLK_GEAR_9; |
| else |
| bw_ops = SLIM_BW_UNVOTE; |
| |
| return tomtom_codec_slim_reserve_bw(codec, |
| bw_ops, true); |
| } |
| |
| static const struct wcd9xxx_resmgr_cb resmgr_cb = { |
| .cdc_rco_ctrl = tomtom_codec_internal_rco_ctrl, |
| }; |
| |
| static int tomtom_cpe_err_irq_control(struct snd_soc_codec *codec, |
| enum cpe_err_irq_cntl_type cntl_type, u8 *status) |
| { |
| switch (cntl_type) { |
| case CPE_ERR_IRQ_MASK: |
| snd_soc_update_bits(codec, |
| TOMTOM_A_SVASS_INT_MASK, |
| 0x3F, 0x3F); |
| break; |
| case CPE_ERR_IRQ_UNMASK: |
| snd_soc_update_bits(codec, |
| TOMTOM_A_SVASS_INT_MASK, |
| 0x3F, 0x0C); |
| break; |
| case CPE_ERR_IRQ_CLEAR: |
| snd_soc_update_bits(codec, |
| TOMTOM_A_SVASS_INT_CLR, |
| 0x3F, 0x3F); |
| break; |
| case CPE_ERR_IRQ_STATUS: |
| if (!status) |
| return -EINVAL; |
| *status = snd_soc_read(codec, |
| TOMTOM_A_SVASS_INT_STATUS); |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static const struct wcd_cpe_cdc_cb cpe_cb = { |
| .cdc_clk_en = tomtom_codec_internal_rco_ctrl, |
| .cpe_clk_en = tomtom_codec_fll_enable, |
| .lab_cdc_ch_ctl = tomtom_codec_enable_slimtx_mad, |
| .cdc_ext_clk = tomtom_codec_ext_clk_en, |
| .bus_vote_bw = tomtom_codec_vote_max_bw, |
| .cpe_err_irq_control = tomtom_cpe_err_irq_control, |
| }; |
| |
| static struct cpe_svc_init_param cpe_svc_params = { |
| .version = 0, |
| .query_freq_plans_cb = NULL, |
| .change_freq_plan_cb = NULL, |
| }; |
| |
| static int tomtom_cpe_initialize(struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| struct wcd_cpe_params cpe_params; |
| |
| memset(&cpe_params, 0, |
| sizeof(struct wcd_cpe_params)); |
| cpe_params.codec = codec; |
| cpe_params.get_cpe_core = tomtom_codec_get_cpe_core; |
| cpe_params.cdc_cb = &cpe_cb; |
| cpe_params.dbg_mode = cpe_debug_mode; |
| cpe_params.cdc_major_ver = CPE_SVC_CODEC_TOMTOM; |
| cpe_params.cdc_minor_ver = CPE_SVC_CODEC_V1P0; |
| cpe_params.cdc_id = CPE_SVC_CODEC_TOMTOM; |
| |
| cpe_params.cdc_irq_info.cpe_engine_irq = |
| WCD9330_IRQ_SVASS_ENGINE; |
| cpe_params.cdc_irq_info.cpe_err_irq = |
| WCD9330_IRQ_SVASS_ERR_EXCEPTION; |
| cpe_params.cdc_irq_info.cpe_fatal_irqs = |
| TOMTOM_CPE_FATAL_IRQS; |
| |
| cpe_svc_params.context = codec; |
| cpe_params.cpe_svc_params = &cpe_svc_params; |
| |
| tomtom->cpe_core = wcd_cpe_init("cpe", codec, |
| &cpe_params); |
| if (IS_ERR_OR_NULL(tomtom->cpe_core)) { |
| dev_err(codec->dev, |
| "%s: Failed to enable CPE\n", |
| __func__); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static int tomtom_codec_probe(struct snd_soc_codec *codec) |
| { |
| struct wcd9xxx *control; |
| struct tomtom_priv *tomtom; |
| struct wcd9xxx_pdata *pdata; |
| struct wcd9xxx *wcd9xxx; |
| struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec); |
| int ret = 0; |
| int i, rco_clk_rate; |
| void *ptr = NULL; |
| struct wcd9xxx_core_resource *core_res; |
| struct clk *wcd_ext_clk = NULL; |
| |
| dev_info(codec->dev, "%s()\n", __func__); |
| |
| control = dev_get_drvdata(codec->dev->parent); |
| |
| tomtom = snd_soc_codec_get_drvdata(codec); |
| |
| wcd9xxx_ssr_register(control, tomtom_device_down, |
| tomtom_post_reset_cb, (void *)codec); |
| |
| for (i = 0; i < NUM_DECIMATORS; i++) { |
| tx_hpf_work[i].tomtom = tomtom; |
| tx_hpf_work[i].decimator = i + 1; |
| tx_hpf_work[i].tx_hpf_bypass = false; |
| INIT_DELAYED_WORK(&tx_hpf_work[i].dwork, |
| tx_hpf_corner_freq_callback); |
| } |
| |
| wcd9xxx = control; |
| if (!of_find_property(wcd9xxx->dev->of_node, "clock-names", NULL)) { |
| dev_dbg(wcd9xxx->dev, "%s: codec not using audio-ext-clk driver\n", |
| __func__); |
| } else { |
| wcd_ext_clk = clk_get(wcd9xxx->dev, "wcd_clk"); |
| if (IS_ERR(wcd_ext_clk)) { |
| dev_err(codec->dev, "%s: clk get %s failed\n", |
| __func__, "wcd_ext_clk"); |
| goto err_nomem_slimch; |
| } |
| } |
| tomtom->wcd_ext_clk = wcd_ext_clk; |
| core_res = &wcd9xxx->core_res; |
| pdata = dev_get_platdata(codec->dev->parent); |
| /* codec resmgr module init */ |
| ret = wcd9xxx_resmgr_init(&tomtom->resmgr, codec, core_res, pdata, |
| &pdata->micbias, &tomtom_reg_address, |
| &resmgr_cb, WCD9XXX_CDC_TYPE_TOMTOM); |
| if (ret) { |
| pr_err("%s: wcd9xxx init failed %d\n", __func__, ret); |
| goto err_nomem_slimch; |
| } |
| |
| tomtom->clsh_d.buck_mv = tomtom_codec_get_buck_mv(codec); |
| /* TomTom does not support dynamic switching of vdd_cp */ |
| tomtom->clsh_d.is_dynamic_vdd_cp = false; |
| wcd9xxx_clsh_init(&tomtom->clsh_d, &tomtom->resmgr); |
| |
| if (wcd9xxx->mclk_rate == TOMTOM_MCLK_CLK_12P288MHZ) |
| rco_clk_rate = TOMTOM_MCLK_CLK_12P288MHZ; |
| else |
| rco_clk_rate = TOMTOM_MCLK_CLK_9P6MHZ; |
| |
| tomtom->fw_data = kzalloc(sizeof(*(tomtom->fw_data)), GFP_KERNEL); |
| if (!tomtom->fw_data) |
| goto err_nomem_slimch; |
| set_bit(WCD9XXX_ANC_CAL, tomtom->fw_data->cal_bit); |
| set_bit(WCD9XXX_MAD_CAL, tomtom->fw_data->cal_bit); |
| set_bit(WCD9XXX_MBHC_CAL, tomtom->fw_data->cal_bit); |
| ret = wcd_cal_create_hwdep(tomtom->fw_data, |
| WCD9XXX_CODEC_HWDEP_NODE, codec); |
| if (ret < 0) { |
| dev_err(codec->dev, "%s hwdep failed %d\n", __func__, ret); |
| goto err_hwdep; |
| } |
| |
| /* init and start mbhc */ |
| ret = wcd9xxx_mbhc_init(&tomtom->mbhc, &tomtom->resmgr, codec, |
| tomtom_enable_mbhc_micbias, |
| &mbhc_cb, &cdc_intr_ids, |
| rco_clk_rate, TOMTOM_ZDET_SUPPORTED); |
| if (ret) { |
| pr_err("%s: mbhc init failed %d\n", __func__, ret); |
| goto err_hwdep; |
| } |
| |
| tomtom->codec = codec; |
| for (i = 0; i < COMPANDER_MAX; i++) { |
| tomtom->comp_enabled[i] = 0; |
| tomtom->comp_fs[i] = COMPANDER_FS_48KHZ; |
| } |
| tomtom->intf_type = wcd9xxx_get_intf_type(); |
| tomtom->aux_pga_cnt = 0; |
| tomtom->aux_l_gain = 0x1F; |
| tomtom->aux_r_gain = 0x1F; |
| tomtom->ldo_h_users = 0; |
| tomtom->micb_2_users = 0; |
| tomtom_update_reg_defaults(codec); |
| pr_debug("%s: MCLK Rate = %x\n", __func__, wcd9xxx->mclk_rate); |
| if (wcd9xxx->mclk_rate == TOMTOM_MCLK_CLK_12P288MHZ) |
| snd_soc_update_bits(codec, TOMTOM_A_CHIP_CTL, 0x06, 0x0); |
| else if (wcd9xxx->mclk_rate == TOMTOM_MCLK_CLK_9P6MHZ) |
| snd_soc_update_bits(codec, TOMTOM_A_CHIP_CTL, 0x06, 0x2); |
| tomtom_codec_init_reg(codec); |
| |
| ret = tomtom_handle_pdata(tomtom); |
| if (ret < 0) { |
| pr_err("%s: bad pdata\n", __func__); |
| goto err_hwdep; |
| } |
| |
| tomtom->spkdrv_reg = tomtom_codec_find_regulator(codec, |
| WCD9XXX_VDD_SPKDRV_NAME); |
| tomtom->spkdrv2_reg = tomtom_codec_find_regulator(codec, |
| WCD9XXX_VDD_SPKDRV2_NAME); |
| |
| ptr = kmalloc((sizeof(tomtom_rx_chs) + |
| sizeof(tomtom_tx_chs)), GFP_KERNEL); |
| if (!ptr) { |
| ret = -ENOMEM; |
| goto err_hwdep; |
| } |
| |
| if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_I2C) { |
| snd_soc_dapm_new_controls(dapm, tomtom_dapm_i2s_widgets, |
| ARRAY_SIZE(tomtom_dapm_i2s_widgets)); |
| snd_soc_dapm_add_routes(dapm, audio_i2s_map, |
| ARRAY_SIZE(audio_i2s_map)); |
| for (i = 0; i < ARRAY_SIZE(tomtom_i2s_dai); i++) |
| INIT_LIST_HEAD(&tomtom->dai[i].wcd9xxx_ch_list); |
| } else if (tomtom->intf_type == WCD9XXX_INTERFACE_TYPE_SLIMBUS) { |
| for (i = 0; i < NUM_CODEC_DAIS; i++) { |
| INIT_LIST_HEAD(&tomtom->dai[i].wcd9xxx_ch_list); |
| init_waitqueue_head(&tomtom->dai[i].dai_wait); |
| } |
| tomtom_slimbus_slave_port_cfg.slave_dev_intfdev_la = |
| control->slim_slave->laddr; |
| tomtom_slimbus_slave_port_cfg.slave_dev_pgd_la = |
| control->slim->laddr; |
| tomtom_slimbus_slave_port_cfg.slave_port_mapping[0] = |
| TOMTOM_MAD_SLIMBUS_TX_PORT; |
| |
| tomtom_init_slim_slave_cfg(codec); |
| } |
| |
| snd_soc_dapm_new_controls(dapm, tomtom_1_dapm_widgets, |
| ARRAY_SIZE(tomtom_1_dapm_widgets)); |
| snd_soc_add_codec_controls(codec, |
| tomtom_1_x_analog_gain_controls, |
| ARRAY_SIZE(tomtom_1_x_analog_gain_controls)); |
| |
| snd_soc_add_codec_controls(codec, impedance_detect_controls, |
| ARRAY_SIZE(impedance_detect_controls)); |
| snd_soc_add_codec_controls(codec, hph_type_detect_controls, |
| ARRAY_SIZE(hph_type_detect_controls)); |
| |
| control->num_rx_port = TOMTOM_RX_MAX; |
| control->rx_chs = ptr; |
| memcpy(control->rx_chs, tomtom_rx_chs, sizeof(tomtom_rx_chs)); |
| control->num_tx_port = TOMTOM_TX_MAX; |
| control->tx_chs = ptr + sizeof(tomtom_rx_chs); |
| memcpy(control->tx_chs, tomtom_tx_chs, sizeof(tomtom_tx_chs)); |
| |
| snd_soc_dapm_sync(dapm); |
| |
| ret = tomtom_setup_irqs(tomtom); |
| if (ret) { |
| pr_err("%s: tomtom irq setup failed %d\n", __func__, ret); |
| goto err_pdata; |
| } |
| |
| atomic_set(&kp_tomtom_priv, (unsigned long)tomtom); |
| mutex_lock(&tomtom->codec_mutex); |
| snd_soc_dapm_disable_pin(dapm, "ANC HPHL"); |
| snd_soc_dapm_disable_pin(dapm, "ANC HPHR"); |
| snd_soc_dapm_disable_pin(dapm, "ANC HEADPHONE"); |
| snd_soc_dapm_disable_pin(dapm, "ANC EAR PA"); |
| snd_soc_dapm_disable_pin(dapm, "ANC EAR"); |
| mutex_unlock(&tomtom->codec_mutex); |
| snd_soc_dapm_sync(dapm); |
| |
| codec->component.ignore_pmdown_time = 1; |
| ret = tomtom_cpe_initialize(codec); |
| if (ret) { |
| dev_info(codec->dev, |
| "%s: cpe initialization failed, ret = %d\n", |
| __func__, ret); |
| /* Do not fail probe if CPE failed */ |
| ret = 0; |
| } |
| return ret; |
| |
| err_pdata: |
| kfree(ptr); |
| control->rx_chs = NULL; |
| control->tx_chs = NULL; |
| err_hwdep: |
| kfree(tomtom->fw_data); |
| tomtom->fw_data = NULL; |
| err_nomem_slimch: |
| devm_kfree(codec->dev, tomtom); |
| return ret; |
| } |
| static int tomtom_codec_remove(struct snd_soc_codec *codec) |
| { |
| struct tomtom_priv *tomtom = snd_soc_codec_get_drvdata(codec); |
| struct wcd9xxx *control; |
| |
| WCD9XXX_BG_CLK_LOCK(&tomtom->resmgr); |
| atomic_set(&kp_tomtom_priv, 0); |
| |
| WCD9XXX_BG_CLK_UNLOCK(&tomtom->resmgr); |
| |
| control = dev_get_drvdata(codec->dev->parent); |
| control->rx_chs = NULL; |
| control->tx_chs = NULL; |
| |
| if (tomtom->wcd_ext_clk) |
| clk_put(tomtom->wcd_ext_clk); |
| tomtom_cleanup_irqs(tomtom); |
| |
| /* cleanup MBHC */ |
| wcd9xxx_mbhc_deinit(&tomtom->mbhc); |
| /* cleanup resmgr */ |
| wcd9xxx_resmgr_deinit(&tomtom->resmgr); |
| |
| tomtom->spkdrv_reg = NULL; |
| tomtom->spkdrv2_reg = NULL; |
| |
| devm_kfree(codec->dev, tomtom); |
| return 0; |
| } |
| |
| static struct regmap *tomtom_get_regmap(struct device *dev) |
| { |
| struct wcd9xxx *control = dev_get_drvdata(dev->parent); |
| |
| return control->regmap; |
| } |
| |
| static struct snd_soc_codec_driver soc_codec_dev_tomtom = { |
| .probe = tomtom_codec_probe, |
| .remove = tomtom_codec_remove, |
| .get_regmap = tomtom_get_regmap, |
| .component_driver = { |
| .controls = tomtom_snd_controls, |
| .num_controls = ARRAY_SIZE(tomtom_snd_controls), |
| .dapm_widgets = tomtom_dapm_widgets, |
| .num_dapm_widgets = ARRAY_SIZE(tomtom_dapm_widgets), |
| .dapm_routes = audio_map, |
| .num_dapm_routes = ARRAY_SIZE(audio_map), |
| }, |
| }; |
| |
| #ifdef CONFIG_PM |
| static int tomtom_suspend(struct device *dev) |
| { |
| dev_dbg(dev, "%s: system suspend\n", __func__); |
| return 0; |
| } |
| |
| static int tomtom_resume(struct device *dev) |
| { |
| struct platform_device *pdev = to_platform_device(dev); |
| struct tomtom_priv *tomtom = platform_get_drvdata(pdev); |
| |
| if (!tomtom) { |
| dev_err(dev, "%s: tomtom private data is NULL\n", __func__); |
| return -EINVAL; |
| } |
| dev_dbg(dev, "%s: system resume\n", __func__); |
| /* Notify */ |
| wcd9xxx_resmgr_notifier_call(&tomtom->resmgr, |
| WCD9XXX_EVENT_POST_RESUME); |
| return 0; |
| } |
| |
| static const struct dev_pm_ops tomtom_pm_ops = { |
| .suspend = tomtom_suspend, |
| .resume = tomtom_resume, |
| }; |
| #endif |
| |
| static int tomtom_probe(struct platform_device *pdev) |
| { |
| int ret = 0; |
| struct tomtom_priv *tomtom; |
| |
| tomtom = devm_kzalloc(&pdev->dev, sizeof(struct tomtom_priv), |
| GFP_KERNEL); |
| if (!tomtom) |
| return -ENOMEM; |
| |
| platform_set_drvdata(pdev, tomtom); |
| |
| if (wcd9xxx_get_intf_type() == WCD9XXX_INTERFACE_TYPE_SLIMBUS) |
| ret = snd_soc_register_codec(&pdev->dev, &soc_codec_dev_tomtom, |
| tomtom_dai, ARRAY_SIZE(tomtom_dai)); |
| else if (wcd9xxx_get_intf_type() == WCD9XXX_INTERFACE_TYPE_I2C) |
| ret = snd_soc_register_codec(&pdev->dev, &soc_codec_dev_tomtom, |
| tomtom_i2s_dai, ARRAY_SIZE(tomtom_i2s_dai)); |
| mutex_init(&tomtom->codec_mutex); |
| return ret; |
| } |
| static int tomtom_remove(struct platform_device *pdev) |
| { |
| struct tomtom_priv *tomtom = platform_get_drvdata(pdev); |
| |
| mutex_destroy(&tomtom->codec_mutex); |
| snd_soc_unregister_codec(&pdev->dev); |
| return 0; |
| } |
| static struct platform_driver tomtom_codec_driver = { |
| .probe = tomtom_probe, |
| .remove = tomtom_remove, |
| .driver = { |
| .name = "tomtom_codec", |
| .owner = THIS_MODULE, |
| #ifdef CONFIG_PM |
| .pm = &tomtom_pm_ops, |
| #endif |
| }, |
| }; |
| |
| static int __init tomtom_codec_init(void) |
| { |
| return platform_driver_register(&tomtom_codec_driver); |
| } |
| |
| static void __exit tomtom_codec_exit(void) |
| { |
| platform_driver_unregister(&tomtom_codec_driver); |
| } |
| |
| module_init(tomtom_codec_init); |
| module_exit(tomtom_codec_exit); |
| |
| MODULE_DESCRIPTION("TomTom codec driver"); |
| MODULE_LICENSE("GPL v2"); |