// SPDX-License-Identifier: GPL-2.0-only
//
// Cirrus Logic CS48L32 audio DSP.
//
// Copyright (C) 2016-2018, 2020, 2022, 2025 Cirrus Logic, Inc. and
// Cirrus Logic International Semiconductor Ltd.
#include <dt-bindings/sound/cs48l32.h>
#include <linux/array_size.h>
#include <linux/build_bug.h>
#include <linux/clk.h>
#include <linux/container_of.h>
#include <linux/delay.h>
#include <linux/err.h>
#include <linux/gcd.h>
#include <linux/gpio/consumer.h>
#include <linux/minmax.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/pm_runtime.h>
#include <linux/property.h>
#include <linux/regmap.h>
#include <linux/regulator/consumer.h>
#include <linux/slab.h>
#include <linux/spi/spi.h>
#include <linux/string_choices.h>
#include <sound/cs48l32.h>
#include <sound/cs48l32_registers.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/soc.h>
#include <sound/soc-component.h>
#include <sound/soc-dai.h>
#include <sound/soc-dapm.h>
#include <sound/tlv.h>
#include "cs48l32.h"
static const char * const cs48l32_core_supplies[] = { "vdd-a" , "vdd-io" };
static const struct cs_dsp_region cs48l32_dsp1_regions[] = {
{ .type = WMFW_HALO_PM_PACKED, .base = 0x3800000 },
{ .type = WMFW_HALO_XM_PACKED, .base = 0x2000000 },
{ .type = WMFW_ADSP2_XM, .base = 0x2800000 },
{ .type = WMFW_HALO_YM_PACKED, .base = 0x2C00000 },
{ .type = WMFW_ADSP2_YM, .base = 0x3400000 },
};
static const struct cs48l32_dsp_power_reg_block cs48l32_dsp1_sram_ext_regs[] = {
{ CS48L32_DSP1_XM_SRAM_IBUS_SETUP_1, CS48L32_DSP1_XM_SRAM_IBUS_SETUP_24 },
{ CS48L32_DSP1_YM_SRAM_IBUS_SETUP_1, CS48L32_DSP1_YM_SRAM_IBUS_SETUP_8 },
{ CS48L32_DSP1_PM_SRAM_IBUS_SETUP_1, CS48L32_DSP1_PM_SRAM_IBUS_SETUP_7 },
};
static const unsigned int cs48l32_dsp1_sram_pwd_regs[] = {
CS48L32_DSP1_XM_SRAM_IBUS_SETUP_0,
CS48L32_DSP1_YM_SRAM_IBUS_SETUP_0,
CS48L32_DSP1_PM_SRAM_IBUS_SETUP_0,
};
static const struct cs48l32_dsp_power_regs cs48l32_dsp_sram_regs = {
.ext = cs48l32_dsp1_sram_ext_regs,
.n_ext = ARRAY_SIZE(cs48l32_dsp1_sram_ext_regs),
.pwd = cs48l32_dsp1_sram_pwd_regs,
.n_pwd = ARRAY_SIZE(cs48l32_dsp1_sram_pwd_regs),
};
static const char * const cs48l32_mixer_texts[] = {
"None" ,
"Tone Generator 1" ,
"Tone Generator 2" ,
"Noise Generator" ,
"IN1L" ,
"IN1R" ,
"IN2L" ,
"IN2R" ,
"ASP1RX1" ,
"ASP1RX2" ,
"ASP1RX3" ,
"ASP1RX4" ,
"ASP1RX5" ,
"ASP1RX6" ,
"ASP1RX7" ,
"ASP1RX8" ,
"ASP2RX1" ,
"ASP2RX2" ,
"ASP2RX3" ,
"ASP2RX4" ,
"ISRC1INT1" ,
"ISRC1INT2" ,
"ISRC1INT3" ,
"ISRC1INT4" ,
"ISRC1DEC1" ,
"ISRC1DEC2" ,
"ISRC1DEC3" ,
"ISRC1DEC4" ,
"ISRC2INT1" ,
"ISRC2INT2" ,
"ISRC2DEC1" ,
"ISRC2DEC2" ,
"ISRC3INT1" ,
"ISRC3INT2" ,
"ISRC3DEC1" ,
"ISRC3DEC2" ,
"EQ1" ,
"EQ2" ,
"EQ3" ,
"EQ4" ,
"DRC1L" ,
"DRC1R" ,
"DRC2L" ,
"DRC2R" ,
"LHPF1" ,
"LHPF2" ,
"LHPF3" ,
"LHPF4" ,
"Ultrasonic 1" ,
"Ultrasonic 2" ,
"DSP1.1" ,
"DSP1.2" ,
"DSP1.3" ,
"DSP1.4" ,
"DSP1.5" ,
"DSP1.6" ,
"DSP1.7" ,
"DSP1.8" ,
};
static unsigned int cs48l32_mixer_values[] = {
0x000, /* Silence (mute) */
0x004, /* Tone generator 1 */
0x005, /* Tone generator 2 */
0x00C, /* Noise Generator */
0x010, /* IN1L signal path */
0x011, /* IN1R signal path */
0x012, /* IN2L signal path */
0x013, /* IN2R signal path */
0x020, /* ASP1 RX1 */
0x021, /* ASP1 RX2 */
0x022, /* ASP1 RX3 */
0x023, /* ASP1 RX4 */
0x024, /* ASP1 RX5 */
0x025, /* ASP1 RX6 */
0x026, /* ASP1 RX7 */
0x027, /* ASP1 RX8 */
0x030, /* ASP2 RX1 */
0x031, /* ASP2 RX2 */
0x032, /* ASP2 RX3 */
0x033, /* ASP2 RX4 */
0x098, /* ISRC1 INT1 */
0x099, /* ISRC1 INT2 */
0x09a, /* ISRC1 INT3 */
0x09b, /* ISRC1 INT4 */
0x09C, /* ISRC1 DEC1 */
0x09D, /* ISRC1 DEC2 */
0x09e, /* ISRC1 DEC3 */
0x09f, /* ISRC1 DEC4 */
0x0A0, /* ISRC2 INT1 */
0x0A1, /* ISRC2 INT2 */
0x0A4, /* ISRC2 DEC1 */
0x0A5, /* ISRC2 DEC2 */
0x0A8, /* ISRC3 INT1 */
0x0A9, /* ISRC3 INT2 */
0x0AC, /* ISRC3 DEC1 */
0x0AD, /* ISRC3 DEC2 */
0x0B8, /* EQ1 */
0x0B9, /* EQ2 */
0x0BA, /* EQ3 */
0x0BB, /* EQ4 */
0x0C0, /* DRC1 Left */
0x0C1, /* DRC1 Right */
0x0C2, /* DRC2 Left */
0x0C3, /* DRC2 Right */
0x0C8, /* LHPF1 */
0x0C9, /* LHPF2 */
0x0CA, /* LHPF3 */
0x0CB, /* LHPF4 */
0x0D8, /* Ultrasonic 1 */
0x0D9, /* Ultrasonic 2 */
0x100, /* DSP1 channel 1 */
0x101, /* DSP1 channel 2 */
0x102, /* DSP1 channel 3 */
0x103, /* DSP1 channel 4 */
0x104, /* DSP1 channel 5 */
0x105, /* DSP1 channel 6 */
0x106, /* DSP1 channel 7 */
0x107, /* DSP1 channel 8 */
};
static_assert(ARRAY_SIZE(cs48l32_mixer_texts) == ARRAY_SIZE(cs48l32_mixer_values));
#define CS48L32_NUM_MIXER_INPUTS ARRAY_SIZE(cs48l32_mixer_values)
static const DECLARE_TLV_DB_SCALE(cs48l32_ana_tlv, 0, 100, 0);
static const DECLARE_TLV_DB_SCALE(cs48l32_eq_tlv, -1200, 100, 0);
static const DECLARE_TLV_DB_SCALE(cs48l32_digital_tlv, -6400, 50, 0);
static const DECLARE_TLV_DB_SCALE(cs48l32_noise_tlv, -10800, 600, 0);
static const DECLARE_TLV_DB_SCALE(cs48l32_mixer_tlv, -3200, 100, 0);
static const DECLARE_TLV_DB_SCALE(cs48l32_us_tlv, 0, 600, 0);
static void cs48l32_spin_sysclk(struct cs48l32_codec *cs48l32_codec)
{
struct cs48l32 *cs48l32 = &cs48l32_codec->core;
unsigned int val;
int ret, i;
/* Skip this if the chip is down */
if (pm_runtime_suspended(cs48l32->dev))
return ;
/*
* Just read a register a few times to ensure the internal
* oscillator sends out some clocks.
*/
for (i = 0; i < 4; i++) {
ret = regmap_read(cs48l32->regmap, CS48L32_DEVID, &val);
if (ret)
dev_err(cs48l32_codec->core.dev, "%s Failed to read register: %d (%d)\n" ,
__func__, ret, i);
}
udelay(300);
}
static const char * const cs48l32_rate_text[] = {
"Sample Rate 1" , "Sample Rate 2" , "Sample Rate 3" , "Sample Rate 4" ,
};
static const unsigned int cs48l32_rate_val[] = {
0x0, 0x1, 0x2, 0x3,
};
static_assert(ARRAY_SIZE(cs48l32_rate_val) == ARRAY_SIZE(cs48l32_rate_text));
static int cs48l32_rate_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
int ret;
/* Prevent any mixer mux changes while we do this */
mutex_lock(&cs48l32_codec->rate_lock);
/* The write must be guarded by a number of SYSCLK cycles */
cs48l32_spin_sysclk(cs48l32_codec);
ret = snd_soc_put_enum_double(kcontrol, ucontrol);
cs48l32_spin_sysclk(cs48l32_codec);
mutex_unlock(&cs48l32_codec->rate_lock);
return ret;
}
static const char * const cs48l32_sample_rate_text[] = {
"12kHz" ,
"24kHz" ,
"48kHz" ,
"96kHz" ,
"192kHz" ,
"384kHz" ,
"768kHz" ,
"11.025kHz" ,
"22.05kHz" ,
"44.1kHz" ,
"88.2kHz" ,
"176.4kHz" ,
"352.8kHz" ,
"705.6kHz" ,
"8kHz" ,
"16kHz" ,
"32kHz" ,
};
static const unsigned int cs48l32_sample_rate_val[] = {
0x01, /* 12kHz */
0x02, /* 24kHz */
0x03, /* 48kHz */
0x04, /* 96kHz */
0x05, /* 192kHz */
0x06, /* 384kHz */
0x07, /* 768kHz */
0x09, /* 11.025kHz */
0x0a, /* 22.05kHz */
0x0b, /* 44.1kHz */
0x0c, /* 88.2kHz */
0x0d, /* 176.4kHz */
0x0e, /* 352.8kHz */
0x0f, /* 705.6kHz */
0x11, /* 8kHz */
0x12, /* 16kHz */
0x13, /* 32kHz */
};
static_assert(ARRAY_SIZE(cs48l32_sample_rate_val) == ARRAY_SIZE(cs48l32_sample_rate_text));
#define CS48L32_SAMPLE_RATE_ENUM_SIZE ARRAY_SIZE(cs48l32_sample_rate_val)
static const struct soc_enum cs48l32_sample_rate[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_SAMPLE_RATE1,
CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_1_MASK >> CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_ENUM_SIZE,
cs48l32_sample_rate_text,
cs48l32_sample_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_SAMPLE_RATE2,
CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_1_MASK >> CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_ENUM_SIZE,
cs48l32_sample_rate_text,
cs48l32_sample_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_SAMPLE_RATE3,
CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_1_MASK >> CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_ENUM_SIZE,
cs48l32_sample_rate_text,
cs48l32_sample_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_SAMPLE_RATE4,
CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_1_MASK >> CS48L32_SAMPLE_RATE_1_SHIFT,
CS48L32_SAMPLE_RATE_ENUM_SIZE,
cs48l32_sample_rate_text,
cs48l32_sample_rate_val),
};
static int cs48l32_inmux_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_dapm_kcontrol_component(kcontrol);
struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct soc_enum *e = (struct soc_enum *) kcontrol->private_value;
unsigned int mux, src_val, in_type;
int ret;
mux = ucontrol->value.enumerated.item[0];
if (mux > 1)
return -EINVAL;
switch (e->reg) {
case CS48L32_IN1L_CONTROL1:
in_type = cs48l32_codec->in_type[0][mux];
break ;
case CS48L32_IN1R_CONTROL1:
in_type = cs48l32_codec->in_type[1][mux];
break ;
default :
return -EINVAL;
}
src_val = mux << e->shift_l;
if (in_type == CS48L32_IN_TYPE_SE)
src_val |= 1 << CS48L32_INx_SRC_SHIFT;
ret = snd_soc_component_update_bits(dapm->component,
e->reg,
CS48L32_INx_SRC_MASK,
src_val);
if (ret > 0)
snd_soc_dapm_mux_update_power(dapm, kcontrol, mux, e, NULL);
return ret;
}
static const char * const cs48l32_inmux_texts[] = {
"Analog 1" , "Analog 2" ,
};
static SOC_ENUM_SINGLE_DECL(cs48l32_in1muxl_enum,
CS48L32_IN1L_CONTROL1,
CS48L32_INx_SRC_SHIFT + 1,
cs48l32_inmux_texts);
static SOC_ENUM_SINGLE_DECL(cs48l32_in1muxr_enum,
CS48L32_IN1R_CONTROL1,
CS48L32_INx_SRC_SHIFT + 1,
cs48l32_inmux_texts);
static const struct snd_kcontrol_new cs48l32_inmux[] = {
SOC_DAPM_ENUM_EXT("IN1L Mux" , cs48l32_in1muxl_enum,
snd_soc_dapm_get_enum_double, cs48l32_inmux_put),
SOC_DAPM_ENUM_EXT("IN1R Mux" , cs48l32_in1muxr_enum,
snd_soc_dapm_get_enum_double, cs48l32_inmux_put),
};
static const char * const cs48l32_dmode_texts[] = {
"Analog" , "Digital" ,
};
static int cs48l32_dmode_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_dapm_context *dapm = snd_soc_dapm_kcontrol_dapm(kcontrol);
struct snd_soc_component *component = snd_soc_dapm_to_component(dapm);
struct soc_enum *e = (struct soc_enum *) kcontrol->private_value;
unsigned int mode;
int ret, result;
mode = ucontrol->value.enumerated.item[0];
switch (mode) {
case 0:
ret = snd_soc_component_update_bits(component,
CS48L32_ADC1L_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
CS48L32_ADC1x_INT_ENA_FRC_MASK);
if (ret < 0) {
dev_err(component->dev,
"Failed to set ADC1L_INT_ENA_FRC: %d\n" , ret);
return ret;
}
ret = snd_soc_component_update_bits(component,
CS48L32_ADC1R_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
CS48L32_ADC1x_INT_ENA_FRC_MASK);
if (ret < 0) {
dev_err(component->dev,
"Failed to set ADC1R_INT_ENA_FRC: %d\n" , ret);
return ret;
}
result = snd_soc_component_update_bits(component,
e->reg,
BIT(CS48L32_IN1_MODE_SHIFT),
0);
if (result < 0) {
dev_err(component->dev, "Failed to set input mode: %d\n" , result);
return result;
}
usleep_range(200, 300);
ret = snd_soc_component_update_bits(component,
CS48L32_ADC1L_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
0);
if (ret < 0) {
dev_err(component->dev,
"Failed to clear ADC1L_INT_ENA_FRC: %d\n" , ret);
return ret;
}
ret = snd_soc_component_update_bits(component,
CS48L32_ADC1R_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
0);
if (ret < 0) {
dev_err(component->dev,
"Failed to clear ADC1R_INT_ENA_FRC: %d\n" , ret);
return ret;
}
if (result > 0)
snd_soc_dapm_mux_update_power(dapm, kcontrol, mode, e, NULL);
return result;
case 1:
return snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
default :
return -EINVAL;
}
}
static SOC_ENUM_SINGLE_DECL(cs48l32_in1dmode_enum,
CS48L32_INPUT1_CONTROL1,
CS48L32_IN1_MODE_SHIFT,
cs48l32_dmode_texts);
static const struct snd_kcontrol_new cs48l32_dmode_mux[] = {
SOC_DAPM_ENUM_EXT("IN1 Mode" , cs48l32_in1dmode_enum,
snd_soc_dapm_get_enum_double, cs48l32_dmode_put),
};
static const char * const cs48l32_in_texts[] = {
"IN1L" , "IN1R" , "IN2L" , "IN2R" ,
};
static_assert(ARRAY_SIZE(cs48l32_in_texts) == CS48L32_MAX_INPUT);
static const char * const cs48l32_us_freq_texts[] = {
"16-24kHz" , "20-28kHz" ,
};
static const unsigned int cs48l32_us_freq_val[] = {
0x2, 0x3,
};
static const struct soc_enum cs48l32_us_freq[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_US1_CONTROL,
CS48L32_US1_FREQ_SHIFT,
CS48L32_US1_FREQ_MASK >> CS48L32_US1_FREQ_SHIFT,
ARRAY_SIZE(cs48l32_us_freq_val),
cs48l32_us_freq_texts,
cs48l32_us_freq_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_US2_CONTROL,
CS48L32_US1_FREQ_SHIFT,
CS48L32_US1_FREQ_MASK >> CS48L32_US1_FREQ_SHIFT,
ARRAY_SIZE(cs48l32_us_freq_val),
cs48l32_us_freq_texts,
cs48l32_us_freq_val),
};
static const unsigned int cs48l32_us_in_val[] = {
0x0, 0x1, 0x2, 0x3,
};
static const struct soc_enum cs48l32_us_inmux_enum[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_US1_CONTROL,
CS48L32_US1_SRC_SHIFT,
CS48L32_US1_SRC_MASK >> CS48L32_US1_SRC_SHIFT,
ARRAY_SIZE(cs48l32_us_in_val),
cs48l32_in_texts,
cs48l32_us_in_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_US2_CONTROL,
CS48L32_US1_SRC_SHIFT,
CS48L32_US1_SRC_MASK >> CS48L32_US1_SRC_SHIFT,
ARRAY_SIZE(cs48l32_us_in_val),
cs48l32_in_texts,
cs48l32_us_in_val),
};
static const struct snd_kcontrol_new cs48l32_us_inmux[] = {
SOC_DAPM_ENUM("Ultrasonic 1 Input" , cs48l32_us_inmux_enum[0]),
SOC_DAPM_ENUM("Ultrasonic 2 Input" , cs48l32_us_inmux_enum[1]),
};
static const char * const cs48l32_us_det_thr_texts[] = {
"-6dB" , "-9dB" , "-12dB" , "-15dB" , "-18dB" , "-21dB" , "-24dB" , "-27dB" ,
};
static const struct soc_enum cs48l32_us_det_thr[] = {
SOC_ENUM_SINGLE(CS48L32_US1_DET_CONTROL,
CS48L32_US1_DET_THR_SHIFT,
ARRAY_SIZE(cs48l32_us_det_thr_texts),
cs48l32_us_det_thr_texts),
SOC_ENUM_SINGLE(CS48L32_US2_DET_CONTROL,
CS48L32_US1_DET_THR_SHIFT,
ARRAY_SIZE(cs48l32_us_det_thr_texts),
cs48l32_us_det_thr_texts),
};
static const char * const cs48l32_us_det_num_texts[] = {
"1 Sample" ,
"2 Samples" ,
"4 Samples" ,
"8 Samples" ,
"16 Samples" ,
"32 Samples" ,
"64 Samples" ,
"128 Samples" ,
"256 Samples" ,
"512 Samples" ,
"1024 Samples" ,
"2048 Samples" ,
"4096 Samples" ,
"8192 Samples" ,
"16384 Samples" ,
"32768 Samples" ,
};
static const struct soc_enum cs48l32_us_det_num[] = {
SOC_ENUM_SINGLE(CS48L32_US1_DET_CONTROL,
CS48L32_US1_DET_NUM_SHIFT,
ARRAY_SIZE(cs48l32_us_det_num_texts),
cs48l32_us_det_num_texts),
SOC_ENUM_SINGLE(CS48L32_US2_DET_CONTROL,
CS48L32_US1_DET_NUM_SHIFT,
ARRAY_SIZE(cs48l32_us_det_num_texts),
cs48l32_us_det_num_texts),
};
static const char * const cs48l32_us_det_hold_texts[] = {
"0 Samples" ,
"31 Samples" ,
"63 Samples" ,
"127 Samples" ,
"255 Samples" ,
"511 Samples" ,
"1023 Samples" ,
"2047 Samples" ,
"4095 Samples" ,
"8191 Samples" ,
"16383 Samples" ,
"32767 Samples" ,
"65535 Samples" ,
"131071 Samples" ,
"262143 Samples" ,
"524287 Samples" ,
};
static const struct soc_enum cs48l32_us_det_hold[] = {
SOC_ENUM_SINGLE(CS48L32_US1_DET_CONTROL,
CS48L32_US1_DET_HOLD_SHIFT,
ARRAY_SIZE(cs48l32_us_det_hold_texts),
cs48l32_us_det_hold_texts),
SOC_ENUM_SINGLE(CS48L32_US2_DET_CONTROL,
CS48L32_US1_DET_HOLD_SHIFT,
ARRAY_SIZE(cs48l32_us_det_hold_texts),
cs48l32_us_det_hold_texts),
};
static const struct soc_enum cs48l32_us_output_rate[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_US1_CONTROL,
CS48L32_US1_RATE_SHIFT,
CS48L32_US1_RATE_MASK >> CS48L32_US1_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_US2_CONTROL,
CS48L32_US1_RATE_SHIFT,
CS48L32_US1_RATE_MASK >> CS48L32_US1_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
};
static const char * const cs48l32_us_det_lpf_cut_texts[] = {
"1722Hz" , "833Hz" , "408Hz" , "203Hz" ,
};
static const struct soc_enum cs48l32_us_det_lpf_cut[] = {
SOC_ENUM_SINGLE(CS48L32_US1_DET_CONTROL,
CS48L32_US1_DET_LPF_CUT_SHIFT,
ARRAY_SIZE(cs48l32_us_det_lpf_cut_texts),
cs48l32_us_det_lpf_cut_texts),
SOC_ENUM_SINGLE(CS48L32_US2_DET_CONTROL,
CS48L32_US1_DET_LPF_CUT_SHIFT,
ARRAY_SIZE(cs48l32_us_det_lpf_cut_texts),
cs48l32_us_det_lpf_cut_texts),
};
static const char * const cs48l32_us_det_dcy_texts[] = {
"0 ms" , "0.79 ms" , "1.58 ms" , "3.16 ms" , "6.33 ms" , "12.67 ms" , "25.34 ms" , "50.69 ms" ,
};
static const struct soc_enum cs48l32_us_det_dcy[] = {
SOC_ENUM_SINGLE(CS48L32_US1_DET_CONTROL,
CS48L32_US1_DET_DCY_SHIFT,
ARRAY_SIZE(cs48l32_us_det_dcy_texts),
cs48l32_us_det_dcy_texts),
SOC_ENUM_SINGLE(CS48L32_US2_DET_CONTROL,
CS48L32_US1_DET_DCY_SHIFT,
ARRAY_SIZE(cs48l32_us_det_dcy_texts),
cs48l32_us_det_dcy_texts),
};
static const struct snd_kcontrol_new cs48l32_us_switch[] = {
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
};
static const char * const cs48l32_vol_ramp_text[] = {
"0ms/6dB" , "0.5ms/6dB" , "1ms/6dB" , "2ms/6dB" , "4ms/6dB" , "8ms/6dB" , "16ms/6dB" , "32ms/6dB" ,
};
static SOC_ENUM_SINGLE_DECL(cs48l32_in_vd_ramp,
CS48L32_INPUT_VOL_CONTROL,
CS48L32_IN_VD_RAMP_SHIFT,
cs48l32_vol_ramp_text);
static SOC_ENUM_SINGLE_DECL(cs48l32_in_vi_ramp,
CS48L32_INPUT_VOL_CONTROL,
CS48L32_IN_VI_RAMP_SHIFT,
cs48l32_vol_ramp_text);
static const char * const cs48l32_in_hpf_cut_text[] = {
"2.5Hz" , "5Hz" , "10Hz" , "20Hz" , "40Hz"
};
static SOC_ENUM_SINGLE_DECL(cs48l32_in_hpf_cut_enum,
CS48L32_INPUT_HPF_CONTROL,
CS48L32_IN_HPF_CUT_SHIFT,
cs48l32_in_hpf_cut_text);
static const char * const cs48l32_in_dmic_osr_text[] = {
"384kHz" , "768kHz" , "1.536MHz" , "2.048MHz" , "2.4576MHz" , "3.072MHz" , "6.144MHz" ,
};
static const struct soc_enum cs48l32_in_dmic_osr[] = {
SOC_ENUM_SINGLE(CS48L32_INPUT1_CONTROL1,
CS48L32_IN1_OSR_SHIFT,
ARRAY_SIZE(cs48l32_in_dmic_osr_text),
cs48l32_in_dmic_osr_text),
SOC_ENUM_SINGLE(CS48L32_INPUT2_CONTROL1,
CS48L32_IN1_OSR_SHIFT,
ARRAY_SIZE(cs48l32_in_dmic_osr_text),
cs48l32_in_dmic_osr_text),
};
static bool cs48l32_is_input_enabled(struct snd_soc_component *component,
unsigned int reg)
{
unsigned int input_active;
input_active = snd_soc_component_read(component, CS48L32_INPUT_CONTROL);
switch (reg) {
case CS48L32_IN1L_CONTROL1:
return input_active & BIT(CS48L32_IN1L_EN_SHIFT);
case CS48L32_IN1R_CONTROL1:
return input_active & BIT(CS48L32_IN1R_EN_SHIFT);
case CS48L32_IN2L_CONTROL1:
return input_active & BIT(CS48L32_IN2L_EN_SHIFT);
case CS48L32_IN2R_CONTROL1:
return input_active & BIT(CS48L32_IN2R_EN_SHIFT);
default :
return false ;
}
}
static int cs48l32_in_rate_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
int ret;
snd_soc_dapm_mutex_lock(dapm);
/* Cannot change rate on an active input */
if (cs48l32_is_input_enabled(component, e->reg)) {
ret = -EBUSY;
goto exit ;
}
ret = snd_soc_put_enum_double(kcontrol, ucontrol);
exit :
snd_soc_dapm_mutex_unlock(dapm);
return ret;
}
static const struct soc_enum cs48l32_input_rate[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_IN1L_CONTROL1,
CS48L32_INx_RATE_SHIFT,
CS48L32_INx_RATE_MASK >> CS48L32_INx_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_IN1R_CONTROL1,
CS48L32_INx_RATE_SHIFT,
CS48L32_INx_RATE_MASK >> CS48L32_INx_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_IN2L_CONTROL1,
CS48L32_INx_RATE_SHIFT,
CS48L32_INx_RATE_MASK >> CS48L32_INx_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_IN2R_CONTROL1,
CS48L32_INx_RATE_SHIFT,
CS48L32_INx_RATE_MASK >> CS48L32_INx_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
};
static int cs48l32_low_power_mode_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct soc_mixer_control *mc = (struct soc_mixer_control *)kcontrol->private_value;
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
int ret;
snd_soc_dapm_mutex_lock(dapm);
/* Cannot change rate on an active input */
if (cs48l32_is_input_enabled(component, mc->reg)) {
ret = -EBUSY;
goto exit ;
}
ret = snd_soc_put_volsw(kcontrol, ucontrol);
exit :
snd_soc_dapm_mutex_unlock(dapm);
return ret;
}
static const struct soc_enum noise_gen_rate =
SOC_VALUE_ENUM_SINGLE(CS48L32_COMFORT_NOISE_GENERATOR,
CS48L32_NOISE_GEN_RATE_SHIFT,
CS48L32_NOISE_GEN_RATE_MASK >> CS48L32_NOISE_GEN_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val);
static const char * const cs48l32_auxpdm_freq_texts[] = {
"3.072MHz" , "2.048MHz" , "1.536MHz" , "768kHz" ,
};
static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm1_freq,
CS48L32_AUXPDM1_CONTROL1,
CS48L32_AUXPDM1_FREQ_SHIFT,
cs48l32_auxpdm_freq_texts);
static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm2_freq,
CS48L32_AUXPDM2_CONTROL1,
CS48L32_AUXPDM1_FREQ_SHIFT,
cs48l32_auxpdm_freq_texts);
static const char * const cs48l32_auxpdm_src_texts[] = {
"Analog" , "IN1 Digital" , "IN2 Digital" ,
};
static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm1_in,
CS48L32_AUXPDM_CTRL2,
CS48L32_AUXPDMDAT1_SRC_SHIFT,
cs48l32_auxpdm_src_texts);
static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm2_in,
CS48L32_AUXPDM_CTRL2,
CS48L32_AUXPDMDAT2_SRC_SHIFT,
cs48l32_auxpdm_src_texts);
static const struct snd_kcontrol_new cs48l32_auxpdm_inmux[] = {
SOC_DAPM_ENUM("AUXPDM1 Input" , cs48l32_auxpdm1_in),
SOC_DAPM_ENUM("AUXPDM2 Input" , cs48l32_auxpdm2_in),
};
static const unsigned int cs48l32_auxpdm_analog_in_val[] = {
0x0, 0x1,
};
static const struct soc_enum cs48l32_auxpdm_analog_inmux_enum[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_AUXPDM1_CONTROL1,
CS48L32_AUXPDM1_SRC_SHIFT,
CS48L32_AUXPDM1_SRC_MASK >> CS48L32_AUXPDM1_SRC_SHIFT,
ARRAY_SIZE(cs48l32_auxpdm_analog_in_val),
cs48l32_in_texts,
cs48l32_auxpdm_analog_in_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_AUXPDM2_CONTROL1,
CS48L32_AUXPDM1_SRC_SHIFT,
CS48L32_AUXPDM1_SRC_MASK >> CS48L32_AUXPDM1_SRC_SHIFT,
ARRAY_SIZE(cs48l32_auxpdm_analog_in_val),
cs48l32_in_texts,
cs48l32_auxpdm_analog_in_val),
};
static const struct snd_kcontrol_new cs48l32_auxpdm_analog_inmux[] = {
SOC_DAPM_ENUM("AUXPDM1 Analog Input" , cs48l32_auxpdm_analog_inmux_enum[0]),
SOC_DAPM_ENUM("AUXPDM2 Analog Input" , cs48l32_auxpdm_analog_inmux_enum[1]),
};
static const struct snd_kcontrol_new cs48l32_auxpdm_switch[] = {
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
};
static const struct soc_enum cs48l32_isrc_fsh[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_ISRC1_CONTROL1,
CS48L32_ISRC1_FSH_SHIFT,
CS48L32_ISRC1_FSH_MASK >> CS48L32_ISRC1_FSH_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_ISRC2_CONTROL1,
CS48L32_ISRC1_FSH_SHIFT,
CS48L32_ISRC1_FSH_MASK >> CS48L32_ISRC1_FSH_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_ISRC3_CONTROL1,
CS48L32_ISRC1_FSH_SHIFT,
CS48L32_ISRC1_FSH_MASK >> CS48L32_ISRC1_FSH_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
};
static const struct soc_enum cs48l32_isrc_fsl[] = {
SOC_VALUE_ENUM_SINGLE(CS48L32_ISRC1_CONTROL1,
CS48L32_ISRC1_FSL_SHIFT,
CS48L32_ISRC1_FSL_MASK >> CS48L32_ISRC1_FSL_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_ISRC2_CONTROL1,
CS48L32_ISRC1_FSL_SHIFT,
CS48L32_ISRC1_FSL_MASK >> CS48L32_ISRC1_FSL_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(CS48L32_ISRC3_CONTROL1,
CS48L32_ISRC1_FSL_SHIFT,
CS48L32_ISRC1_FSL_MASK >> CS48L32_ISRC1_FSL_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val),
};
static const struct soc_enum cs48l32_fx_rate =
SOC_VALUE_ENUM_SINGLE(CS48L32_FX_SAMPLE_RATE,
CS48L32_FX_RATE_SHIFT,
CS48L32_FX_RATE_MASK >> CS48L32_FX_RATE_SHIFT,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text,
cs48l32_rate_val);
static const char * const cs48l32_lhpf_mode_text[] = {
"Low-pass" , "High-pass"
};
static const struct soc_enum cs48l32_lhpf_mode[] = {
SOC_ENUM_SINGLE(CS48L32_LHPF_CONTROL2, 0,
ARRAY_SIZE(cs48l32_lhpf_mode_text), cs48l32_lhpf_mode_text),
SOC_ENUM_SINGLE(CS48L32_LHPF_CONTROL2, 1,
ARRAY_SIZE(cs48l32_lhpf_mode_text), cs48l32_lhpf_mode_text),
SOC_ENUM_SINGLE(CS48L32_LHPF_CONTROL2, 2,
ARRAY_SIZE(cs48l32_lhpf_mode_text), cs48l32_lhpf_mode_text),
SOC_ENUM_SINGLE(CS48L32_LHPF_CONTROL2, 3,
ARRAY_SIZE(cs48l32_lhpf_mode_text), cs48l32_lhpf_mode_text),
};
static int cs48l32_lhpf_coeff_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
__be32 *data = (__be32 *)ucontrol->value.bytes.data;
s16 val = (s16)be32_to_cpu(*data);
if (abs(val) > CS48L32_LHPF_MAX_COEFF) {
dev_err(cs48l32_codec->core.dev, "Rejecting unstable LHPF coefficients\n" );
return -EINVAL;
}
return snd_soc_bytes_put(kcontrol, ucontrol);
}
static const char * const cs48l32_eq_mode_text[] = {
"Low-pass" , "High-pass" ,
};
static const struct soc_enum cs48l32_eq_mode[] = {
SOC_ENUM_SINGLE(CS48L32_EQ_CONTROL2, 0,
ARRAY_SIZE(cs48l32_eq_mode_text),
cs48l32_eq_mode_text),
SOC_ENUM_SINGLE(CS48L32_EQ_CONTROL2, 1,
ARRAY_SIZE(cs48l32_eq_mode_text),
cs48l32_eq_mode_text),
SOC_ENUM_SINGLE(CS48L32_EQ_CONTROL2, 2,
ARRAY_SIZE(cs48l32_eq_mode_text),
cs48l32_eq_mode_text),
SOC_ENUM_SINGLE(CS48L32_EQ_CONTROL2, 3,
ARRAY_SIZE(cs48l32_eq_mode_text),
cs48l32_eq_mode_text),
};
static int cs48l32_eq_mode_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct soc_enum *e = (struct soc_enum *) kcontrol->private_value;
unsigned int item;
item = snd_soc_enum_val_to_item(e, cs48l32_codec->eq_mode[e->shift_l]);
ucontrol->value.enumerated.item[0] = item;
return 0;
}
static int cs48l32_eq_mode_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct soc_enum *e = (struct soc_enum *) kcontrol->private_value;
unsigned int *item = ucontrol->value.enumerated.item;
unsigned int val;
bool changed = false ;
if (item[0] >= e->items)
return -EINVAL;
val = snd_soc_enum_item_to_val(e, item[0]);
snd_soc_dapm_mutex_lock(dapm);
if (cs48l32_codec->eq_mode[e->shift_l] != val) {
cs48l32_codec->eq_mode[e->shift_l] = val;
changed = true ;
}
snd_soc_dapm_mutex_unlock(dapm);
return changed;
}
static int cs48l32_eq_coeff_info(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_info *uinfo)
{
struct cs48l32_eq_control *ctl = (void *) kcontrol->private_value;
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
uinfo->count = 1;
uinfo->value.integer.min = 0;
uinfo->value.integer.max = ctl->max;
return 0;
}
static int cs48l32_eq_coeff_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct cs48l32_eq_control *params = (void *)kcontrol->private_value;
__be16 *coeffs;
unsigned int coeff_idx;
int block_idx;
block_idx = ((int ) params->block_base - (int ) CS48L32_EQ1_BAND1_COEFF1);
block_idx /= (CS48L32_EQ2_BAND1_COEFF1 - CS48L32_EQ1_BAND1_COEFF1);
coeffs = &cs48l32_codec->eq_coefficients[block_idx][0];
coeff_idx = (params->reg - params->block_base) / 2;
/* High __be16 is in [coeff_idx] and low __be16 in [coeff_idx + 1] */
if (params->shift == 0)
coeff_idx++;
ucontrol->value.integer.value[0] = be16_to_cpu(coeffs[coeff_idx]);
return 0;
}
static int cs48l32_eq_coeff_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct cs48l32_eq_control *params = (void *)kcontrol->private_value;
__be16 *coeffs;
unsigned int coeff_idx;
int block_idx;
block_idx = ((int ) params->block_base - (int ) CS48L32_EQ1_BAND1_COEFF1);
block_idx /= (CS48L32_EQ2_BAND1_COEFF1 - CS48L32_EQ1_BAND1_COEFF1);
coeffs = &cs48l32_codec->eq_coefficients[block_idx][0];
coeff_idx = (params->reg - params->block_base) / 2;
/* Put high __be16 in [coeff_idx] and low __be16 in [coeff_idx + 1] */
if (params->shift == 0)
coeff_idx++;
snd_soc_dapm_mutex_lock(dapm);
coeffs[coeff_idx] = cpu_to_be16(ucontrol->value.integer.value[0]);
snd_soc_dapm_mutex_unlock(dapm);
return 0;
}
static const struct snd_kcontrol_new cs48l32_drc_activity_output_mux[] = {
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
};
static const struct snd_kcontrol_new cs48l32_dsp_trigger_output_mux[] = {
SOC_DAPM_SINGLE("Switch" , SND_SOC_NOPM, 0, 1, 0),
};
static int cs48l32_dsp_rate_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct soc_enum *e = (struct soc_enum *) kcontrol->private_value;
unsigned int cached_rate;
const unsigned int rate_num = e->mask;
int item;
if (rate_num >= ARRAY_SIZE(cs48l32_codec->dsp_dma_rates))
return -EINVAL;
cached_rate = cs48l32_codec->dsp_dma_rates[rate_num];
item = snd_soc_enum_val_to_item(e, cached_rate);
ucontrol->value.enumerated.item[0] = item;
return 0;
}
static int cs48l32_dsp_rate_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct soc_enum *e = (struct soc_enum *) kcontrol->private_value;
const unsigned int rate_num = e->mask;
const unsigned int item = ucontrol->value.enumerated.item[0];
unsigned int val;
bool changed = false ;
if (item >= e->items)
return -EINVAL;
if (rate_num >= ARRAY_SIZE(cs48l32_codec->dsp_dma_rates))
return -EINVAL;
val = snd_soc_enum_item_to_val(e, item);
snd_soc_dapm_mutex_lock(dapm);
if (cs48l32_codec->dsp_dma_rates[rate_num] != val) {
cs48l32_codec->dsp_dma_rates[rate_num] = val;
changed = true ;
}
snd_soc_dapm_mutex_unlock(dapm);
return changed;
}
static const struct soc_enum cs48l32_dsp_rate_enum[] = {
/* RX rates */
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
0,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
1,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
2,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
3,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
4,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
5,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
6,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
7,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
/* TX rates */
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
8,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
9,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
10,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
11,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
12,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
13,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
14,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
SOC_VALUE_ENUM_SINGLE(SND_SOC_NOPM, 0,
15,
ARRAY_SIZE(cs48l32_rate_text),
cs48l32_rate_text, cs48l32_rate_val),
};
static int cs48l32_dsp_pre_run(struct wm_adsp *dsp)
{
struct cs48l32_codec *cs48l32_codec = container_of(dsp, struct cs48l32_codec, dsp);
unsigned int reg;
const u8 *rate = cs48l32_codec->dsp_dma_rates;
int i;
reg = dsp->cs_dsp.base + CS48L32_HALO_SAMPLE_RATE_RX1;
for (i = 0; i < CS48L32_DSP_N_RX_CHANNELS; ++i) {
regmap_update_bits(dsp->cs_dsp.regmap, reg, CS48L32_HALO_DSP_RATE_MASK, *rate);
reg += 8;
rate++;
}
reg = dsp->cs_dsp.base + CS48L32_HALO_SAMPLE_RATE_TX1;
for (i = 0; i < CS48L32_DSP_N_TX_CHANNELS; ++i) {
regmap_update_bits(dsp->cs_dsp.regmap, reg, CS48L32_HALO_DSP_RATE_MASK, *rate);
reg += 8;
rate++;
}
usleep_range(300, 600);
return 0;
}
static void cs48l32_dsp_memory_disable(struct cs48l32_codec *cs48l32_codec,
const struct cs48l32_dsp_power_regs *regs)
{
struct regmap *regmap = cs48l32_codec->core.regmap;
int i, j, ret;
for (i = 0; i < regs->n_pwd; ++i) {
ret = regmap_write(regmap, regs->pwd[i], 0);
if (ret)
goto err;
}
for (i = 0; i < regs->n_ext; ++i) {
for (j = regs->ext[i].start; j <= regs->ext[i].end; j += 4) {
ret = regmap_write(regmap, j, 0);
if (ret)
goto err;
}
}
return ;
err:
dev_warn(cs48l32_codec->core.dev, "Failed to write SRAM enables (%d)\n" , ret);
}
static int cs48l32_dsp_memory_enable(struct cs48l32_codec *cs48l32_codec,
const struct cs48l32_dsp_power_regs *regs)
{
struct regmap *regmap = cs48l32_codec->core.regmap;
int i, j, ret;
/* disable power-off */
for (i = 0; i < regs->n_ext; ++i) {
for (j = regs->ext[i].start; j <= regs->ext[i].end; j += 4) {
ret = regmap_write(regmap, j, 0x3);
if (ret)
goto err;
}
}
/* power-up the banks in sequence */
for (i = 0; i < regs->n_pwd; ++i) {
ret = regmap_write(regmap, regs->pwd[i], 0x1);
if (ret)
goto err;
udelay(1); /* allow bank to power-up */
ret = regmap_write(regmap, regs->pwd[i], 0x3);
if (ret)
goto err;
udelay(1); /* allow bank to power-up */
}
return 0;
err:
dev_err(cs48l32_codec->core.dev, "Failed to write SRAM enables (%d)\n" , ret);
cs48l32_dsp_memory_disable(cs48l32_codec, regs);
return ret;
}
static int cs48l32_dsp_freq_update(struct snd_soc_dapm_widget *w, unsigned int freq_reg,
unsigned int freqsel_reg)
{
struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
struct wm_adsp *dsp = &cs48l32_codec->dsp;
int ret;
unsigned int freq, freq_sel, freq_sts;
if (!freq_reg)
return -EINVAL;
ret = regmap_read(regmap, freq_reg, &freq);
if (ret) {
dev_err(component->dev, "Failed to read #%x: %d\n" , freq_reg, ret);
return ret;
}
if (freqsel_reg) {
freq_sts = (freq & CS48L32_SYSCLK_FREQ_STS_MASK) >> CS48L32_SYSCLK_FREQ_STS_SHIFT;
ret = regmap_read(regmap, freqsel_reg, &freq_sel);
if (ret) {
dev_err(component->dev, "Failed to read #%x: %d\n" , freqsel_reg, ret);
return ret;
}
freq_sel = (freq_sel & CS48L32_SYSCLK_FREQ_MASK) >> CS48L32_SYSCLK_FREQ_SHIFT;
if (freq_sts != freq_sel) {
dev_err(component->dev, "SYSCLK FREQ (#%x) != FREQ STS (#%x)\n" ,
freq_sel, freq_sts);
return -ETIMEDOUT;
}
}
freq &= CS48L32_DSP_CLK_FREQ_MASK;
freq >>= CS48L32_DSP_CLK_FREQ_SHIFT;
ret = regmap_write(dsp->cs_dsp.regmap,
dsp->cs_dsp.base + CS48L32_DSP_CLOCK_FREQ_OFFS, freq);
if (ret) {
dev_err(component->dev, "Failed to set HALO clock freq: %d\n" , ret);
return ret;
}
return 0;
}
static int cs48l32_dsp_freq_ev(struct snd_soc_dapm_widget *w,
struct snd_kcontrol *kcontrol, int event)
{
switch (event) {
case SND_SOC_DAPM_POST_PMU:
return cs48l32_dsp_freq_update(w, CS48L32_SYSTEM_CLOCK2, CS48L32_SYSTEM_CLOCK1);
default :
return 0;
}
}
static irqreturn_t cs48l32_irq(int irq, void *data)
{
static const unsigned int eint1_regs[] = {
CS48L32_IRQ1_EINT_9, CS48L32_IRQ1_MASK_9,
CS48L32_IRQ1_EINT_7, CS48L32_IRQ1_MASK_7
};
u32 reg_vals[4];
struct cs48l32_codec *cs48l32_codec = data;
struct regmap *regmap = cs48l32_codec->core.regmap;
irqreturn_t result = IRQ_NONE;
unsigned int eint_pending;
int i, ret;
static_assert(ARRAY_SIZE(eint1_regs) == ARRAY_SIZE(reg_vals));
ret = pm_runtime_resume_and_get(cs48l32_codec->core.dev);
if (ret) {
dev_warn(cs48l32_codec->core.dev, "irq could not get pm runtime: %d\n" , ret);
return IRQ_NONE;
}
ret = regmap_read(regmap, CS48L32_IRQ1_STATUS, &eint_pending);
if (ret) {
dev_warn(cs48l32_codec->core.dev, "Read IRQ1_STATUS failed: %d\n" , ret);
return IRQ_NONE;
}
if ((eint_pending & CS48L32_IRQ1_STS_MASK) == 0)
goto out;
ret = regmap_multi_reg_read(regmap, eint1_regs, reg_vals, ARRAY_SIZE(reg_vals));
if (ret) {
dev_warn(cs48l32_codec->core.dev, "Read IRQ regs failed: %d\n" , ret);
return IRQ_NONE;
}
for (i = 0; i < ARRAY_SIZE(reg_vals); i += 2) {
reg_vals[i] &= ~reg_vals[i + 1];
regmap_write(regmap, eint1_regs[i], reg_vals[i]);
}
if (reg_vals[0] & CS48L32_DSP1_IRQ0_EINT1_MASK)
wm_adsp_compr_handle_irq(&cs48l32_codec->dsp);
if (reg_vals[2] & CS48L32_DSP1_MPU_ERR_EINT1_MASK) {
dev_warn(cs48l32_codec->core.dev, "MPU err IRQ\n" );
wm_halo_bus_error(irq, &cs48l32_codec->dsp);
}
if (reg_vals[2] & CS48L32_DSP1_WDT_EXPIRE_EINT1_MASK) {
dev_warn(cs48l32_codec->core.dev, "WDT expire IRQ\n" );
wm_halo_wdt_expire(irq, &cs48l32_codec->dsp);
}
result = IRQ_HANDLED;
out:
pm_runtime_put_autosuspend(cs48l32_codec->core.dev);
return result;
}
static int cs48l32_get_dspclk_setting(struct cs48l32_codec *cs48l32_codec, unsigned int freq,
int src, unsigned int *val)
{
freq /= 15625; /* convert to 1/64ths of 1MHz */
*val |= freq << CS48L32_DSP_CLK_FREQ_SHIFT;
return 0;
}
static int cs48l32_get_sysclk_setting(unsigned int freq)
{
switch (freq) {
case 0:
case 5644800:
case 6144000:
return CS48L32_SYSCLK_RATE_6MHZ;
case 11289600:
case 12288000:
return CS48L32_SYSCLK_RATE_12MHZ << CS48L32_SYSCLK_FREQ_SHIFT;
case 22579200:
case 24576000:
return CS48L32_SYSCLK_RATE_24MHZ << CS48L32_SYSCLK_FREQ_SHIFT;
case 45158400:
case 49152000:
return CS48L32_SYSCLK_RATE_49MHZ << CS48L32_SYSCLK_FREQ_SHIFT;
case 90316800:
case 98304000:
return CS48L32_SYSCLK_RATE_98MHZ << CS48L32_SYSCLK_FREQ_SHIFT;
default :
return -EINVAL;
}
}
static int cs48l32_set_pdm_fllclk(struct snd_soc_component *component, int source)
{
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
unsigned int val;
switch (source) {
case CS48L32_PDMCLK_SRC_IN1_PDMCLK:
case CS48L32_PDMCLK_SRC_IN2_PDMCLK:
case CS48L32_PDMCLK_SRC_IN3_PDMCLK:
case CS48L32_PDMCLK_SRC_IN4_PDMCLK:
case CS48L32_PDMCLK_SRC_AUXPDM1_CLK:
case CS48L32_PDMCLK_SRC_AUXPDM2_CLK:
val = source << CS48L32_PDM_FLLCLK_SRC_SHIFT;
break ;
default :
dev_err(cs48l32_codec->core.dev, "Invalid PDM FLLCLK src %d\n" , source);
return -EINVAL;
}
return regmap_update_bits(regmap, CS48L32_INPUT_CONTROL2,
CS48L32_PDM_FLLCLK_SRC_MASK, val);
}
static int cs48l32_set_sysclk(struct snd_soc_component *component, int clk_id, int source,
unsigned int freq, int dir)
{
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
char *name;
unsigned int reg;
unsigned int mask = CS48L32_SYSCLK_SRC_MASK;
unsigned int val = source << CS48L32_SYSCLK_SRC_SHIFT;
int clk_freq_sel, *clk;
switch (clk_id) {
case CS48L32_CLK_SYSCLK_1:
name = "SYSCLK" ;
reg = CS48L32_SYSTEM_CLOCK1;
clk = &cs48l32_codec->sysclk;
clk_freq_sel = cs48l32_get_sysclk_setting(freq);
mask |= CS48L32_SYSCLK_FREQ_MASK | CS48L32_SYSCLK_FRAC_MASK;
break ;
case CS48L32_CLK_DSPCLK:
name = "DSPCLK" ;
reg = CS48L32_DSP_CLOCK1;
clk = &cs48l32_codec->dspclk;
clk_freq_sel = cs48l32_get_dspclk_setting(cs48l32_codec, freq, source, &val);
mask |= CS48L32_DSP_CLK_FREQ_MASK;
break ;
case CS48L32_CLK_PDM_FLLCLK:
return cs48l32_set_pdm_fllclk(component, source);
default :
return -EINVAL;
}
if (clk_freq_sel < 0) {
dev_err(cs48l32_codec->core.dev, "Failed to get %s setting for %dHZ\n" , name, freq);
return clk_freq_sel;
}
*clk = freq;
if (freq == 0) {
dev_dbg(cs48l32_codec->core.dev, "%s cleared\n" , name);
return 0;
}
val |= clk_freq_sel;
if (freq % 6144000)
val |= CS48L32_SYSCLK_FRAC_MASK;
dev_dbg(cs48l32_codec->core.dev, "%s set to %uHz" , name, freq);
return regmap_update_bits(regmap, reg, mask, val);
}
static int cs48l32_is_enabled_fll(struct cs48l32_fll *fll, int base)
{
struct regmap *regmap = fll->codec->core.regmap;
unsigned int reg;
int ret;
ret = regmap_read(regmap, base + CS48L32_FLL_CONTROL1_OFFS, ®);
if (ret != 0) {
cs48l32_fll_err(fll, "Failed to read current state: %d\n" , ret);
return ret;
}
return reg & CS48L32_FLL_EN_MASK;
}
static int cs48l32_wait_for_fll(struct cs48l32_fll *fll, bool requested)
{
struct regmap *regmap = fll->codec->core.regmap;
unsigned int val = 0;
int i;
cs48l32_fll_dbg(fll, "Waiting for FLL...\n" );
for (i = 0; i < 30; i++) {
regmap_read(regmap, fll->sts_addr, &val);
if (!!(val & fll->sts_mask) == requested)
return 0;
switch (i) {
case 0 ... 5:
usleep_range(75, 125);
break ;
case 6 ... 20:
usleep_range(750, 1250);
break ;
default :
fsleep(20000);
break ;
}
}
cs48l32_fll_warn(fll, "Timed out waiting for %s\n" , requested ? "lock" : "unlock" );
return -ETIMEDOUT;
}
static int cs48l32_fllhj_disable(struct cs48l32_fll *fll)
{
struct cs48l32 *cs48l32 = &fll->codec->core;
bool change;
cs48l32_fll_dbg(fll, "Disabling FLL\n" );
/*
* Disable lockdet, but don't set ctrl_upd update bit. This allows the
* lock status bit to clear as normal, but should the FLL be enabled
* again due to a control clock being required, the lock won't re-assert
* as the FLL config registers are automatically applied when the FLL
* enables.
*/
regmap_set_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_HOLD_MASK);
regmap_clear_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL2_OFFS,
CS48L32_FLL_LOCKDET_MASK);
regmap_set_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL5_OFFS,
CS48L32_FLL_FRC_INTEG_UPD_MASK);
regmap_update_bits_check(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_EN_MASK,
0,
&change);
cs48l32_wait_for_fll(fll, false );
/*
* ctrl_up gates the writes to all the fll's registers, setting it to 0
* here ensures that after a runtime suspend/resume cycle when one
* enables the fll then ctrl_up is the last bit that is configured
* by the fll enable code rather than the cache sync operation which
* would have updated it much earlier before writing out all fll
* registers
*/
regmap_clear_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_CTRL_UPD_MASK);
if (change)
pm_runtime_put_autosuspend(cs48l32->dev);
return 0;
}
static int cs48l32_fllhj_apply(struct cs48l32_fll *fll, int fin)
{
struct regmap *regmap = fll->codec->core.regmap;
int refdiv, fref, fout, lockdet_thr, fbdiv, fllgcd;
bool frac = false ;
unsigned int fll_n, min_n, max_n, ratio, theta, lambda, hp;
unsigned int gains, num;
cs48l32_fll_dbg(fll, "fin=%d, fout=%d\n" , fin, fll->fout);
for (refdiv = 0; refdiv < 4; refdiv++) {
if ((fin / (1 << refdiv)) <= CS48L32_FLLHJ_MAX_THRESH)
break ;
}
fref = fin / (1 << refdiv);
fout = fll->fout;
frac = fout % fref;
/*
* Use simple heuristic approach to find a configuration that
* should work for most input clocks.
*/
if (fref < CS48L32_FLLHJ_LOW_THRESH) {
lockdet_thr = 2;
gains = CS48L32_FLLHJ_LOW_GAINS;
if (frac)
fbdiv = 256;
else
fbdiv = 4;
} else if (fref < CS48L32_FLLHJ_MID_THRESH) {
lockdet_thr = 8;
gains = CS48L32_FLLHJ_MID_GAINS;
fbdiv = (frac) ? 16 : 2;
} else {
lockdet_thr = 8;
gains = CS48L32_FLLHJ_HIGH_GAINS;
fbdiv = 1;
}
/* Use high performance mode for fractional configurations. */
if (frac) {
hp = 3;
min_n = CS48L32_FLLHJ_FRAC_MIN_N;
max_n = CS48L32_FLLHJ_FRAC_MAX_N;
} else {
if (fref < CS48L32_FLLHJ_LP_INT_MODE_THRESH)
hp = 0;
else
hp = 1;
min_n = CS48L32_FLLHJ_INT_MIN_N;
max_n = CS48L32_FLLHJ_INT_MAX_N;
}
ratio = fout / fref;
cs48l32_fll_dbg(fll, "refdiv=%d, fref=%d, frac:%d\n" , refdiv, fref, frac);
while (ratio / fbdiv < min_n) {
fbdiv /= 2;
if (fbdiv < min_n) {
cs48l32_fll_err(fll, "FBDIV (%u) < minimum N (%u)\n" , fbdiv, min_n);
return -EINVAL;
}
}
while (frac && (ratio / fbdiv > max_n)) {
fbdiv *= 2;
if (fbdiv >= 1024) {
cs48l32_fll_err(fll, "FBDIV (%u) >= 1024\n" , fbdiv);
return -EINVAL;
}
}
cs48l32_fll_dbg(fll, "lockdet=%d, hp=#%x, fbdiv:%d\n" , lockdet_thr, hp, fbdiv);
/* Calculate N.K values */
fllgcd = gcd(fout, fbdiv * fref);
num = fout / fllgcd;
lambda = (fref * fbdiv) / fllgcd;
fll_n = num / lambda;
theta = num % lambda;
cs48l32_fll_dbg(fll, "fll_n=%d, gcd=%d, theta=%d, lambda=%d\n" ,
fll_n, fllgcd, theta, lambda);
/* Some sanity checks before any registers are written. */
if (fll_n < min_n || fll_n > max_n) {
cs48l32_fll_err(fll, "N not in valid %s mode range %d-%d: %d\n" ,
frac ? "fractional" : "integer" , min_n, max_n, fll_n);
return -EINVAL;
}
if (fbdiv < 1 || (frac && fbdiv >= 1024) || (!frac && fbdiv >= 256)) {
cs48l32_fll_err(fll, "Invalid fbdiv for %s mode (%u)\n" ,
frac ? "fractional" : "integer" , fbdiv);
return -EINVAL;
}
/* clear the ctrl_upd bit to guarantee we write to it later. */
regmap_update_bits(regmap,
fll->base + CS48L32_FLL_CONTROL2_OFFS,
CS48L32_FLL_LOCKDET_THR_MASK |
CS48L32_FLL_PHASEDET_MASK |
CS48L32_FLL_REFCLK_DIV_MASK |
CS48L32_FLL_N_MASK |
CS48L32_FLL_CTRL_UPD_MASK,
(lockdet_thr << CS48L32_FLL_LOCKDET_THR_SHIFT) |
(1 << CS48L32_FLL_PHASEDET_SHIFT) |
(refdiv << CS48L32_FLL_REFCLK_DIV_SHIFT) |
(fll_n << CS48L32_FLL_N_SHIFT));
regmap_update_bits(regmap,
fll->base + CS48L32_FLL_CONTROL3_OFFS,
CS48L32_FLL_LAMBDA_MASK |
CS48L32_FLL_THETA_MASK,
(lambda << CS48L32_FLL_LAMBDA_SHIFT) |
(theta << CS48L32_FLL_THETA_SHIFT));
regmap_update_bits(regmap,
fll->base + CS48L32_FLL_CONTROL4_OFFS,
(0xffff << CS48L32_FLL_FD_GAIN_COARSE_SHIFT) |
CS48L32_FLL_HP_MASK |
CS48L32_FLL_FB_DIV_MASK,
(gains << CS48L32_FLL_FD_GAIN_COARSE_SHIFT) |
(hp << CS48L32_FLL_HP_SHIFT) |
(fbdiv << CS48L32_FLL_FB_DIV_SHIFT));
return 0;
}
static int cs48l32_fllhj_enable(struct cs48l32_fll *fll)
{
struct cs48l32 *cs48l32 = &fll->codec->core;
int already_enabled = cs48l32_is_enabled_fll(fll, fll->base);
int ret;
if (already_enabled < 0)
return already_enabled;
if (!already_enabled)
pm_runtime_get_sync(cs48l32->dev);
cs48l32_fll_dbg(fll, "Enabling FLL, initially %s\n" ,
str_enabled_disabled(already_enabled));
/* FLLn_HOLD must be set before configuring any registers */
regmap_set_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_HOLD_MASK);
/* Apply refclk */
ret = cs48l32_fllhj_apply(fll, fll->ref_freq);
if (ret) {
cs48l32_fll_err(fll, "Failed to set FLL: %d\n" , ret);
goto out;
}
regmap_update_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL2_OFFS,
CS48L32_FLL_REFCLK_SRC_MASK,
fll->ref_src << CS48L32_FLL_REFCLK_SRC_SHIFT);
regmap_set_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_EN_MASK);
out:
regmap_set_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL2_OFFS,
CS48L32_FLL_LOCKDET_MASK);
regmap_set_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_CTRL_UPD_MASK);
/* Release the hold so that flln locks to external frequency */
regmap_clear_bits(cs48l32->regmap,
fll->base + CS48L32_FLL_CONTROL1_OFFS,
CS48L32_FLL_HOLD_MASK);
if (!already_enabled)
cs48l32_wait_for_fll(fll, true );
return 0;
}
static int cs48l32_fllhj_validate(struct cs48l32_fll *fll,
unsigned int ref_in,
unsigned int fout)
{
if (fout && !ref_in) {
cs48l32_fll_err(fll, "fllout set without valid input clk\n" );
return -EINVAL;
}
if (fll->fout && fout != fll->fout) {
cs48l32_fll_err(fll, "Can't change output on active FLL\n" );
return -EINVAL;
}
if (ref_in / CS48L32_FLL_MAX_REFDIV > CS48L32_FLLHJ_MAX_THRESH) {
cs48l32_fll_err(fll, "Can't scale %dMHz to <=13MHz\n" , ref_in);
return -EINVAL;
}
if (fout > CS48L32_FLL_MAX_FOUT) {
cs48l32_fll_err(fll, "Fout=%dMHz exceeds maximum %dMHz\n" ,
fout, CS48L32_FLL_MAX_FOUT);
return -EINVAL;
}
return 0;
}
static int cs48l32_fllhj_set_refclk(struct cs48l32_fll *fll, int source,
unsigned int fin, unsigned int fout)
{
int ret = 0;
if (fll->ref_src == source && fll->ref_freq == fin && fll->fout == fout)
return 0;
if (fin && fout && cs48l32_fllhj_validate(fll, fin, fout))
return -EINVAL;
fll->ref_src = source;
fll->ref_freq = fin;
fll->fout = fout;
if (fout)
ret = cs48l32_fllhj_enable(fll);
else
cs48l32_fllhj_disable(fll);
return ret;
}
static int cs48l32_init_fll(struct cs48l32_fll *fll)
{
fll->ref_src = CS48L32_FLL_SRC_NONE;
return 0;
}
static int cs48l32_set_fll(struct snd_soc_component *component, int fll_id,
int source, unsigned int fref, unsigned int fout)
{
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
switch (fll_id) {
case CS48L32_FLL1_REFCLK:
break ;
default :
return -EINVAL;
}
return cs48l32_fllhj_set_refclk(&cs48l32_codec->fll, source, fref, fout);
}
static int cs48l32_asp_dai_probe(struct snd_soc_dai *dai)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
unsigned int pin_reg, last_pin_reg, hiz_reg;
switch (dai->id) {
case 1:
pin_reg = CS48L32_GPIO3_CTRL1;
hiz_reg = CS48L32_ASP1_CONTROL3;
break ;
case 2:
pin_reg = CS48L32_GPIO7_CTRL1;
hiz_reg = CS48L32_ASP2_CONTROL3;
break ;
default :
return -EINVAL;
}
for (last_pin_reg = pin_reg + 12; pin_reg <= last_pin_reg; ++pin_reg)
regmap_clear_bits(regmap, pin_reg, CS48L32_GPIOX_CTRL1_FN_MASK);
/* DOUT high-impendance when not transmitting */
regmap_set_bits(regmap, hiz_reg, CS48L32_ASP_DOUT_HIZ_MASK);
return 0;
}
static int cs48l32_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
unsigned int val = 0U;
unsigned int base = dai->driver->base;
unsigned int mask = CS48L32_ASP_FMT_MASK | CS48L32_ASP_BCLK_INV_MASK |
CS48L32_ASP_BCLK_MSTR_MASK |
CS48L32_ASP_FSYNC_INV_MASK |
CS48L32_ASP_FSYNC_MSTR_MASK;
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
case SND_SOC_DAIFMT_DSP_A:
val |= (CS48L32_ASP_FMT_DSP_MODE_A << CS48L32_ASP_FMT_SHIFT);
break ;
case SND_SOC_DAIFMT_DSP_B:
if ((fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) != SND_SOC_DAIFMT_BP_FP) {
cs48l32_asp_err(dai, "DSP_B cannot be clock consumer\n" );
return -EINVAL;
}
val |= (CS48L32_ASP_FMT_DSP_MODE_B << CS48L32_ASP_FMT_SHIFT);
break ;
case SND_SOC_DAIFMT_I2S:
val |= (CS48L32_ASP_FMT_I2S_MODE << CS48L32_ASP_FMT_SHIFT);
break ;
case SND_SOC_DAIFMT_LEFT_J:
if ((fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) != SND_SOC_DAIFMT_BP_FP) {
cs48l32_asp_err(dai, "LEFT_J cannot be clock consumer\n" );
return -EINVAL;
}
val |= (CS48L32_ASP_FMT_LEFT_JUSTIFIED_MODE << CS48L32_ASP_FMT_SHIFT);
break ;
default :
cs48l32_asp_err(dai, "Unsupported DAI format %d\n" ,
fmt & SND_SOC_DAIFMT_FORMAT_MASK);
return -EINVAL;
}
switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
case SND_SOC_DAIFMT_BC_FC:
break ;
case SND_SOC_DAIFMT_BC_FP:
val |= CS48L32_ASP_FSYNC_MSTR_MASK;
break ;
case SND_SOC_DAIFMT_BP_FC:
val |= CS48L32_ASP_BCLK_MSTR_MASK;
break ;
case SND_SOC_DAIFMT_BP_FP:
val |= CS48L32_ASP_BCLK_MSTR_MASK;
val |= CS48L32_ASP_FSYNC_MSTR_MASK;
break ;
default :
cs48l32_asp_err(dai, "Unsupported clock direction %d\n" ,
fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK);
return -EINVAL;
}
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
case SND_SOC_DAIFMT_NB_NF:
break ;
case SND_SOC_DAIFMT_IB_IF:
val |= CS48L32_ASP_BCLK_INV_MASK;
val |= CS48L32_ASP_FSYNC_INV_MASK;
break ;
case SND_SOC_DAIFMT_IB_NF:
val |= CS48L32_ASP_BCLK_INV_MASK;
break ;
case SND_SOC_DAIFMT_NB_IF:
val |= CS48L32_ASP_FSYNC_INV_MASK;
break ;
default :
return -EINVAL;
}
regmap_update_bits(regmap, base + CS48L32_ASP_CONTROL2, mask, val);
return 0;
}
static const struct {
u32 freq;
u32 id;
} cs48l32_sclk_rates[] = {
{ 128000, 12 },
{ 176400, 13 },
{ 192000, 14 },
{ 256000, 15 },
{ 352800, 16 },
{ 384000, 17 },
{ 512000, 18 },
{ 705600, 19 },
{ 768000, 21 },
{ 1024000, 23 },
{ 1411200, 25 },
{ 1536000, 27 },
{ 2048000, 29 },
{ 2822400, 31 },
{ 3072000, 33 },
{ 4096000, 36 },
{ 5644800, 38 },
{ 6144000, 40 },
{ 8192000, 47 },
{ 11289600, 49 },
{ 12288000, 51 },
{ 22579200, 57 },
{ 24576000, 59 },
};
#define CS48L32_48K_RATE_MASK 0x0e00fe
#define CS48L32_44K1_RATE_MASK 0x00fe00
#define CS48L32_RATE_MASK (CS48L32_48K_RATE_MASK | CS48L32_44K1_RATE_MASK)
static const unsigned int cs48l32_sr_vals[] = {
0,
12000, /* CS48L32_48K_RATE_MASK */
24000, /* CS48L32_48K_RATE_MASK */
48000, /* CS48L32_48K_RATE_MASK */
96000, /* CS48L32_48K_RATE_MASK */
192000, /* CS48L32_48K_RATE_MASK */
384000, /* CS48L32_48K_RATE_MASK */
768000, /* CS48L32_48K_RATE_MASK */
0,
11025, /* CS48L32_44K1_RATE_MASK */
22050, /* CS48L32_44K1_RATE_MASK */
44100, /* CS48L32_44K1_RATE_MASK */
88200, /* CS48L32_44K1_RATE_MASK */
176400, /* CS48L32_44K1_RATE_MASK */
352800, /* CS48L32_44K1_RATE_MASK */
705600, /* CS48L32_44K1_RATE_MASK */
0,
8000, /* CS48L32_48K_RATE_MASK */
16000, /* CS48L32_48K_RATE_MASK */
32000, /* CS48L32_48K_RATE_MASK */
};
static const struct snd_pcm_hw_constraint_list cs48l32_constraint = {
.count = ARRAY_SIZE(cs48l32_sr_vals),
.list = cs48l32_sr_vals,
};
static int cs48l32_startup(struct snd_pcm_substream *substream, struct snd_soc_dai *dai)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct cs48l32_dai_priv *dai_priv = &cs48l32_codec->dai[dai->id - 1];
unsigned int base_rate;
if (!substream->runtime)
return 0;
switch (dai_priv->clk) {
case CS48L32_CLK_SYSCLK_1:
case CS48L32_CLK_SYSCLK_2:
case CS48L32_CLK_SYSCLK_3:
case CS48L32_CLK_SYSCLK_4:
base_rate = cs48l32_codec->sysclk;
break ;
default :
return 0;
}
if (base_rate == 0)
dai_priv->constraint.mask = CS48L32_RATE_MASK;
else if (base_rate % 4000)
dai_priv->constraint.mask = CS48L32_44K1_RATE_MASK;
else
dai_priv->constraint.mask = CS48L32_48K_RATE_MASK;
return snd_pcm_hw_constraint_list(substream->runtime, 0,
SNDRV_PCM_HW_PARAM_RATE,
&dai_priv->constraint);
}
static int cs48l32_hw_params_rate(struct snd_pcm_substream *substream,
struct snd_pcm_hw_params *params,
struct snd_soc_dai *dai)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct cs48l32_dai_priv *dai_priv = &cs48l32_codec->dai[dai->id - 1];
unsigned int sr_val, sr_reg, rate;
rate = params_rate(params);
for (sr_val = 0; sr_val < ARRAY_SIZE(cs48l32_sr_vals); sr_val++)
if (cs48l32_sr_vals[sr_val] == rate)
break ;
if (sr_val == ARRAY_SIZE(cs48l32_sr_vals)) {
cs48l32_asp_err(dai, "Unsupported sample rate %dHz\n" , rate);
return -EINVAL;
}
switch (dai_priv->clk) {
case CS48L32_CLK_SYSCLK_1:
sr_reg = CS48L32_SAMPLE_RATE1;
break ;
case CS48L32_CLK_SYSCLK_2:
sr_reg = CS48L32_SAMPLE_RATE2;
break ;
case CS48L32_CLK_SYSCLK_3:
sr_reg = CS48L32_SAMPLE_RATE3;
break ;
case CS48L32_CLK_SYSCLK_4:
sr_reg = CS48L32_SAMPLE_RATE4;
break ;
default :
return -EINVAL;
}
snd_soc_component_update_bits(component, sr_reg, CS48L32_SAMPLE_RATE_1_MASK, sr_val);
return 0;
}
static bool cs48l32_asp_cfg_changed(struct snd_soc_component *component,
unsigned int base, unsigned int sclk,
unsigned int slotws, unsigned int dataw)
{
unsigned int val;
val = snd_soc_component_read(component, base + CS48L32_ASP_CONTROL1);
if (sclk != (val & CS48L32_ASP_BCLK_FREQ_MASK))
return true ;
val = snd_soc_component_read(component, base + CS48L32_ASP_CONTROL2);
if (slotws != (val & (CS48L32_ASP_RX_WIDTH_MASK | CS48L32_ASP_TX_WIDTH_MASK)))
return true ;
val = snd_soc_component_read(component, base + CS48L32_ASP_DATA_CONTROL1);
if (dataw != (val & (CS48L32_ASP_TX_WL_MASK)))
return true ;
val = snd_soc_component_read(component, base + CS48L32_ASP_DATA_CONTROL5);
if (dataw != (val & (CS48L32_ASP_RX_WL_MASK)))
return true ;
return false ;
}
static int cs48l32_hw_params(struct snd_pcm_substream *substream,
struct snd_pcm_hw_params *params,
struct snd_soc_dai *dai)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
int base = dai->driver->base;
int dai_id = dai->id - 1;
unsigned int rate = params_rate(params);
unsigned int dataw = snd_pcm_format_width(params_format(params));
unsigned int asp_state = 0;
int sclk, sclk_target;
unsigned int slotw, n_slots, n_slots_multiple, val;
int i, ret;
cs48l32_asp_dbg(dai, "hwparams in: ch:%u dataw:%u rate:%u\n" ,
params_channels(params), dataw, rate);
/*
* The following calculations hold only under the assumption that
* symmetric_[rates|channels|samplebits] are set to 1
*/
if (cs48l32_codec->tdm_slots[dai_id]) {
n_slots = cs48l32_codec->tdm_slots[dai_id];
slotw = cs48l32_codec->tdm_width[dai_id];
} else {
n_slots = params_channels(params);
slotw = dataw;
}
val = snd_soc_component_read(component, base + CS48L32_ASP_CONTROL2);
val = (val & CS48L32_ASP_FMT_MASK) >> CS48L32_ASP_FMT_SHIFT;
if (val == CS48L32_ASP_FMT_I2S_MODE)
n_slots_multiple = 2;
else
n_slots_multiple = 1;
sclk_target = snd_soc_tdm_params_to_bclk(params, slotw, n_slots, n_slots_multiple);
if (sclk_target < 0) {
cs48l32_asp_err(dai, "Invalid parameters\n" );
return sclk_target;
}
for (i = 0; i < ARRAY_SIZE(cs48l32_sclk_rates); i++) {
if ((cs48l32_sclk_rates[i].freq >= sclk_target) &&
(cs48l32_sclk_rates[i].freq % rate == 0)) {
sclk = cs48l32_sclk_rates[i].id;
break ;
}
}
if (i == ARRAY_SIZE(cs48l32_sclk_rates)) {
cs48l32_asp_err(dai, "Unsupported sample rate %dHz\n" , rate);
return -EINVAL;
}
cs48l32_asp_dbg(dai, "hwparams out: n_slots:%u dataw:%u slotw:%u bclk:%u bclkid:%u\n" ,
n_slots, dataw, slotw, sclk_target, sclk);
slotw = (slotw << CS48L32_ASP_TX_WIDTH_SHIFT) |
(slotw << CS48L32_ASP_RX_WIDTH_SHIFT);
if (!cs48l32_asp_cfg_changed(component, base, sclk, slotw, dataw))
return cs48l32_hw_params_rate(substream, params, dai);
/* ASP must be disabled while changing configuration */
asp_state = snd_soc_component_read(component, base + CS48L32_ASP_ENABLES1);
regmap_clear_bits(regmap, base + CS48L32_ASP_ENABLES1, 0xff00ff);
ret = cs48l32_hw_params_rate(substream, params, dai);
if (ret != 0)
goto restore_asp;
regmap_update_bits_async(regmap,
base + CS48L32_ASP_CONTROL1,
CS48L32_ASP_BCLK_FREQ_MASK,
sclk);
regmap_update_bits_async(regmap,
base + CS48L32_ASP_CONTROL2,
CS48L32_ASP_RX_WIDTH_MASK | CS48L32_ASP_TX_WIDTH_MASK,
slotw);
regmap_update_bits_async(regmap,
base + CS48L32_ASP_DATA_CONTROL1,
CS48L32_ASP_TX_WL_MASK,
dataw);
regmap_update_bits(regmap,
base + CS48L32_ASP_DATA_CONTROL5,
CS48L32_ASP_RX_WL_MASK,
dataw);
restore_asp:
/* Restore ASP TX/RX enable state */
regmap_update_bits(regmap,
base + CS48L32_ASP_ENABLES1,
0xff00ff,
asp_state);
return ret;
}
static const char *cs48l32_dai_clk_str(int clk_id)
{
switch (clk_id) {
case CS48L32_CLK_SYSCLK_1:
case CS48L32_CLK_SYSCLK_2:
case CS48L32_CLK_SYSCLK_3:
case CS48L32_CLK_SYSCLK_4:
return "SYSCLK" ;
default :
return "Unknown clock" ;
}
}
static int cs48l32_dai_set_sysclk(struct snd_soc_dai *dai,
int clk_id, unsigned int freq, int dir)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct cs48l32_dai_priv *dai_priv = &cs48l32_codec->dai[dai->id - 1];
unsigned int base = dai->driver->base;
unsigned int current_asp_rate, target_asp_rate;
bool change_rate_domain = false ;
int ret;
if (clk_id == dai_priv->clk)
return 0;
if (snd_soc_dai_active(dai)) {
cs48l32_asp_err(dai, "Can't change clock on active DAI\n" );
return -EBUSY;
}
switch (clk_id) {
case CS48L32_CLK_SYSCLK_1:
target_asp_rate = 0U << CS48L32_ASP_RATE_SHIFT;
break ;
case CS48L32_CLK_SYSCLK_2:
target_asp_rate = 1U << CS48L32_ASP_RATE_SHIFT;
break ;
case CS48L32_CLK_SYSCLK_3:
target_asp_rate = 2U << CS48L32_ASP_RATE_SHIFT;
break ;
case CS48L32_CLK_SYSCLK_4:
target_asp_rate = 3U << CS48L32_ASP_RATE_SHIFT;
break ;
default :
return -EINVAL;
}
dai_priv->clk = clk_id;
cs48l32_asp_dbg(dai, "Setting to %s\n" , cs48l32_dai_clk_str(clk_id));
if (base) {
ret = regmap_read(cs48l32_codec->core.regmap,
base + CS48L32_ASP_CONTROL1,
¤t_asp_rate);
if (ret != 0) {
cs48l32_asp_err(dai, "Failed to check rate: %d\n" , ret);
return ret;
}
if ((current_asp_rate & CS48L32_ASP_RATE_MASK) !=
(target_asp_rate & CS48L32_ASP_RATE_MASK)) {
change_rate_domain = true ;
mutex_lock(&cs48l32_codec->rate_lock);
/* Guard the rate change with SYSCLK cycles */
cs48l32_spin_sysclk(cs48l32_codec);
}
snd_soc_component_update_bits(component, base + CS48L32_ASP_CONTROL1,
CS48L32_ASP_RATE_MASK, target_asp_rate);
if (change_rate_domain) {
cs48l32_spin_sysclk(cs48l32_codec);
mutex_unlock(&cs48l32_codec->rate_lock);
}
}
return 0;
}
static void cs48l32_set_channels_to_mask(struct snd_soc_dai *dai,
unsigned int base,
int channels, unsigned int mask)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
int slot, i, j = 0, shift;
unsigned int frame_ctls[2] = {0, 0};
for (i = 0; i < channels; ++i) {
slot = ffs(mask) - 1;
if (slot < 0)
return ;
if (i - (j * 4) >= 4) {
++j;
if (j >= 2)
break ;
}
shift = (8 * (i - j * 4));
frame_ctls[j] |= slot << shift;
mask &= ~(1 << slot); /* ? mask ^= 1 << slot ? */
}
regmap_write(regmap, base, frame_ctls[0]);
regmap_write(regmap, base + 0x4, frame_ctls[1]);
if (mask)
cs48l32_asp_warn(dai, "Too many channels in TDM mask\n" );
}
static int cs48l32_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
unsigned int rx_mask, int slots, int slot_width)
{
struct snd_soc_component *component = dai->component;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
int base = dai->driver->base;
int rx_max_chan = dai->driver->playback.channels_max;
int tx_max_chan = dai->driver->capture.channels_max;
/* Only support TDM for the physical ASPs */
if (dai->id > CS48L32_MAX_ASP)
return -EINVAL;
if (slots == 0) {
tx_mask = (1 << tx_max_chan) - 1;
rx_mask = (1 << rx_max_chan) - 1;
}
cs48l32_set_channels_to_mask(dai, base + CS48L32_ASP_FRAME_CONTROL1,
tx_max_chan, tx_mask);
cs48l32_set_channels_to_mask(dai, base + CS48L32_ASP_FRAME_CONTROL5,
rx_max_chan, rx_mask);
cs48l32_codec->tdm_width[dai->id - 1] = slot_width;
cs48l32_codec->tdm_slots[dai->id - 1] = slots;
return 0;
}
static const struct snd_soc_dai_ops cs48l32_dai_ops = {
.probe = &cs48l32_asp_dai_probe,
.startup = &cs48l32_startup,
.set_fmt = &cs48l32_set_fmt,
.set_tdm_slot = &cs48l32_set_tdm_slot,
.hw_params = &cs48l32_hw_params,
.set_sysclk = &cs48l32_dai_set_sysclk,
};
static int cs48l32_sysclk_ev(struct snd_soc_dapm_widget *w,
struct snd_kcontrol *kcontrol, int event)
{
struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
cs48l32_spin_sysclk(cs48l32_codec);
return 0;
}
static int cs48l32_in_ev(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event)
{
struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
unsigned int reg;
if (w->shift % 2)
reg = CS48L32_IN1L_CONTROL2;
else
reg = CS48L32_IN1R_CONTROL2;
reg += (w->shift / 2) * (CS48L32_IN2L_CONTROL2 - CS48L32_IN1L_CONTROL2);
switch (event) {
case SND_SOC_DAPM_PRE_PMU:
switch (w->shift) {
case CS48L32_IN1L_EN_SHIFT:
snd_soc_component_update_bits(component,
CS48L32_ADC1L_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
CS48L32_ADC1x_INT_ENA_FRC_MASK);
break ;
case CS48L32_IN1R_EN_SHIFT:
snd_soc_component_update_bits(component,
CS48L32_ADC1R_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
CS48L32_ADC1x_INT_ENA_FRC_MASK);
break ;
default :
break ;
}
cs48l32_codec->in_up_pending++;
break ;
case SND_SOC_DAPM_POST_PMU:
usleep_range(200, 300);
switch (w->shift) {
case CS48L32_IN1L_EN_SHIFT:
snd_soc_component_update_bits(component,
CS48L32_ADC1L_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
0);
break ;
case CS48L32_IN1R_EN_SHIFT:
snd_soc_component_update_bits(component,
CS48L32_ADC1R_ANA_CONTROL1,
CS48L32_ADC1x_INT_ENA_FRC_MASK,
0);
break ;
default :
break ;
}
cs48l32_codec->in_up_pending--;
snd_soc_component_update_bits(component, reg, CS48L32_INx_MUTE_MASK, 0);
/* Uncached write-only register, no need for update_bits */
if (!cs48l32_codec->in_up_pending) {
snd_soc_component_write(component, cs48l32_codec->in_vu_reg,
CS48L32_IN_VU_MASK);
}
break ;
case SND_SOC_DAPM_PRE_PMD:
snd_soc_component_update_bits(component, reg,
CS48L32_INx_MUTE_MASK, CS48L32_INx_MUTE_MASK);
snd_soc_component_write(component, cs48l32_codec->in_vu_reg,
CS48L32_IN_VU_MASK);
break ;
default :
break ;
}
return 0;
}
static int cs48l32_in_put_volsw(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
int ret;
ret = snd_soc_put_volsw(kcontrol, ucontrol);
if (ret < 0)
return ret;
/*
* Uncached write-only register, no need for update_bits.
* Will fail if codec is off but that will be handled by cs48l32_in_ev
*/
snd_soc_component_write(component, cs48l32_codec->in_vu_reg, CS48L32_IN_VU);
return ret;
}
static bool cs48l32_eq_filter_unstable(bool mode, __be16 in_a, __be16 in_b)
{
s16 a = be16_to_cpu(in_a);
s16 b = be16_to_cpu(in_b);
if (!mode)
return abs(a) > CS48L32_EQ_MAX_COEFF;
if (abs(b) > CS48L32_EQ_MAX_COEFF)
return true ;
if (abs((a << 16) / (CS48L32_EQ_MAX_COEFF + 1 - b)) >= ((CS48L32_EQ_MAX_COEFF + 1) << 4))
return true ;
return false ;
}
static int cs48l32_eq_ev(struct snd_soc_dapm_widget *w,
struct snd_kcontrol *kcontrol, int event)
{
struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
unsigned int mode = cs48l32_codec->eq_mode[w->shift];
unsigned int reg;
__be16 *data = &cs48l32_codec->eq_coefficients[w->shift][0];
int ret = 0;
reg = CS48L32_EQ1_BAND1_COEFF1;
reg += w->shift * (CS48L32_EQ2_BAND1_COEFF1 - CS48L32_EQ1_BAND1_COEFF1);
switch (event) {
case SND_SOC_DAPM_PRE_PMU:
if (cs48l32_eq_filter_unstable(!!mode, data[1], data[0]) ||
cs48l32_eq_filter_unstable(true , data[7], data[6]) ||
cs48l32_eq_filter_unstable(true , data[13], data[12]) ||
cs48l32_eq_filter_unstable(true , data[19], data[18]) ||
cs48l32_eq_filter_unstable(false , data[25], data[24])) {
dev_err(cs48l32_codec->core.dev, "Rejecting unstable EQ coefficients.\n" );
ret = -EINVAL;
} else {
ret = regmap_raw_write(regmap, reg, data, CS48L32_EQ_BLOCK_SZ);
if (ret < 0) {
dev_err(cs48l32_codec->core.dev,
"Error writing EQ coefficients: %d\n" , ret);
goto out;
}
ret = snd_soc_component_update_bits(component,
CS48L32_EQ_CONTROL2,
w->mask,
mode << w->shift);
if (ret < 0) {
dev_err(cs48l32_codec->core.dev,
"Error writing EQ mode: %d\n" , ret);
}
}
break ;
default :
break ;
}
out:
return ret;
}
static const struct snd_kcontrol_new cs48l32_snd_controls[] = {
SOC_ENUM("IN1 OSR" , cs48l32_in_dmic_osr[0]),
SOC_ENUM("IN2 OSR" , cs48l32_in_dmic_osr[1]),
SOC_SINGLE_RANGE_TLV("IN1L Volume" , CS48L32_IN1L_CONTROL2,
CS48L32_INx_PGA_VOL_SHIFT, 0x40, 0x5f, 0, cs48l32_ana_tlv),
SOC_SINGLE_RANGE_TLV("IN1R Volume" , CS48L32_IN1R_CONTROL2,
CS48L32_INx_PGA_VOL_SHIFT, 0x40, 0x5f, 0, cs48l32_ana_tlv),
SOC_ENUM("IN HPF Cutoff Frequency" , cs48l32_in_hpf_cut_enum),
SOC_SINGLE_EXT("IN1L LP Switch" , CS48L32_IN1L_CONTROL1, CS48L32_INx_LP_MODE_SHIFT,
1, 0, snd_soc_get_volsw, cs48l32_low_power_mode_put),
SOC_SINGLE_EXT("IN1R LP Switch" , CS48L32_IN1R_CONTROL1, CS48L32_INx_LP_MODE_SHIFT,
1, 0, snd_soc_get_volsw, cs48l32_low_power_mode_put),
SOC_SINGLE("IN1L HPF Switch" , CS48L32_IN1L_CONTROL1, CS48L32_INx_HPF_SHIFT, 1, 0),
SOC_SINGLE("IN1R HPF Switch" , CS48L32_IN1R_CONTROL1, CS48L32_INx_HPF_SHIFT, 1, 0),
SOC_SINGLE("IN2L HPF Switch" , CS48L32_IN2L_CONTROL1, CS48L32_INx_HPF_SHIFT, 1, 0),
SOC_SINGLE("IN2R HPF Switch" , CS48L32_IN2R_CONTROL1, CS48L32_INx_HPF_SHIFT, 1, 0),
SOC_SINGLE_EXT_TLV("IN1L Digital Volume" , CS48L32_IN1L_CONTROL2,
CS48L32_INx_VOL_SHIFT, 0xbf, 0, snd_soc_get_volsw,
cs48l32_in_put_volsw, cs48l32_digital_tlv),
SOC_SINGLE_EXT_TLV("IN1R Digital Volume" , CS48L32_IN1R_CONTROL2,
CS48L32_INx_VOL_SHIFT, 0xbf, 0, snd_soc_get_volsw,
cs48l32_in_put_volsw, cs48l32_digital_tlv),
SOC_SINGLE_EXT_TLV("IN2L Digital Volume" , CS48L32_IN2L_CONTROL2,
CS48L32_INx_VOL_SHIFT, 0xbf, 0, snd_soc_get_volsw,
cs48l32_in_put_volsw, cs48l32_digital_tlv),
SOC_SINGLE_EXT_TLV("IN2R Digital Volume" , CS48L32_IN2R_CONTROL2,
CS48L32_INx_VOL_SHIFT, 0xbf, 0, snd_soc_get_volsw,
cs48l32_in_put_volsw, cs48l32_digital_tlv),
SOC_ENUM("Input Ramp Up" , cs48l32_in_vi_ramp),
SOC_ENUM("Input Ramp Down" , cs48l32_in_vd_ramp),
CS48L32_RATE_ENUM("Ultrasonic 1 Rate" , cs48l32_us_output_rate[0]),
CS48L32_RATE_ENUM("Ultrasonic 2 Rate" , cs48l32_us_output_rate[1]),
SOC_ENUM("Ultrasonic 1 Freq" , cs48l32_us_freq[0]),
SOC_ENUM("Ultrasonic 2 Freq" , cs48l32_us_freq[1]),
SOC_SINGLE_TLV("Ultrasonic 1 Volume" , CS48L32_US1_CONTROL, CS48L32_US1_GAIN_SHIFT,
3, 0, cs48l32_us_tlv),
SOC_SINGLE_TLV("Ultrasonic 2 Volume" , CS48L32_US2_CONTROL, CS48L32_US1_GAIN_SHIFT,
3, 0, cs48l32_us_tlv),
SOC_ENUM("Ultrasonic 1 Detect Threshold" , cs48l32_us_det_thr[0]),
SOC_ENUM("Ultrasonic 2 Detect Threshold" , cs48l32_us_det_thr[1]),
SOC_ENUM("Ultrasonic 1 Detect Pulse Length" , cs48l32_us_det_num[0]),
SOC_ENUM("Ultrasonic 2 Detect Pulse Length" , cs48l32_us_det_num[1]),
SOC_ENUM("Ultrasonic 1 Detect Hold" , cs48l32_us_det_hold[0]),
SOC_ENUM("Ultrasonic 2 Detect Hold" , cs48l32_us_det_hold[1]),
SOC_ENUM("Ultrasonic 1 Detect Decay" , cs48l32_us_det_dcy[0]),
SOC_ENUM("Ultrasonic 2 Detect Decay" , cs48l32_us_det_dcy[1]),
SOC_SINGLE("Ultrasonic 1 Detect LPF Switch" ,
CS48L32_US1_DET_CONTROL, CS48L32_US1_DET_LPF_SHIFT, 1, 0),
SOC_SINGLE("Ultrasonic 2 Detect LPF Switch" ,
CS48L32_US2_DET_CONTROL, CS48L32_US1_DET_LPF_SHIFT, 1, 0),
SOC_ENUM("Ultrasonic 1 Detect LPF Cut-off" , cs48l32_us_det_lpf_cut[0]),
SOC_ENUM("Ultrasonic 2 Detect LPF Cut-off" , cs48l32_us_det_lpf_cut[1]),
CS48L32_MIXER_CONTROLS("EQ1" , CS48L32_EQ1_INPUT1),
CS48L32_MIXER_CONTROLS("EQ2" , CS48L32_EQ2_INPUT1),
CS48L32_MIXER_CONTROLS("EQ3" , CS48L32_EQ3_INPUT1),
CS48L32_MIXER_CONTROLS("EQ4" , CS48L32_EQ4_INPUT1),
SOC_ENUM_EXT("EQ1 Mode" , cs48l32_eq_mode[0], cs48l32_eq_mode_get, cs48l32_eq_mode_put),
CS48L32_EQ_COEFF_CONTROLS(EQ1),
SOC_SINGLE_TLV("EQ1 B1 Volume" , CS48L32_EQ1_GAIN1, 0, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ1 B2 Volume" , CS48L32_EQ1_GAIN1, 8, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ1 B3 Volume" , CS48L32_EQ1_GAIN1, 16, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ1 B4 Volume" , CS48L32_EQ1_GAIN1, 24, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ1 B5 Volume" , CS48L32_EQ1_GAIN2, 0, 24, 0, cs48l32_eq_tlv),
SOC_ENUM_EXT("EQ2 Mode" , cs48l32_eq_mode[1], cs48l32_eq_mode_get, cs48l32_eq_mode_put),
CS48L32_EQ_COEFF_CONTROLS(EQ2),
SOC_SINGLE_TLV("EQ2 B1 Volume" , CS48L32_EQ2_GAIN1, 0, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ2 B2 Volume" , CS48L32_EQ2_GAIN1, 8, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ2 B3 Volume" , CS48L32_EQ2_GAIN1, 16, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ2 B4 Volume" , CS48L32_EQ2_GAIN1, 24, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ2 B5 Volume" , CS48L32_EQ2_GAIN2, 0, 24, 0, cs48l32_eq_tlv),
SOC_ENUM_EXT("EQ3 Mode" , cs48l32_eq_mode[2], cs48l32_eq_mode_get, cs48l32_eq_mode_put),
CS48L32_EQ_COEFF_CONTROLS(EQ3),
SOC_SINGLE_TLV("EQ3 B1 Volume" , CS48L32_EQ3_GAIN1, 0, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ3 B2 Volume" , CS48L32_EQ3_GAIN1, 8, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ3 B3 Volume" , CS48L32_EQ3_GAIN1, 16, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ3 B4 Volume" , CS48L32_EQ3_GAIN1, 24, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ3 B5 Volume" , CS48L32_EQ3_GAIN2, 0, 24, 0, cs48l32_eq_tlv),
SOC_ENUM_EXT("EQ4 Mode" , cs48l32_eq_mode[3], cs48l32_eq_mode_get, cs48l32_eq_mode_put),
CS48L32_EQ_COEFF_CONTROLS(EQ4),
SOC_SINGLE_TLV("EQ4 B1 Volume" , CS48L32_EQ4_GAIN1, 0, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ4 B2 Volume" , CS48L32_EQ4_GAIN1, 8, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ4 B3 Volume" , CS48L32_EQ4_GAIN1, 16, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ4 B4 Volume" , CS48L32_EQ4_GAIN1, 24, 24, 0, cs48l32_eq_tlv),
SOC_SINGLE_TLV("EQ4 B5 Volume" , CS48L32_EQ4_GAIN2, 0, 24, 0, cs48l32_eq_tlv),
CS48L32_MIXER_CONTROLS("DRC1L" , CS48L32_DRC1L_INPUT1),
CS48L32_MIXER_CONTROLS("DRC1R" , CS48L32_DRC1R_INPUT1),
CS48L32_MIXER_CONTROLS("DRC2L" , CS48L32_DRC2L_INPUT1),
CS48L32_MIXER_CONTROLS("DRC2R" , CS48L32_DRC2R_INPUT1),
SND_SOC_BYTES_MASK("DRC1 Coefficients" , CS48L32_DRC1_CONTROL1, 4,
BIT(CS48L32_DRC1R_EN_SHIFT) | BIT(CS48L32_DRC1L_EN_SHIFT)),
SND_SOC_BYTES_MASK("DRC2 Coefficients" , CS48L32_DRC2_CONTROL1, 4,
BIT(CS48L32_DRC1R_EN_SHIFT) | BIT(CS48L32_DRC1L_EN_SHIFT)),
CS48L32_MIXER_CONTROLS("LHPF1" , CS48L32_LHPF1_INPUT1),
CS48L32_MIXER_CONTROLS("LHPF2" , CS48L32_LHPF2_INPUT1),
CS48L32_MIXER_CONTROLS("LHPF3" , CS48L32_LHPF3_INPUT1),
CS48L32_MIXER_CONTROLS("LHPF4" , CS48L32_LHPF4_INPUT1),
CS48L32_LHPF_CONTROL("LHPF1 Coefficients" , CS48L32_LHPF1_COEFF),
CS48L32_LHPF_CONTROL("LHPF2 Coefficients" , CS48L32_LHPF2_COEFF),
CS48L32_LHPF_CONTROL("LHPF3 Coefficients" , CS48L32_LHPF3_COEFF),
CS48L32_LHPF_CONTROL("LHPF4 Coefficients" , CS48L32_LHPF4_COEFF),
SOC_ENUM("LHPF1 Mode" , cs48l32_lhpf_mode[0]),
SOC_ENUM("LHPF2 Mode" , cs48l32_lhpf_mode[1]),
SOC_ENUM("LHPF3 Mode" , cs48l32_lhpf_mode[2]),
SOC_ENUM("LHPF4 Mode" , cs48l32_lhpf_mode[3]),
CS48L32_RATE_CONTROL("Sample Rate 1" , 1),
CS48L32_RATE_CONTROL("Sample Rate 2" , 2),
CS48L32_RATE_CONTROL("Sample Rate 3" , 3),
CS48L32_RATE_CONTROL("Sample Rate 4" , 4),
CS48L32_RATE_ENUM("FX Rate" , cs48l32_fx_rate),
CS48L32_RATE_ENUM("ISRC1 FSL" , cs48l32_isrc_fsl[0]),
CS48L32_RATE_ENUM("ISRC2 FSL" , cs48l32_isrc_fsl[1]),
CS48L32_RATE_ENUM("ISRC3 FSL" , cs48l32_isrc_fsl[2]),
CS48L32_RATE_ENUM("ISRC1 FSH" , cs48l32_isrc_fsh[0]),
CS48L32_RATE_ENUM("ISRC2 FSH" , cs48l32_isrc_fsh[1]),
CS48L32_RATE_ENUM("ISRC3 FSH" , cs48l32_isrc_fsh[2]),
SOC_ENUM("AUXPDM1 Rate" , cs48l32_auxpdm1_freq),
SOC_ENUM("AUXPDM2 Rate" , cs48l32_auxpdm2_freq),
SOC_ENUM_EXT("IN1L Rate" , cs48l32_input_rate[0], snd_soc_get_enum_double, cs48l32_in_rate_put),
SOC_ENUM_EXT("IN1R Rate" , cs48l32_input_rate[1], snd_soc_get_enum_double, cs48l32_in_rate_put),
SOC_ENUM_EXT("IN2L Rate" , cs48l32_input_rate[2], snd_soc_get_enum_double, cs48l32_in_rate_put),
SOC_ENUM_EXT("IN2R Rate" , cs48l32_input_rate[3], snd_soc_get_enum_double, cs48l32_in_rate_put),
CS48L32_RATE_ENUM("Noise Generator Rate" , noise_gen_rate),
SOC_SINGLE_TLV("Noise Generator Volume" , CS48L32_COMFORT_NOISE_GENERATOR,
CS48L32_NOISE_GEN_GAIN_SHIFT, 0x12, 0, cs48l32_noise_tlv),
CS48L32_MIXER_CONTROLS("ASP1TX1" , CS48L32_ASP1TX1_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX2" , CS48L32_ASP1TX2_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX3" , CS48L32_ASP1TX3_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX4" , CS48L32_ASP1TX4_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX5" , CS48L32_ASP1TX5_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX6" , CS48L32_ASP1TX6_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX7" , CS48L32_ASP1TX7_INPUT1),
CS48L32_MIXER_CONTROLS("ASP1TX8" , CS48L32_ASP1TX8_INPUT1),
CS48L32_MIXER_CONTROLS("ASP2TX1" , CS48L32_ASP2TX1_INPUT1),
CS48L32_MIXER_CONTROLS("ASP2TX2" , CS48L32_ASP2TX2_INPUT1),
CS48L32_MIXER_CONTROLS("ASP2TX3" , CS48L32_ASP2TX3_INPUT1),
CS48L32_MIXER_CONTROLS("ASP2TX4" , CS48L32_ASP2TX4_INPUT1),
WM_ADSP2_PRELOAD_SWITCH("DSP1" , 1),
CS48L32_MIXER_CONTROLS("DSP1RX1" , CS48L32_DSP1RX1_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX2" , CS48L32_DSP1RX2_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX3" , CS48L32_DSP1RX3_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX4" , CS48L32_DSP1RX4_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX5" , CS48L32_DSP1RX5_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX6" , CS48L32_DSP1RX6_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX7" , CS48L32_DSP1RX7_INPUT1),
CS48L32_MIXER_CONTROLS("DSP1RX8" , CS48L32_DSP1RX8_INPUT1),
WM_ADSP_FW_CONTROL("DSP1" , 0),
CS48L32_DSP_RATE_CONTROL("DSP1RX1" , 0),
CS48L32_DSP_RATE_CONTROL("DSP1RX2" , 1),
CS48L32_DSP_RATE_CONTROL("DSP1RX3" , 2),
CS48L32_DSP_RATE_CONTROL("DSP1RX4" , 3),
CS48L32_DSP_RATE_CONTROL("DSP1RX5" , 4),
CS48L32_DSP_RATE_CONTROL("DSP1RX6" , 5),
CS48L32_DSP_RATE_CONTROL("DSP1RX7" , 6),
CS48L32_DSP_RATE_CONTROL("DSP1RX8" , 7),
CS48L32_DSP_RATE_CONTROL("DSP1TX1" , 8),
CS48L32_DSP_RATE_CONTROL("DSP1TX2" , 9),
CS48L32_DSP_RATE_CONTROL("DSP1TX3" , 10),
CS48L32_DSP_RATE_CONTROL("DSP1TX4" , 11),
CS48L32_DSP_RATE_CONTROL("DSP1TX5" , 12),
CS48L32_DSP_RATE_CONTROL("DSP1TX6" , 13),
CS48L32_DSP_RATE_CONTROL("DSP1TX7" , 14),
CS48L32_DSP_RATE_CONTROL("DSP1TX8" , 15),
};
CS48L32_MIXER_ENUMS(EQ1, CS48L32_EQ1_INPUT1);
CS48L32_MIXER_ENUMS(EQ2, CS48L32_EQ2_INPUT1);
CS48L32_MIXER_ENUMS(EQ3, CS48L32_EQ3_INPUT1);
CS48L32_MIXER_ENUMS(EQ4, CS48L32_EQ4_INPUT1);
CS48L32_MIXER_ENUMS(DRC1L, CS48L32_DRC1L_INPUT1);
CS48L32_MIXER_ENUMS(DRC1R, CS48L32_DRC1R_INPUT1);
CS48L32_MIXER_ENUMS(DRC2L, CS48L32_DRC2L_INPUT1);
CS48L32_MIXER_ENUMS(DRC2R, CS48L32_DRC2R_INPUT1);
CS48L32_MIXER_ENUMS(LHPF1, CS48L32_LHPF1_INPUT1);
CS48L32_MIXER_ENUMS(LHPF2, CS48L32_LHPF2_INPUT1);
CS48L32_MIXER_ENUMS(LHPF3, CS48L32_LHPF3_INPUT1);
CS48L32_MIXER_ENUMS(LHPF4, CS48L32_LHPF4_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX1, CS48L32_ASP1TX1_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX2, CS48L32_ASP1TX2_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX3, CS48L32_ASP1TX3_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX4, CS48L32_ASP1TX4_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX5, CS48L32_ASP1TX5_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX6, CS48L32_ASP1TX6_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX7, CS48L32_ASP1TX7_INPUT1);
CS48L32_MIXER_ENUMS(ASP1TX8, CS48L32_ASP1TX8_INPUT1);
CS48L32_MIXER_ENUMS(ASP2TX1, CS48L32_ASP2TX1_INPUT1);
CS48L32_MIXER_ENUMS(ASP2TX2, CS48L32_ASP2TX2_INPUT1);
CS48L32_MIXER_ENUMS(ASP2TX3, CS48L32_ASP2TX3_INPUT1);
CS48L32_MIXER_ENUMS(ASP2TX4, CS48L32_ASP2TX4_INPUT1);
CS48L32_MUX_ENUMS(ISRC1INT1, CS48L32_ISRC1INT1_INPUT1);
CS48L32_MUX_ENUMS(ISRC1INT2, CS48L32_ISRC1INT2_INPUT1);
CS48L32_MUX_ENUMS(ISRC1INT3, CS48L32_ISRC1INT3_INPUT1);
CS48L32_MUX_ENUMS(ISRC1INT4, CS48L32_ISRC1INT4_INPUT1);
CS48L32_MUX_ENUMS(ISRC1DEC1, CS48L32_ISRC1DEC1_INPUT1);
CS48L32_MUX_ENUMS(ISRC1DEC2, CS48L32_ISRC1DEC2_INPUT1);
CS48L32_MUX_ENUMS(ISRC1DEC3, CS48L32_ISRC1DEC3_INPUT1);
CS48L32_MUX_ENUMS(ISRC1DEC4, CS48L32_ISRC1DEC4_INPUT1);
CS48L32_MUX_ENUMS(ISRC2INT1, CS48L32_ISRC2INT1_INPUT1);
CS48L32_MUX_ENUMS(ISRC2INT2, CS48L32_ISRC2INT2_INPUT1);
CS48L32_MUX_ENUMS(ISRC2DEC1, CS48L32_ISRC2DEC1_INPUT1);
CS48L32_MUX_ENUMS(ISRC2DEC2, CS48L32_ISRC2DEC2_INPUT1);
CS48L32_MUX_ENUMS(ISRC3INT1, CS48L32_ISRC3INT1_INPUT1);
CS48L32_MUX_ENUMS(ISRC3INT2, CS48L32_ISRC3INT2_INPUT1);
CS48L32_MUX_ENUMS(ISRC3DEC1, CS48L32_ISRC3DEC1_INPUT1);
CS48L32_MUX_ENUMS(ISRC3DEC2, CS48L32_ISRC3DEC2_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX1, CS48L32_DSP1RX1_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX2, CS48L32_DSP1RX2_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX3, CS48L32_DSP1RX3_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX4, CS48L32_DSP1RX4_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX5, CS48L32_DSP1RX5_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX6, CS48L32_DSP1RX6_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX7, CS48L32_DSP1RX7_INPUT1);
CS48L32_MIXER_ENUMS(DSP1RX8, CS48L32_DSP1RX8_INPUT1);
static int cs48l32_dsp_mem_ev(struct snd_soc_dapm_widget *w,
struct snd_kcontrol *kcontrol, int event)
{
struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
switch (event) {
case SND_SOC_DAPM_POST_PMU:
return cs48l32_dsp_memory_enable(cs48l32_codec, &cs48l32_dsp_sram_regs);
case SND_SOC_DAPM_PRE_PMD:
cs48l32_dsp_memory_disable(cs48l32_codec, &cs48l32_dsp_sram_regs);
return 0;
default :
return 0;
}
}
static const struct snd_soc_dapm_widget cs48l32_dapm_widgets[] = {
SND_SOC_DAPM_SUPPLY("SYSCLK" , CS48L32_SYSTEM_CLOCK1, CS48L32_SYSCLK_EN_SHIFT, 0,
cs48l32_sysclk_ev, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
SND_SOC_DAPM_REGULATOR_SUPPLY("vdd-cp" , 20, 0),
SND_SOC_DAPM_SUPPLY("VOUT_MIC" , CS48L32_CHARGE_PUMP1, CS48L32_CP2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_SUPPLY("VOUT_MIC_REGULATED" , CS48L32_CHARGE_PUMP1, CS48L32_CP2_BYPASS_SHIFT,
1, NULL, 0),
SND_SOC_DAPM_SUPPLY("MICBIAS1" , CS48L32_MICBIAS_CTRL1, CS48L32_MICB1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_SUPPLY("MICBIAS1A" , CS48L32_MICBIAS_CTRL5, CS48L32_MICB1A_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_SUPPLY("MICBIAS1B" , CS48L32_MICBIAS_CTRL5, CS48L32_MICB1B_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_SUPPLY("MICBIAS1C" , CS48L32_MICBIAS_CTRL5, CS48L32_MICB1C_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_SUPPLY("DSP1MEM" , SND_SOC_NOPM, 0, 0, cs48l32_dsp_mem_ev,
SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
CS48L32_DSP_FREQ_WIDGET_EV("DSP1" , 0, cs48l32_dsp_freq_ev),
SND_SOC_DAPM_SIGGEN("TONE" ),
SND_SOC_DAPM_SIGGEN("NOISE" ),
SND_SOC_DAPM_INPUT("IN1LN_1" ),
SND_SOC_DAPM_INPUT("IN1LN_2" ),
SND_SOC_DAPM_INPUT("IN1LP_1" ),
SND_SOC_DAPM_INPUT("IN1LP_2" ),
SND_SOC_DAPM_INPUT("IN1RN_1" ),
SND_SOC_DAPM_INPUT("IN1RN_2" ),
SND_SOC_DAPM_INPUT("IN1RP_1" ),
SND_SOC_DAPM_INPUT("IN1RP_2" ),
SND_SOC_DAPM_INPUT("IN1_PDMCLK" ),
SND_SOC_DAPM_INPUT("IN1_PDMDATA" ),
SND_SOC_DAPM_INPUT("IN2_PDMCLK" ),
SND_SOC_DAPM_INPUT("IN2_PDMDATA" ),
SND_SOC_DAPM_MUX("Ultrasonic 1 Input" , SND_SOC_NOPM, 0, 0, &cs48l32_us_inmux[0]),
SND_SOC_DAPM_MUX("Ultrasonic 2 Input" , SND_SOC_NOPM, 0, 0, &cs48l32_us_inmux[1]),
SND_SOC_DAPM_OUTPUT("DRC1 Signal Activity" ),
SND_SOC_DAPM_OUTPUT("DRC2 Signal Activity" ),
SND_SOC_DAPM_OUTPUT("DSP Trigger Out" ),
SND_SOC_DAPM_MUX("IN1L Mux" , SND_SOC_NOPM, 0, 0, &cs48l32_inmux[0]),
SND_SOC_DAPM_MUX("IN1R Mux" , SND_SOC_NOPM, 0, 0, &cs48l32_inmux[1]),
SND_SOC_DAPM_MUX("IN1L Mode" , SND_SOC_NOPM, 0, 0, &cs48l32_dmode_mux[0]),
SND_SOC_DAPM_MUX("IN1R Mode" , SND_SOC_NOPM, 0, 0, &cs48l32_dmode_mux[0]),
SND_SOC_DAPM_AIF_OUT("ASP1TX1" , NULL, 0, CS48L32_ASP1_ENABLES1, 0, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX2" , NULL, 1, CS48L32_ASP1_ENABLES1, 1, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX3" , NULL, 2, CS48L32_ASP1_ENABLES1, 2, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX4" , NULL, 3, CS48L32_ASP1_ENABLES1, 3, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX5" , NULL, 4, CS48L32_ASP1_ENABLES1, 4, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX6" , NULL, 5, CS48L32_ASP1_ENABLES1, 5, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX7" , NULL, 6, CS48L32_ASP1_ENABLES1, 6, 0),
SND_SOC_DAPM_AIF_OUT("ASP1TX8" , NULL, 7, CS48L32_ASP1_ENABLES1, 7, 0),
SND_SOC_DAPM_AIF_OUT("ASP2TX1" , NULL, 0, CS48L32_ASP2_ENABLES1, 0, 0),
SND_SOC_DAPM_AIF_OUT("ASP2TX2" , NULL, 1, CS48L32_ASP2_ENABLES1, 1, 0),
SND_SOC_DAPM_AIF_OUT("ASP2TX3" , NULL, 2, CS48L32_ASP2_ENABLES1, 2, 0),
SND_SOC_DAPM_AIF_OUT("ASP2TX4" , NULL, 3, CS48L32_ASP2_ENABLES1, 3, 0),
SND_SOC_DAPM_SWITCH("AUXPDM1 Output" , CS48L32_AUXPDM_CONTROL1, 0, 0, &cs48l32_auxpdm_switch[0]),
SND_SOC_DAPM_SWITCH("AUXPDM2 Output" , CS48L32_AUXPDM_CONTROL1, 1, 0, &cs48l32_auxpdm_switch[1]),
SND_SOC_DAPM_MUX("AUXPDM1 Input" , SND_SOC_NOPM, 0, 0, &cs48l32_auxpdm_inmux[0]),
SND_SOC_DAPM_MUX("AUXPDM2 Input" , SND_SOC_NOPM, 0, 0, &cs48l32_auxpdm_inmux[1]),
SND_SOC_DAPM_MUX("AUXPDM1 Analog Input" , SND_SOC_NOPM, 0, 0,
&cs48l32_auxpdm_analog_inmux[0]),
SND_SOC_DAPM_MUX("AUXPDM2 Analog Input" , SND_SOC_NOPM, 0, 0,
&cs48l32_auxpdm_analog_inmux[1]),
SND_SOC_DAPM_SWITCH("Ultrasonic 1 Detect" , CS48L32_US_CONTROL,
CS48L32_US1_DET_EN_SHIFT, 0, &cs48l32_us_switch[0]),
SND_SOC_DAPM_SWITCH("Ultrasonic 2 Detect" , CS48L32_US_CONTROL,
CS48L32_US1_DET_EN_SHIFT, 0, &cs48l32_us_switch[1]),
/*
* mux_in widgets : arranged in the order of sources
* specified in CS48L32_MIXER_INPUT_ROUTES
*/
SND_SOC_DAPM_PGA("Tone Generator 1" , CS48L32_TONE_GENERATOR1, 0, 0, NULL, 0),
SND_SOC_DAPM_PGA("Tone Generator 2" , CS48L32_TONE_GENERATOR1, 1, 0, NULL, 0),
SND_SOC_DAPM_PGA("Noise Generator" , CS48L32_COMFORT_NOISE_GENERATOR,
CS48L32_NOISE_GEN_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA_E("IN1L PGA" , CS48L32_INPUT_CONTROL, CS48L32_IN1L_EN_SHIFT,
0, NULL, 0, cs48l32_in_ev,
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU),
SND_SOC_DAPM_PGA_E("IN1R PGA" , CS48L32_INPUT_CONTROL, CS48L32_IN1R_EN_SHIFT,
0, NULL, 0, cs48l32_in_ev,
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU),
SND_SOC_DAPM_PGA_E("IN2L PGA" , CS48L32_INPUT_CONTROL, CS48L32_IN2L_EN_SHIFT,
0, NULL, 0, cs48l32_in_ev,
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU),
SND_SOC_DAPM_PGA_E("IN2R PGA" , CS48L32_INPUT_CONTROL, CS48L32_IN2R_EN_SHIFT,
0, NULL, 0, cs48l32_in_ev,
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU),
SND_SOC_DAPM_AIF_IN("ASP1RX1" , NULL, 0, CS48L32_ASP1_ENABLES1, 16, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX2" , NULL, 1, CS48L32_ASP1_ENABLES1, 17, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX3" , NULL, 2, CS48L32_ASP1_ENABLES1, 18, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX4" , NULL, 3, CS48L32_ASP1_ENABLES1, 19, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX5" , NULL, 4, CS48L32_ASP1_ENABLES1, 20, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX6" , NULL, 5, CS48L32_ASP1_ENABLES1, 21, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX7" , NULL, 6, CS48L32_ASP1_ENABLES1, 22, 0),
SND_SOC_DAPM_AIF_IN("ASP1RX8" , NULL, 7, CS48L32_ASP1_ENABLES1, 23, 0),
SND_SOC_DAPM_AIF_IN("ASP2RX1" , NULL, 0, CS48L32_ASP2_ENABLES1, 16, 0),
SND_SOC_DAPM_AIF_IN("ASP2RX2" , NULL, 1, CS48L32_ASP2_ENABLES1, 17, 0),
SND_SOC_DAPM_AIF_IN("ASP2RX3" , NULL, 2, CS48L32_ASP2_ENABLES1, 18, 0),
SND_SOC_DAPM_AIF_IN("ASP2RX4" , NULL, 3, CS48L32_ASP2_ENABLES1, 19, 0),
SND_SOC_DAPM_PGA("ISRC1DEC1" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_DEC1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1DEC2" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_DEC2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1DEC3" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_DEC3_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1DEC4" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_DEC4_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1INT1" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_INT1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1INT2" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_INT2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1INT3" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_INT3_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC1INT4" , CS48L32_ISRC1_CONTROL2, CS48L32_ISRC1_INT4_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC2DEC1" , CS48L32_ISRC2_CONTROL2, CS48L32_ISRC1_DEC1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC2DEC2" , CS48L32_ISRC2_CONTROL2, CS48L32_ISRC1_DEC2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC2INT1" , CS48L32_ISRC2_CONTROL2, CS48L32_ISRC1_INT1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC2INT2" , CS48L32_ISRC2_CONTROL2, CS48L32_ISRC1_INT2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC3DEC1" , CS48L32_ISRC3_CONTROL2, CS48L32_ISRC1_DEC1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC3DEC2" , CS48L32_ISRC3_CONTROL2, CS48L32_ISRC1_DEC2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC3INT1" , CS48L32_ISRC3_CONTROL2, CS48L32_ISRC1_INT1_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("ISRC3INT2" , CS48L32_ISRC3_CONTROL2, CS48L32_ISRC1_INT2_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA_E("EQ1" , CS48L32_EQ_CONTROL1, 0, 0, NULL, 0, cs48l32_eq_ev, SND_SOC_DAPM_PRE_PMU),
SND_SOC_DAPM_PGA_E("EQ2" , CS48L32_EQ_CONTROL1, 1, 0, NULL, 0, cs48l32_eq_ev, SND_SOC_DAPM_PRE_PMU),
SND_SOC_DAPM_PGA_E("EQ3" , CS48L32_EQ_CONTROL1, 2, 0, NULL, 0, cs48l32_eq_ev, SND_SOC_DAPM_PRE_PMU),
SND_SOC_DAPM_PGA_E("EQ4" , CS48L32_EQ_CONTROL1, 3, 0, NULL, 0, cs48l32_eq_ev, SND_SOC_DAPM_PRE_PMU),
SND_SOC_DAPM_PGA("DRC1L" , CS48L32_DRC1_CONTROL1, CS48L32_DRC1L_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("DRC1R" , CS48L32_DRC1_CONTROL1, CS48L32_DRC1R_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("DRC2L" , CS48L32_DRC2_CONTROL1, CS48L32_DRC1L_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("DRC2R" , CS48L32_DRC2_CONTROL1, CS48L32_DRC1R_EN_SHIFT, 0, NULL, 0),
SND_SOC_DAPM_PGA("LHPF1" , CS48L32_LHPF_CONTROL1, 0, 0, NULL, 0),
SND_SOC_DAPM_PGA("LHPF2" , CS48L32_LHPF_CONTROL1, 1, 0, NULL, 0),
SND_SOC_DAPM_PGA("LHPF3" , CS48L32_LHPF_CONTROL1, 2, 0, NULL, 0),
SND_SOC_DAPM_PGA("LHPF4" , CS48L32_LHPF_CONTROL1, 3, 0, NULL, 0),
SND_SOC_DAPM_PGA("Ultrasonic 1" , CS48L32_US_CONTROL, 0, 0, NULL, 0),
SND_SOC_DAPM_PGA("Ultrasonic 2" , CS48L32_US_CONTROL, 1, 0, NULL, 0),
WM_ADSP2("DSP1" , 0, wm_adsp_early_event),
/* end of ordered widget list */
CS48L32_MIXER_WIDGETS(EQ1, "EQ1" ),
CS48L32_MIXER_WIDGETS(EQ2, "EQ2" ),
CS48L32_MIXER_WIDGETS(EQ3, "EQ3" ),
CS48L32_MIXER_WIDGETS(EQ4, "EQ4" ),
CS48L32_MIXER_WIDGETS(DRC1L, "DRC1L" ),
CS48L32_MIXER_WIDGETS(DRC1R, "DRC1R" ),
CS48L32_MIXER_WIDGETS(DRC2L, "DRC2L" ),
CS48L32_MIXER_WIDGETS(DRC2R, "DRC2R" ),
SND_SOC_DAPM_SWITCH("DRC1 Activity Output" , SND_SOC_NOPM, 0, 0,
&cs48l32_drc_activity_output_mux[0]),
SND_SOC_DAPM_SWITCH("DRC2 Activity Output" , SND_SOC_NOPM, 0, 0,
&cs48l32_drc_activity_output_mux[1]),
CS48L32_MIXER_WIDGETS(LHPF1, "LHPF1" ),
CS48L32_MIXER_WIDGETS(LHPF2, "LHPF2" ),
CS48L32_MIXER_WIDGETS(LHPF3, "LHPF3" ),
CS48L32_MIXER_WIDGETS(LHPF4, "LHPF4" ),
CS48L32_MIXER_WIDGETS(ASP1TX1, "ASP1TX1" ),
CS48L32_MIXER_WIDGETS(ASP1TX2, "ASP1TX2" ),
CS48L32_MIXER_WIDGETS(ASP1TX3, "ASP1TX3" ),
CS48L32_MIXER_WIDGETS(ASP1TX4, "ASP1TX4" ),
CS48L32_MIXER_WIDGETS(ASP1TX5, "ASP1TX5" ),
CS48L32_MIXER_WIDGETS(ASP1TX6, "ASP1TX6" ),
CS48L32_MIXER_WIDGETS(ASP1TX7, "ASP1TX7" ),
CS48L32_MIXER_WIDGETS(ASP1TX8, "ASP1TX8" ),
CS48L32_MIXER_WIDGETS(ASP2TX1, "ASP2TX1" ),
CS48L32_MIXER_WIDGETS(ASP2TX2, "ASP2TX2" ),
CS48L32_MIXER_WIDGETS(ASP2TX3, "ASP2TX3" ),
CS48L32_MIXER_WIDGETS(ASP2TX4, "ASP2TX4" ),
CS48L32_MUX_WIDGETS(ISRC1DEC1, "ISRC1DEC1" ),
CS48L32_MUX_WIDGETS(ISRC1DEC2, "ISRC1DEC2" ),
CS48L32_MUX_WIDGETS(ISRC1DEC3, "ISRC1DEC3" ),
CS48L32_MUX_WIDGETS(ISRC1DEC4, "ISRC1DEC4" ),
CS48L32_MUX_WIDGETS(ISRC1INT1, "ISRC1INT1" ),
CS48L32_MUX_WIDGETS(ISRC1INT2, "ISRC1INT2" ),
CS48L32_MUX_WIDGETS(ISRC1INT3, "ISRC1INT3" ),
CS48L32_MUX_WIDGETS(ISRC1INT4, "ISRC1INT4" ),
CS48L32_MUX_WIDGETS(ISRC2DEC1, "ISRC2DEC1" ),
CS48L32_MUX_WIDGETS(ISRC2DEC2, "ISRC2DEC2" ),
CS48L32_MUX_WIDGETS(ISRC2INT1, "ISRC2INT1" ),
CS48L32_MUX_WIDGETS(ISRC2INT2, "ISRC2INT2" ),
CS48L32_MUX_WIDGETS(ISRC3DEC1, "ISRC3DEC1" ),
CS48L32_MUX_WIDGETS(ISRC3DEC2, "ISRC3DEC2" ),
CS48L32_MUX_WIDGETS(ISRC3INT1, "ISRC3INT1" ),
CS48L32_MUX_WIDGETS(ISRC3INT2, "ISRC3INT2" ),
CS48L32_MIXER_WIDGETS(DSP1RX1, "DSP1RX1" ),
CS48L32_MIXER_WIDGETS(DSP1RX2, "DSP1RX2" ),
CS48L32_MIXER_WIDGETS(DSP1RX3, "DSP1RX3" ),
CS48L32_MIXER_WIDGETS(DSP1RX4, "DSP1RX4" ),
CS48L32_MIXER_WIDGETS(DSP1RX5, "DSP1RX5" ),
CS48L32_MIXER_WIDGETS(DSP1RX6, "DSP1RX6" ),
CS48L32_MIXER_WIDGETS(DSP1RX7, "DSP1RX7" ),
CS48L32_MIXER_WIDGETS(DSP1RX8, "DSP1RX8" ),
SND_SOC_DAPM_SWITCH("DSP1 Trigger Output" , SND_SOC_NOPM, 0, 0,
&cs48l32_dsp_trigger_output_mux[0]),
SND_SOC_DAPM_OUTPUT("AUXPDM1_CLK" ),
SND_SOC_DAPM_OUTPUT("AUXPDM1_DOUT" ),
SND_SOC_DAPM_OUTPUT("AUXPDM2_CLK" ),
SND_SOC_DAPM_OUTPUT("AUXPDM2_DOUT" ),
SND_SOC_DAPM_OUTPUT("MICSUPP" ),
SND_SOC_DAPM_OUTPUT("Ultrasonic Dummy Output" ),
};
static const struct snd_soc_dapm_route cs48l32_dapm_routes[] = {
{ "IN1LN_1" , NULL, "SYSCLK" },
{ "IN1LN_2" , NULL, "SYSCLK" },
{ "IN1LP_1" , NULL, "SYSCLK" },
{ "IN1LP_2" , NULL, "SYSCLK" },
{ "IN1RN_1" , NULL, "SYSCLK" },
{ "IN1RN_2" , NULL, "SYSCLK" },
{ "IN1RP_1" , NULL, "SYSCLK" },
{ "IN1RP_2" , NULL, "SYSCLK" },
{ "IN1_PDMCLK" , NULL, "SYSCLK" },
{ "IN1_PDMDATA" , NULL, "SYSCLK" },
{ "IN2_PDMCLK" , NULL, "SYSCLK" },
{ "IN2_PDMDATA" , NULL, "SYSCLK" },
{ "DSP1 Preloader" , NULL, "DSP1MEM" },
{ "DSP1" , NULL, "DSP1FREQ" },
{ "Audio Trace DSP" , NULL, "DSP1" },
{ "Voice Ctrl DSP" , NULL, "DSP1" },
{ "VOUT_MIC_REGULATED" , NULL, "VOUT_MIC" },
{ "MICBIAS1" , NULL, "VOUT_MIC_REGULATED" },
{ "MICBIAS1A" , NULL, "MICBIAS1" },
{ "MICBIAS1B" , NULL, "MICBIAS1" },
{ "MICBIAS1C" , NULL, "MICBIAS1" },
{ "Tone Generator 1" , NULL, "SYSCLK" },
{ "Tone Generator 2" , NULL, "SYSCLK" },
{ "Noise Generator" , NULL, "SYSCLK" },
{ "Tone Generator 1" , NULL, "TONE" },
{ "Tone Generator 2" , NULL, "TONE" },
{ "Noise Generator" , NULL, "NOISE" },
{ "ASP1 Capture" , NULL, "ASP1TX1" },
{ "ASP1 Capture" , NULL, "ASP1TX2" },
{ "ASP1 Capture" , NULL, "ASP1TX3" },
{ "ASP1 Capture" , NULL, "ASP1TX4" },
{ "ASP1 Capture" , NULL, "ASP1TX5" },
{ "ASP1 Capture" , NULL, "ASP1TX6" },
{ "ASP1 Capture" , NULL, "ASP1TX7" },
{ "ASP1 Capture" , NULL, "ASP1TX8" },
{ "ASP1RX1" , NULL, "ASP1 Playback" },
{ "ASP1RX2" , NULL, "ASP1 Playback" },
{ "ASP1RX3" , NULL, "ASP1 Playback" },
{ "ASP1RX4" , NULL, "ASP1 Playback" },
{ "ASP1RX5" , NULL, "ASP1 Playback" },
{ "ASP1RX6" , NULL, "ASP1 Playback" },
{ "ASP1RX7" , NULL, "ASP1 Playback" },
{ "ASP1RX8" , NULL, "ASP1 Playback" },
{ "ASP2 Capture" , NULL, "ASP2TX1" },
{ "ASP2 Capture" , NULL, "ASP2TX2" },
{ "ASP2 Capture" , NULL, "ASP2TX3" },
{ "ASP2 Capture" , NULL, "ASP2TX4" },
{ "ASP2RX1" , NULL, "ASP2 Playback" },
{ "ASP2RX2" , NULL, "ASP2 Playback" },
{ "ASP2RX3" , NULL, "ASP2 Playback" },
{ "ASP2RX4" , NULL, "ASP2 Playback" },
{ "ASP1 Playback" , NULL, "SYSCLK" },
{ "ASP2 Playback" , NULL, "SYSCLK" },
{ "ASP1 Capture" , NULL, "SYSCLK" },
{ "ASP2 Capture" , NULL, "SYSCLK" },
{ "IN1L Mux" , "Analog 1" , "IN1LN_1" },
{ "IN1L Mux" , "Analog 2" , "IN1LN_2" },
{ "IN1L Mux" , "Analog 1" , "IN1LP_1" },
{ "IN1L Mux" , "Analog 2" , "IN1LP_2" },
{ "IN1R Mux" , "Analog 1" , "IN1RN_1" },
{ "IN1R Mux" , "Analog 2" , "IN1RN_2" },
{ "IN1R Mux" , "Analog 1" , "IN1RP_1" },
{ "IN1R Mux" , "Analog 2" , "IN1RP_2" },
{ "IN1L PGA" , NULL, "IN1L Mode" },
{ "IN1R PGA" , NULL, "IN1R Mode" },
{ "IN1L Mode" , "Analog" , "IN1L Mux" },
{ "IN1R Mode" , "Analog" , "IN1R Mux" },
{ "IN1L Mode" , "Digital" , "IN1_PDMCLK" },
{ "IN1L Mode" , "Digital" , "IN1_PDMDATA" },
{ "IN1R Mode" , "Digital" , "IN1_PDMCLK" },
{ "IN1R Mode" , "Digital" , "IN1_PDMDATA" },
{ "IN1L PGA" , NULL, "VOUT_MIC" },
{ "IN1R PGA" , NULL, "VOUT_MIC" },
{ "IN2L PGA" , NULL, "VOUT_MIC" },
{ "IN2R PGA" , NULL, "VOUT_MIC" },
{ "IN2L PGA" , NULL, "IN2_PDMCLK" },
{ "IN2R PGA" , NULL, "IN2_PDMCLK" },
{ "IN2L PGA" , NULL, "IN2_PDMDATA" },
{ "IN2R PGA" , NULL, "IN2_PDMDATA" },
{ "Ultrasonic 1" , NULL, "Ultrasonic 1 Input" },
{ "Ultrasonic 2" , NULL, "Ultrasonic 2 Input" },
{ "Ultrasonic 1 Input" , "IN1L" , "IN1L PGA" },
{ "Ultrasonic 1 Input" , "IN1R" , "IN1R PGA" },
{ "Ultrasonic 1 Input" , "IN2L" , "IN2L PGA" },
{ "Ultrasonic 1 Input" , "IN2R" , "IN2R PGA" },
{ "Ultrasonic 2 Input" , "IN1L" , "IN1L PGA" },
{ "Ultrasonic 2 Input" , "IN1R" , "IN1R PGA" },
{ "Ultrasonic 2 Input" , "IN2L" , "IN2L PGA" },
{ "Ultrasonic 2 Input" , "IN2R" , "IN2R PGA" },
{ "Ultrasonic 1 Detect" , "Switch" , "Ultrasonic 1 Input" },
{ "Ultrasonic 2 Detect" , "Switch" , "Ultrasonic 2 Input" },
{ "Ultrasonic Dummy Output" , NULL, "Ultrasonic 1 Detect" },
{ "Ultrasonic Dummy Output" , NULL, "Ultrasonic 2 Detect" },
CS48L32_MIXER_ROUTES("ASP1TX1" , "ASP1TX1" ),
CS48L32_MIXER_ROUTES("ASP1TX2" , "ASP1TX2" ),
CS48L32_MIXER_ROUTES("ASP1TX3" , "ASP1TX3" ),
CS48L32_MIXER_ROUTES("ASP1TX4" , "ASP1TX4" ),
CS48L32_MIXER_ROUTES("ASP1TX5" , "ASP1TX5" ),
CS48L32_MIXER_ROUTES("ASP1TX6" , "ASP1TX6" ),
CS48L32_MIXER_ROUTES("ASP1TX7" , "ASP1TX7" ),
CS48L32_MIXER_ROUTES("ASP1TX8" , "ASP1TX8" ),
CS48L32_MIXER_ROUTES("ASP2TX1" , "ASP2TX1" ),
CS48L32_MIXER_ROUTES("ASP2TX2" , "ASP2TX2" ),
CS48L32_MIXER_ROUTES("ASP2TX3" , "ASP2TX3" ),
CS48L32_MIXER_ROUTES("ASP2TX4" , "ASP2TX4" ),
CS48L32_MIXER_ROUTES("EQ1" , "EQ1" ),
CS48L32_MIXER_ROUTES("EQ2" , "EQ2" ),
CS48L32_MIXER_ROUTES("EQ3" , "EQ3" ),
CS48L32_MIXER_ROUTES("EQ4" , "EQ4" ),
CS48L32_MIXER_ROUTES("DRC1L" , "DRC1L" ),
CS48L32_MIXER_ROUTES("DRC1R" , "DRC1R" ),
CS48L32_MIXER_ROUTES("DRC2L" , "DRC2L" ),
CS48L32_MIXER_ROUTES("DRC2R" , "DRC2R" ),
CS48L32_MIXER_ROUTES("LHPF1" , "LHPF1" ),
CS48L32_MIXER_ROUTES("LHPF2" , "LHPF2" ),
CS48L32_MIXER_ROUTES("LHPF3" , "LHPF3" ),
CS48L32_MIXER_ROUTES("LHPF4" , "LHPF4" ),
CS48L32_MUX_ROUTES("ISRC1INT1" , "ISRC1INT1" ),
CS48L32_MUX_ROUTES("ISRC1INT2" , "ISRC1INT2" ),
CS48L32_MUX_ROUTES("ISRC1INT3" , "ISRC1INT3" ),
CS48L32_MUX_ROUTES("ISRC1INT4" , "ISRC1INT4" ),
CS48L32_MUX_ROUTES("ISRC1DEC1" , "ISRC1DEC1" ),
CS48L32_MUX_ROUTES("ISRC1DEC2" , "ISRC1DEC2" ),
CS48L32_MUX_ROUTES("ISRC1DEC3" , "ISRC1DEC3" ),
CS48L32_MUX_ROUTES("ISRC1DEC4" , "ISRC1DEC4" ),
CS48L32_MUX_ROUTES("ISRC2INT1" , "ISRC2INT1" ),
CS48L32_MUX_ROUTES("ISRC2INT2" , "ISRC2INT2" ),
CS48L32_MUX_ROUTES("ISRC2DEC1" , "ISRC2DEC1" ),
CS48L32_MUX_ROUTES("ISRC2DEC2" , "ISRC2DEC2" ),
CS48L32_MUX_ROUTES("ISRC3INT1" , "ISRC3INT1" ),
CS48L32_MUX_ROUTES("ISRC3INT2" , "ISRC3INT2" ),
CS48L32_MUX_ROUTES("ISRC3DEC1" , "ISRC3DEC1" ),
CS48L32_MUX_ROUTES("ISRC3DEC2" , "ISRC3DEC2" ),
CS48L32_DSP_ROUTES_1_8_SYSCLK("DSP1" ),
{ "DSP Trigger Out" , NULL, "DSP1 Trigger Output" },
{ "DSP1 Trigger Output" , "Switch" , "DSP1" },
{ "AUXPDM1 Analog Input" , "IN1L" , "IN1L PGA" },
{ "AUXPDM1 Analog Input" , "IN1R" , "IN1R PGA" },
{ "AUXPDM2 Analog Input" , "IN1L" , "IN1L PGA" },
{ "AUXPDM2 Analog Input" , "IN1R" , "IN1R PGA" },
{ "AUXPDM1 Input" , "Analog" , "AUXPDM1 Analog Input" },
{ "AUXPDM1 Input" , "IN1 Digital" , "IN1L PGA" },
{ "AUXPDM1 Input" , "IN1 Digital" , "IN1R PGA" },
{ "AUXPDM1 Input" , "IN2 Digital" , "IN2L PGA" },
{ "AUXPDM1 Input" , "IN2 Digital" , "IN2R PGA" },
{ "AUXPDM2 Input" , "Analog" , "AUXPDM2 Analog Input" },
{ "AUXPDM2 Input" , "IN1 Digital" , "IN1L PGA" },
{ "AUXPDM2 Input" , "IN1 Digital" , "IN1R PGA" },
{ "AUXPDM2 Input" , "IN2 Digital" , "IN2L PGA" },
{ "AUXPDM2 Input" , "IN2 Digital" , "IN2R PGA" },
{ "AUXPDM1 Output" , "Switch" , "AUXPDM1 Input" },
{ "AUXPDM1_CLK" , NULL, "AUXPDM1 Output" },
{ "AUXPDM1_DOUT" , NULL, "AUXPDM1 Output" },
{ "AUXPDM2 Output" , "Switch" , "AUXPDM2 Input" },
{ "AUXPDM2_CLK" , NULL, "AUXPDM2 Output" },
{ "AUXPDM2_DOUT" , NULL, "AUXPDM2 Output" },
{ "MICSUPP" , NULL, "SYSCLK" },
{ "DRC1 Signal Activity" , NULL, "DRC1 Activity Output" },
{ "DRC2 Signal Activity" , NULL, "DRC2 Activity Output" },
{ "DRC1 Activity Output" , "Switch" , "DRC1L" },
{ "DRC1 Activity Output" , "Switch" , "DRC1R" },
{ "DRC2 Activity Output" , "Switch" , "DRC2L" },
{ "DRC2 Activity Output" , "Switch" , "DRC2R" },
};
static int cs48l32_compr_open(struct snd_soc_component *component,
struct snd_compr_stream *stream)
{
struct snd_soc_pcm_runtime *rtd = stream->private_data;
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
if (strcmp(snd_soc_rtd_to_codec(rtd, 0)->name, "cs48l32-dsp-trace" ) &&
strcmp(snd_soc_rtd_to_codec(rtd, 0)->name, "cs48l32-dsp-voicectrl" )) {
dev_err(cs48l32_codec->core.dev, "No suitable compressed stream for DAI '%s'\n" ,
snd_soc_rtd_to_codec(rtd, 0)->name);
return -EINVAL;
}
return wm_adsp_compr_open(&cs48l32_codec->dsp, stream);
}
static const struct snd_compress_ops cs48l32_compress_ops = {
.open = &cs48l32_compr_open,
.free = &wm_adsp_compr_free,
.set_params = &wm_adsp_compr_set_params,
.get_caps = &wm_adsp_compr_get_caps,
.trigger = &wm_adsp_compr_trigger,
.pointer = &wm_adsp_compr_pointer,
.copy = &wm_adsp_compr_copy,
};
static const struct snd_soc_dai_ops cs48l32_compress_dai_ops = {
.compress_new = snd_soc_new_compress,
};
static struct snd_soc_dai_driver cs48l32_dai[] = {
{
.name = "cs48l32-asp1" ,
.id = 1,
.base = CS48L32_ASP1_ENABLES1,
.playback = {
.stream_name = "ASP1 Playback" ,
.channels_min = 1,
.channels_max = 8,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
.capture = {
.stream_name = "ASP1 Capture" ,
.channels_min = 1,
.channels_max = 8,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
.ops = &cs48l32_dai_ops,
.symmetric_rate = 1,
.symmetric_sample_bits = 1,
},
{
.name = "cs48l32-asp2" ,
.id = 2,
.base = CS48L32_ASP2_ENABLES1,
.playback = {
.stream_name = "ASP2 Playback" ,
.channels_min = 1,
.channels_max = 4,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
.capture = {
.stream_name = "ASP2 Capture" ,
.channels_min = 1,
.channels_max = 4,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
.ops = &cs48l32_dai_ops,
.symmetric_rate = 1,
.symmetric_sample_bits = 1,
},
{
.name = "cs48l32-cpu-trace" ,
.id = 3,
.capture = {
.stream_name = "Audio Trace CPU" ,
.channels_min = 1,
.channels_max = 8,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
.ops = &cs48l32_compress_dai_ops,
},
{
.name = "cs48l32-dsp-trace" ,
.id = 4,
.capture = {
.stream_name = "Audio Trace DSP" ,
.channels_min = 1,
.channels_max = 8,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
},
{
.name = "cs48l32-cpu-voicectrl" ,
.id = 5,
.capture = {
.stream_name = "Voice Ctrl CPU" ,
.channels_min = 1,
.channels_max = 8,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
.ops = &cs48l32_compress_dai_ops,
},
{
.name = "cs48l32-dsp-voicectrl" ,
.id = 6,
.capture = {
.stream_name = "Voice Ctrl DSP" ,
.channels_min = 1,
.channels_max = 8,
.rates = CS48L32_RATES,
.formats = CS48L32_FORMATS,
},
},
};
static int cs48l32_init_inputs(struct snd_soc_component *component)
{
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
struct regmap *regmap = cs48l32_codec->core.regmap;
unsigned int ana_mode_l, ana_mode_r, dig_mode;
int i;
/*
* Initialize input modes from the A settings. For muxed inputs the
* B settings will be applied if the mux is changed
*/
switch (cs48l32_codec->in_type[0][0]) {
default :
case CS48L32_IN_TYPE_DIFF:
ana_mode_l = 0;
break ;
case CS48L32_IN_TYPE_SE:
ana_mode_l = 1 << CS48L32_INx_SRC_SHIFT;
break ;
}
switch (cs48l32_codec->in_type[1][0]) {
default :
case CS48L32_IN_TYPE_DIFF:
ana_mode_r = 0;
break ;
case CS48L32_IN_TYPE_SE:
ana_mode_r = 1 << CS48L32_INx_SRC_SHIFT;
break ;
}
dev_dbg(cs48l32_codec->core.dev, "IN1_1 Analogue mode=#%x,#%x\n" ,
ana_mode_l, ana_mode_r);
regmap_update_bits(regmap,
CS48L32_IN1L_CONTROL1,
CS48L32_INx_SRC_MASK,
ana_mode_l);
regmap_update_bits(regmap,
CS48L32_IN1R_CONTROL1,
CS48L32_INx_SRC_MASK,
ana_mode_r);
for (i = 0; i < ARRAY_SIZE(cs48l32_codec->pdm_sup); i++) {
dig_mode = cs48l32_codec->pdm_sup[i] << CS48L32_IN1_PDM_SUP_SHIFT;
dev_dbg(cs48l32_codec->core.dev, "IN%d PDM_SUP=#%x\n" , i + 1, dig_mode);
regmap_update_bits(regmap,
CS48L32_INPUT1_CONTROL1 + (i * 0x40),
CS48L32_IN1_PDM_SUP_MASK, dig_mode);
}
return 0;
}
static int cs48l32_init_dai(struct cs48l32_codec *cs48l32_codec, int id)
{
struct cs48l32_dai_priv *dai_priv = &cs48l32_codec->dai[id];
dai_priv->clk = CS48L32_CLK_SYSCLK_1;
dai_priv->constraint = cs48l32_constraint;
return 0;
}
static int cs48l32_init_eq(struct cs48l32_codec *cs48l32_codec)
{
struct regmap *regmap = cs48l32_codec->core.regmap;
unsigned int reg = CS48L32_EQ1_BAND1_COEFF1, mode;
__be16 *data;
int i, ret;
ret = regmap_read(regmap, CS48L32_EQ_CONTROL2, &mode);
if (ret < 0) {
dev_err(cs48l32_codec->core.dev, "Error reading EQ mode: %d\n" , ret);
goto out;
}
for (i = 0; i < 4; ++i) {
cs48l32_codec->eq_mode[i] = (mode >> i) & 0x1;
data = &cs48l32_codec->eq_coefficients[i][0];
ret = regmap_raw_read(regmap, reg + (i * 68), data,
CS48L32_EQ_BLOCK_SZ);
if (ret < 0) {
dev_err(cs48l32_codec->core.dev,
"Error reading EQ coefficients: %d\n" , ret);
goto out;
}
}
out:
return ret;
}
static int cs48l32_component_probe(struct snd_soc_component *component)
{
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
int i, ret;
snd_soc_component_init_regmap(component, cs48l32_codec->core.regmap);
ret = cs48l32_init_inputs(component);
if (ret)
return ret;
for (i = 0; i < ARRAY_SIZE(cs48l32_dai); i++)
cs48l32_init_dai(cs48l32_codec, i);
ret = cs48l32_init_eq(cs48l32_codec);
if (ret)
return ret;
wm_adsp2_component_probe(&cs48l32_codec->dsp, component);
/* Unmask DSP IRQs */
regmap_clear_bits(cs48l32_codec->core.regmap, CS48L32_IRQ1_MASK_7,
CS48L32_DSP1_MPU_ERR_EINT1_MASK | CS48L32_DSP1_WDT_EXPIRE_EINT1_MASK);
regmap_clear_bits(cs48l32_codec->core.regmap, CS48L32_IRQ1_MASK_9,
CS48L32_DSP1_IRQ0_EINT1_MASK);
return 0;
}
static void cs48l32_component_remove(struct snd_soc_component *component)
{
struct cs48l32_codec *cs48l32_codec = snd_soc_component_get_drvdata(component);
/* Mask DSP IRQs */
regmap_set_bits(cs48l32_codec->core.regmap, CS48L32_IRQ1_MASK_7,
CS48L32_DSP1_MPU_ERR_EINT1_MASK | CS48L32_DSP1_WDT_EXPIRE_EINT1_MASK);
regmap_set_bits(cs48l32_codec->core.regmap, CS48L32_IRQ1_MASK_9,
CS48L32_DSP1_IRQ0_EINT1_MASK);
wm_adsp2_component_remove(&cs48l32_codec->dsp, component);
}
static const struct snd_soc_component_driver cs48l32_soc_component_drv = {
.probe = &cs48l32_component_probe,
.remove = &cs48l32_component_remove,
.set_sysclk = &cs48l32_set_sysclk,
.set_pll = &cs48l32_set_fll,
.name = "cs48l32-codec" ,
.compress_ops = &cs48l32_compress_ops,
.controls = cs48l32_snd_controls,
.num_controls = ARRAY_SIZE(cs48l32_snd_controls),
.dapm_widgets = cs48l32_dapm_widgets,
.num_dapm_widgets = ARRAY_SIZE(cs48l32_dapm_widgets),
.dapm_routes = cs48l32_dapm_routes,
.num_dapm_routes = ARRAY_SIZE(cs48l32_dapm_routes),
.use_pmdown_time = 1,
.endianness = 1,
};
static int cs48l32_prop_read_u32_array(struct cs48l32_codec *cs48l32_codec,
const char *propname,
u32 *dest,
int n_max)
{
struct cs48l32 *cs48l32 = &cs48l32_codec->core;
int ret;
ret = device_property_read_u32_array(cs48l32->dev, propname, dest, n_max);
if (ret == -EINVAL)
return -ENOENT;
if (ret < 0)
return dev_err_probe(cs48l32->dev, ret, "%s malformed\n" , propname);
return 0;
}
static void cs48l32_prop_get_in_type(struct cs48l32_codec *cs48l32_codec)
{
const char *propname = "cirrus,in-type" ;
u32 tmp[CS48L32_MAX_ANALOG_INPUT * CS48L32_MAX_IN_MUX_WAYS];
int i, in_idx, mux_way_idx, ret;
static_assert(ARRAY_SIZE(tmp) ==
ARRAY_SIZE(cs48l32_codec->in_type) * ARRAY_SIZE(cs48l32_codec->in_type[0]));
ret = cs48l32_prop_read_u32_array(cs48l32_codec, propname, tmp, ARRAY_SIZE(tmp));
if (ret < 0)
return ;
in_idx = 0;
mux_way_idx = 0;
for (i = 0; i < ARRAY_SIZE(tmp); ++i) {
switch (tmp[i]) {
case CS48L32_IN_TYPE_DIFF:
case CS48L32_IN_TYPE_SE:
cs48l32_codec->in_type[in_idx][mux_way_idx] = tmp[i];
break ;
default :
dev_warn(cs48l32_codec->core.dev, "Illegal %s value %d ignored\n" ,
propname, tmp[i]);
break ;
}
/*
* Property array is [mux_way][in_channel]. Swap to
* [in_channel][mux_way] for convenience.
*/
if (++in_idx == ARRAY_SIZE(cs48l32_codec->in_type)) {
in_idx = 0;
++mux_way_idx;
}
}
}
static void cs48l32_prop_get_pdm_sup(struct cs48l32_codec *cs48l32_codec)
{
const char *propname = "cirrus,pdm-sup" ;
u32 tmp[CS48L32_MAX_ANALOG_INPUT];
int i;
static_assert(ARRAY_SIZE(tmp) == ARRAY_SIZE(cs48l32_codec->pdm_sup));
cs48l32_prop_read_u32_array(cs48l32_codec, propname, tmp, ARRAY_SIZE(tmp));
for (i = 0; i < ARRAY_SIZE(cs48l32_codec->pdm_sup); i++) {
switch (tmp[i]) {
case CS48L32_PDM_SUP_VOUT_MIC:
case CS48L32_PDM_SUP_MICBIAS1:
cs48l32_codec->pdm_sup[i] = tmp[i];
break ;
default :
dev_warn(cs48l32_codec->core.dev, "Illegal %s value %d ignored\n" ,
propname, cs48l32_codec->pdm_sup[i]);
break ;
}
}
}
static void cs48l32_handle_properties(struct cs48l32_codec *cs48l32_codec)
{
cs48l32_prop_get_in_type(cs48l32_codec);
cs48l32_prop_get_pdm_sup(cs48l32_codec);
}
static int cs48l32_request_interrupt(struct cs48l32_codec *cs48l32_codec)
{
int irq = cs48l32_codec->core.irq;
int ret;
if (irq < 1)
return 0;
/*
* Don't use devm because this must be freed before destroying the
* rest of the driver
*/
ret = request_threaded_irq(irq, NULL, cs48l32_irq,
IRQF_ONESHOT | IRQF_SHARED | IRQF_TRIGGER_LOW,
"cs48l32" , cs48l32_codec);
if (ret)
return dev_err_probe(cs48l32_codec->core.dev, ret, "Failed to get IRQ\n" );
return 0;
}
static int cs48l32_create_codec_component(struct cs48l32_codec *cs48l32_codec)
{
struct wm_adsp *dsp;
int ret;
ASSERT_STRUCT_OFFSET(struct cs48l32_codec, dsp, 0);
static_assert(ARRAY_SIZE(cs48l32_dai) == ARRAY_SIZE(cs48l32_codec->dai));
cs48l32_handle_properties(cs48l32_codec);
dsp = &cs48l32_codec->dsp;
dsp->part = "cs48l32" ;
dsp->cs_dsp.num = 1;
dsp->cs_dsp.type = WMFW_HALO;
dsp->cs_dsp.rev = 0;
dsp->cs_dsp.dev = cs48l32_codec->core.dev;
dsp->cs_dsp.regmap = cs48l32_codec->core.regmap;
dsp->cs_dsp.base = CS48L32_DSP1_CLOCK_FREQ;
dsp->cs_dsp.base_sysinfo = CS48L32_DSP1_SYS_INFO_ID;
dsp->cs_dsp.mem = cs48l32_dsp1_regions;
dsp->cs_dsp.num_mems = ARRAY_SIZE(cs48l32_dsp1_regions);
dsp->pre_run = cs48l32_dsp_pre_run;
ret = wm_halo_init(dsp);
if (ret != 0)
return ret;
cs48l32_codec->fll.codec = cs48l32_codec;
cs48l32_codec->fll.id = 1;
cs48l32_codec->fll.base = CS48L32_FLL1_CONTROL1;
cs48l32_codec->fll.sts_addr = CS48L32_IRQ1_STS_6;
cs48l32_codec->fll.sts_mask = CS48L32_FLL1_LOCK_STS1_MASK;
cs48l32_init_fll(&cs48l32_codec->fll);
ret = cs48l32_request_interrupt(cs48l32_codec);
if (ret)
goto err_dsp;
ret = devm_snd_soc_register_component(cs48l32_codec->core.dev,
&cs48l32_soc_component_drv,
cs48l32_dai,
ARRAY_SIZE(cs48l32_dai));
if (ret < 0) {
dev_err_probe(cs48l32_codec->core.dev, ret, "Failed to register component\n" );
goto err_dsp;
}
return 0;
err_dsp:
wm_adsp2_remove(&cs48l32_codec->dsp);
return ret;
}
static int cs48l32_wait_for_boot(struct cs48l32 *cs48l32)
{
unsigned int val;
int ret;
ret = regmap_read_poll_timeout(cs48l32->regmap, CS48L32_IRQ1_EINT_2, val,
((val < 0xffffffff) && (val & CS48L32_BOOT_DONE_EINT1_MASK)),
1000, CS48L32_BOOT_TIMEOUT_US);
if (ret) {
dev_err(cs48l32->dev, "BOOT_DONE timed out\n" );
return -ETIMEDOUT;
}
ret = regmap_read(cs48l32->regmap, CS48L32_MCU_CTRL1, &val);
if (ret) {
dev_err(cs48l32->dev, "Failed to read MCU_CTRL1: %d\n" , ret);
return ret;
}
if (val & BIT(CS48L32_MCU_STS_SHIFT)) {
dev_err(cs48l32->dev, "MCU boot failed\n" );
return -EIO;
}
pm_runtime_mark_last_busy(cs48l32->dev);
return 0;
}
static int cs48l32_soft_reset(struct cs48l32 *cs48l32)
{
int ret;
ret = regmap_write(cs48l32->regmap, CS48L32_SFT_RESET, CS48L32_SFT_RESET_MAGIC);
if (ret != 0) {
dev_err(cs48l32->dev, "Failed to write soft reset: %d\n" , ret);
return ret;
}
usleep_range(CS48L32_SOFT_RESET_US, CS48L32_SOFT_RESET_US + 1000);
return 0;
}
static void cs48l32_enable_hard_reset(struct cs48l32 *cs48l32)
{
if (cs48l32->reset_gpio)
gpiod_set_raw_value_cansleep(cs48l32->reset_gpio, 0);
}
static void cs48l32_disable_hard_reset(struct cs48l32 *cs48l32)
{
if (cs48l32->reset_gpio) {
gpiod_set_raw_value_cansleep(cs48l32->reset_gpio, 1);
usleep_range(CS48L32_HARD_RESET_MIN_US, CS48L32_HARD_RESET_MIN_US + 1000);
}
}
static int cs48l32_runtime_resume(struct device *dev)
{
struct cs48l32_codec *cs48l32_codec = dev_get_drvdata(dev);
struct cs48l32 *cs48l32 = &cs48l32_codec->core;
unsigned int val;
int ret;
ret = regulator_enable(cs48l32->vdd_d);
if (ret) {
dev_err(cs48l32->dev, "Failed to enable VDD_D: %d\n" , ret);
return ret;
}
usleep_range(CS48L32_SOFT_RESET_US, CS48L32_SOFT_RESET_US + 1000);
regcache_cache_only(cs48l32->regmap, false );
ret = cs48l32_wait_for_boot(cs48l32);
if (ret)
goto err;
/* Check whether registers reset during suspend */
regmap_read(cs48l32->regmap, CS48L32_CTRL_IF_DEBUG3, &val);
if (!val)
regcache_mark_dirty(cs48l32->regmap);
else
dev_dbg(cs48l32->dev, "Did not reset during suspend\n" );
ret = regcache_sync(cs48l32->regmap);
if (ret) {
dev_err(cs48l32->dev, "Failed to restore register cache\n" );
goto err;
}
return 0;
err:
regcache_cache_only(cs48l32->regmap, true );
regulator_disable(cs48l32->vdd_d);
return ret;
}
static int cs48l32_runtime_suspend(struct device *dev)
{
struct cs48l32_codec *cs48l32_codec = dev_get_drvdata(dev);
struct cs48l32 *cs48l32 = &cs48l32_codec->core;
/* Flag to detect if the registers reset during suspend */
regmap_write(cs48l32->regmap, CS48L32_CTRL_IF_DEBUG3, 1);
regcache_cache_only(cs48l32->regmap, true );
regulator_disable(cs48l32->vdd_d);
return 0;
}
static const struct dev_pm_ops cs48l32_pm_ops = {
RUNTIME_PM_OPS(cs48l32_runtime_suspend, cs48l32_runtime_resume, NULL)
};
static int cs48l32_configure_clk32k(struct cs48l32 *cs48l32)
{
int ret = 0;
ret = clk_prepare_enable(cs48l32->mclk1);
if (ret)
return dev_err_probe(cs48l32->dev, ret, "Failed to enable 32k clock\n" );
ret = regmap_update_bits(cs48l32->regmap, CS48L32_CLOCK32K,
CS48L32_CLK_32K_EN_MASK | CS48L32_CLK_32K_SRC_MASK,
CS48L32_CLK_32K_EN_MASK | CS48L32_32K_MCLK1);
if (ret) {
clk_disable_unprepare(cs48l32->mclk1);
return dev_err_probe(cs48l32->dev, ret, "Failed to init 32k clock\n" );
}
return 0;
}
static int cs48l32_get_clocks(struct cs48l32 *cs48l32)
{
cs48l32->mclk1 = devm_clk_get_optional(cs48l32->dev, "mclk1" );
if (IS_ERR(cs48l32->mclk1))
return dev_err_probe(cs48l32->dev, PTR_ERR(cs48l32->mclk1),
"Failed to get mclk1\n" );
return 0;
}
static int cs48l32_get_reset_gpio(struct cs48l32 *cs48l32)
{
struct gpio_desc *reset;
reset = devm_gpiod_get_optional(cs48l32->dev, "reset" , GPIOD_OUT_LOW);
if (IS_ERR(reset))
return dev_err_probe(cs48l32->dev, PTR_ERR(reset), "Failed to request /RESET\n" );
/* ACPI can override the GPIOD_OUT_LOW so ensure it starts low */
gpiod_set_raw_value_cansleep(reset, 0);
cs48l32->reset_gpio = reset;
return 0;
}
static int cs48l32_spi_probe(struct spi_device *spi)
{
struct device *dev = &spi->dev;
struct cs48l32_codec *cs48l32_codec;
struct cs48l32 *cs48l32;
unsigned int hwid, rev, otp_rev;
int i, ret;
cs48l32_codec = devm_kzalloc(&spi->dev, sizeof (*cs48l32_codec), GFP_KERNEL);
if (!cs48l32_codec)
return -ENOMEM;
cs48l32 = &cs48l32_codec->core;
cs48l32->dev = dev;
cs48l32->irq = spi->irq;
mutex_init(&cs48l32_codec->rate_lock);
cs48l32_codec->in_vu_reg = CS48L32_INPUT_CONTROL3;
dev_set_drvdata(cs48l32->dev, cs48l32_codec);
ret = cs48l32_create_regmap(spi, cs48l32);
if (ret)
return dev_err_probe(&spi->dev, ret, "Failed to allocate regmap\n" );
regcache_cache_only(cs48l32->regmap, true );
ret = cs48l32_get_reset_gpio(cs48l32);
if (ret)
return ret;
ret = cs48l32_get_clocks(cs48l32);
if (ret)
return ret;
static_assert(ARRAY_SIZE(cs48l32_core_supplies) == ARRAY_SIZE(cs48l32->core_supplies));
for (i = 0; i < ARRAY_SIZE(cs48l32->core_supplies); i++)
cs48l32->core_supplies[i].supply = cs48l32_core_supplies[i];
ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(cs48l32->core_supplies),
cs48l32->core_supplies);
if (ret)
return dev_err_probe(dev, ret, "Failed to request core supplies\n" );
cs48l32->vdd_d = devm_regulator_get(cs48l32->dev, "vdd-d" );
if (IS_ERR(cs48l32->vdd_d))
return dev_err_probe(dev, PTR_ERR(cs48l32->vdd_d), "Failed to request vdd-d\n" );
ret = regulator_bulk_enable(ARRAY_SIZE(cs48l32->core_supplies), cs48l32->core_supplies);
if (ret)
return dev_err_probe(dev, ret, "Failed to enable core supplies\n" );
ret = regulator_enable(cs48l32->vdd_d);
if (ret) {
dev_err(dev, "Failed to enable vdd-d: %d\n" , ret);
goto err_enable;
}
cs48l32_disable_hard_reset(cs48l32);
regcache_cache_only(cs48l32->regmap, false );
/* If we don't have a reset GPIO use a soft reset */
if (!cs48l32->reset_gpio) {
ret = cs48l32_soft_reset(cs48l32);
if (ret)
goto err_reset;
}
ret = cs48l32_wait_for_boot(cs48l32);
if (ret) {
dev_err(cs48l32->dev, "Device failed initial boot: %d\n" , ret);
goto err_reset;
}
ret = regmap_read(cs48l32->regmap, CS48L32_DEVID, &hwid);
if (ret) {
dev_err(dev, "Failed to read ID register: %d\n" , ret);
goto err_reset;
}
hwid &= CS48L32_DEVID_MASK;
switch (hwid) {
case CS48L32_SILICON_ID:
break ;
default :
ret = -ENODEV;
dev_err_probe(cs48l32->dev, ret, "Unknown device ID: %#x\n" , hwid);
goto err_reset;
}
ret = regmap_read(cs48l32->regmap, CS48L32_REVID, &rev);
if (ret) {
dev_err(dev, "Failed to read revision register: %d\n" , ret);
goto err_reset;
}
rev &= CS48L32_AREVID_MASK | CS48L32_MTLREVID_MASK;
ret = regmap_read(cs48l32->regmap, CS48L32_OTPID, &otp_rev);
if (ret) {
dev_err(dev, "Failed to read OTP revision register: %d\n" , ret);
goto err_reset;
}
otp_rev &= CS48L32_OTPID_MASK;
dev_info(dev, "CS48L%x revision %X%u OTP%u\n" , hwid & 0xff,
rev >> CS48L32_AREVID_SHIFT, rev & CS48L32_MTLREVID_MASK, otp_rev);
/* Apply hardware patch */
ret = cs48l32_apply_patch(cs48l32);
if (ret) {
dev_err(cs48l32->dev, "Failed to apply patch %d\n" , ret);
goto err_reset;
}
/* BOOT_DONE interrupt is unmasked by default, so mask it */
ret = regmap_set_bits(cs48l32->regmap, CS48L32_IRQ1_MASK_2, CS48L32_BOOT_DONE_EINT1_MASK);
ret = cs48l32_configure_clk32k(cs48l32);
if (ret)
goto err_reset;
pm_runtime_set_active(cs48l32->dev);
pm_runtime_set_autosuspend_delay(cs48l32->dev, 100);
pm_runtime_use_autosuspend(cs48l32->dev);
pm_runtime_enable(cs48l32->dev);
ret = cs48l32_create_codec_component(cs48l32_codec);
if (ret)
goto err_clk32k;
return 0;
err_clk32k:
clk_disable_unprepare(cs48l32->mclk1);
err_reset:
cs48l32_enable_hard_reset(cs48l32);
regulator_disable(cs48l32->vdd_d);
err_enable:
regulator_bulk_disable(ARRAY_SIZE(cs48l32->core_supplies), cs48l32->core_supplies);
return ret;
}
static void cs48l32_spi_remove(struct spi_device *spi)
{
struct cs48l32_codec *cs48l32_codec = spi_get_drvdata(spi);
struct cs48l32 *cs48l32 = &cs48l32_codec->core;
/* Remove IRQ handler before destroying anything else */
if (cs48l32->irq >= 1)
free_irq(cs48l32->irq, cs48l32_codec);
pm_runtime_disable(cs48l32->dev);
regulator_disable(cs48l32->vdd_d);
clk_disable_unprepare(cs48l32->mclk1);
cs48l32_enable_hard_reset(cs48l32);
regulator_bulk_disable(ARRAY_SIZE(cs48l32->core_supplies), cs48l32->core_supplies);
mutex_destroy(&cs48l32_codec->rate_lock);
}
static const struct of_device_id cs48l32_of_match[] = {
{ .compatible = "cirrus,cs48l32" , },
{},
};
static const struct spi_device_id cs48l32_spi_ids[] = {
{ "cs48l32" , },
{ },
};
MODULE_DEVICE_TABLE(spi, cs48l32_spi_ids);
static struct spi_driver cs48l32_spi_driver = {
.driver = {
.name = "cs48l32" ,
.pm = pm_ptr(&cs48l32_pm_ops),
.of_match_table = cs48l32_of_match,
},
.probe = &cs48l32_spi_probe,
.remove = &cs48l32_spi_remove,
.id_table = cs48l32_spi_ids,
};
module_spi_driver(cs48l32_spi_driver);
MODULE_DESCRIPTION("CS48L32 ASoC codec driver" );
MODULE_AUTHOR("Stuart Henderson <stuarth@opensource.cirrus.com>" );
MODULE_AUTHOR("Piotr Stankiewicz <piotrs@opensource.cirrus.com>" );
MODULE_AUTHOR("Richard Fitzgerald <rf@opensource.cirrus.com>" );
MODULE_LICENSE("GPL" );
Messung V0.5 in Prozent C=97 H=96 G=96
¤ Dauer der Verarbeitung: 0.46 Sekunden
(vorverarbeitet am 2026-04-25)
¤
*© Formatika GbR, Deutschland