// 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[] = {static const struct cs48l32_dsp_power_reg_block cs48l32_dsp1_sram_ext_regs[] = {static const unsigned int cs48l32_dsp1_sram_pwd_regs[] = {static const struct cs48l32_dsp_power_regs cs48l32_dsp_sram_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[] = {/* Silence (mute) */ /* Tone generator 1 */ /* Tone generator 2 */ /* Noise Generator */ /* IN1L signal path */ /* IN1R signal path */ /* IN2L signal path */ /* IN2R signal path */ /* ASP1 RX1 */ /* ASP1 RX2 */ /* ASP1 RX3 */ /* ASP1 RX4 */ /* ASP1 RX5 */ /* ASP1 RX6 */ /* ASP1 RX7 */ /* ASP1 RX8 */ /* ASP2 RX1 */ /* ASP2 RX2 */ /* ASP2 RX3 */ /* ASP2 RX4 */ /* ISRC1 INT1 */ /* ISRC1 INT2 */ /* ISRC1 INT3 */ /* ISRC1 INT4 */ /* ISRC1 DEC1 */ /* ISRC1 DEC2 */ /* ISRC1 DEC3 */ /* ISRC1 DEC4 */ /* ISRC2 INT1 */ /* ISRC2 INT2 */ /* ISRC2 DEC1 */ /* ISRC2 DEC2 */ /* ISRC3 INT1 */ /* ISRC3 INT2 */ /* ISRC3 DEC1 */ /* ISRC3 DEC2 */ /* EQ1 */ /* EQ2 */ /* EQ3 */ /* EQ4 */ /* DRC1 Left */ /* DRC1 Right */ /* DRC2 Left */ /* DRC2 Right */ /* LHPF1 */ /* LHPF2 */ /* LHPF3 */ /* LHPF4 */ /* Ultrasonic 1 */ /* Ultrasonic 2 */ /* DSP1 channel 1 */ /* DSP1 channel 2 */ /* DSP1 channel 3 */ /* DSP1 channel 4 */ /* DSP1 channel 5 */ /* DSP1 channel 6 */ /* DSP1 channel 7 */ /* DSP1 channel 8 */ ;#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++) {if (ret)"%s Failed to read register: %d (%d)\n" ,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[] = {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 */ /* The write must be guarded by a number of SYSCLK cycles */ 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[] = {/* 12kHz */ /* 24kHz */ /* 48kHz */ /* 96kHz */ /* 192kHz */ /* 384kHz */ /* 768kHz */ /* 11.025kHz */ /* 22.05kHz */ /* 44.1kHz */ /* 88.2kHz */ /* 176.4kHz */ /* 352.8kHz */ /* 705.6kHz */ /* 8kHz */ /* 16kHz */ /* 32kHz */ e_text));#define CS48L32_SAMPLE_RATE_ENUM_SIZE ARRAY_SIZE(cs48l32_sample_rate_val)static const struct soc_enum cs48l32_sample_rate[] = {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;if (mux > 1)return -EINVAL;switch (e->reg) {case CS48L32_IN1L_CONTROL1:break ;case CS48L32_IN1R_CONTROL1:break ;default :return -EINVAL;if (in_type == CS48L32_IN_TYPE_SE)if (ret > 0)return ret;static const char * const cs48l32_inmux_texts[] = {"Analog 1" , "Analog 2" ,static SOC_ENUM_SINGLE_DECL(cs48l32_in1muxl_enum,static SOC_ENUM_SINGLE_DECL(cs48l32_in1muxr_enum,static const struct snd_kcontrol_new cs48l32_inmux[] = {"IN1L Mux" , cs48l32_in1muxl_enum,"IN1R Mux" , cs48l32_in1muxr_enum,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;switch (mode) {case 0:if (ret < 0) {"Failed to set ADC1L_INT_ENA_FRC: %d\n" , ret);return ret;if (ret < 0) {"Failed to set ADC1R_INT_ENA_FRC: %d\n" , ret);return ret;if (result < 0) {"Failed to set input mode: %d\n" , result);return result;if (ret < 0) {"Failed to clear ADC1L_INT_ENA_FRC: %d\n" , ret);return ret;if (ret < 0) {"Failed to clear ADC1R_INT_ENA_FRC: %d\n" , ret);return ret;if (result > 0)return result;case 1:return snd_soc_dapm_put_enum_double(kcontrol, ucontrol);default :return -EINVAL;static SOC_ENUM_SINGLE_DECL(cs48l32_in1dmode_enum,static const struct snd_kcontrol_new cs48l32_dmode_mux[] = {"IN1 Mode" , cs48l32_in1dmode_enum,static const char * const cs48l32_in_texts[] = {"IN1L" , "IN1R" , "IN2L" , "IN2R" ,static const char * const cs48l32_us_freq_texts[] = {"16-24kHz" , "20-28kHz" ,static const unsigned int cs48l32_us_freq_val[] = {static const struct soc_enum cs48l32_us_freq[] = {static const unsigned int cs48l32_us_in_val[] = {static const struct soc_enum cs48l32_us_inmux_enum[] = {static const struct snd_kcontrol_new cs48l32_us_inmux[] = {"Ultrasonic 1 Input" , cs48l32_us_inmux_enum[0]),"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[] = {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[] = {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[] = {static const struct soc_enum cs48l32_us_output_rate[] = {static const char * const cs48l32_us_det_lpf_cut_texts[] = {"1722Hz" , "833Hz" , "408Hz" , "203Hz" ,static const struct soc_enum cs48l32_us_det_lpf_cut[] = {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[] = {static const struct snd_kcontrol_new cs48l32_us_switch[] = {"Switch" , SND_SOC_NOPM, 0, 1, 0),"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,static SOC_ENUM_SINGLE_DECL(cs48l32_in_vi_ramp,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,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[] = {static bool cs48l32_is_input_enabled(struct snd_soc_component *component,unsigned int reg)unsigned int input_active;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;/* Cannot change rate on an active input */ if (cs48l32_is_input_enabled(component, e->reg)) {goto exit ;exit :return ret;static const struct soc_enum cs48l32_input_rate[] = {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;/* Cannot change rate on an active input */ if (cs48l32_is_input_enabled(component, mc->reg)) {goto exit ;exit :return ret;static const struct soc_enum noise_gen_rate =static const char * const cs48l32_auxpdm_freq_texts[] = {"3.072MHz" , "2.048MHz" , "1.536MHz" , "768kHz" ,static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm1_freq,static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm2_freq,static const char * const cs48l32_auxpdm_src_texts[] = {"Analog" , "IN1 Digital" , "IN2 Digital" ,static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm1_in,static SOC_ENUM_SINGLE_DECL(cs48l32_auxpdm2_in,static const struct snd_kcontrol_new cs48l32_auxpdm_inmux[] = {"AUXPDM1 Input" , cs48l32_auxpdm1_in),"AUXPDM2 Input" , cs48l32_auxpdm2_in),static const unsigned int cs48l32_auxpdm_analog_in_val[] = {static const struct soc_enum cs48l32_auxpdm_analog_inmux_enum[] = {static const struct snd_kcontrol_new cs48l32_auxpdm_analog_inmux[] = {"AUXPDM1 Analog Input" , cs48l32_auxpdm_analog_inmux_enum[0]),"AUXPDM2 Analog Input" , cs48l32_auxpdm_analog_inmux_enum[1]),static const struct snd_kcontrol_new cs48l32_auxpdm_switch[] = {"Switch" , SND_SOC_NOPM, 0, 1, 0),"Switch" , SND_SOC_NOPM, 0, 1, 0),static const struct soc_enum cs48l32_isrc_fsh[] = {static const struct soc_enum cs48l32_isrc_fsl[] = {static const struct soc_enum cs48l32_fx_rate =static const char * const cs48l32_lhpf_mode_text[] = {"Low-pass" , "High-pass" static const struct soc_enum cs48l32_lhpf_mode[] = {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);if (abs(val) > CS48L32_LHPF_MAX_COEFF) {"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[] = {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;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;if (cs48l32_codec->eq_mode[e->shift_l] != val) {true ;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;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;unsigned int coeff_idx;int block_idx;int ) params->block_base - (int ) CS48L32_EQ1_BAND1_COEFF1);/* High __be16 is in [coeff_idx] and low __be16 in [coeff_idx + 1] */ if (params->shift == 0)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;unsigned int coeff_idx;int block_idx;int ) params->block_base - (int ) CS48L32_EQ1_BAND1_COEFF1);/* Put high __be16 in [coeff_idx] and low __be16 in [coeff_idx + 1] */ if (params->shift == 0)return 0;static const struct snd_kcontrol_new cs48l32_drc_activity_output_mux[] = {"Switch" , SND_SOC_NOPM, 0, 1, 0),"Switch" , SND_SOC_NOPM, 0, 1, 0),static const struct snd_kcontrol_new cs48l32_dsp_trigger_output_mux[] = {"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;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;if (cs48l32_codec->dsp_dma_rates[rate_num] != val) {true ;return changed;static const struct soc_enum cs48l32_dsp_rate_enum[] = {/* RX rates */ /* TX rates */ 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;for (i = 0; i < CS48L32_DSP_N_RX_CHANNELS; ++i) {for (i = 0; i < CS48L32_DSP_N_TX_CHANNELS; ++i) {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) {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) {if (ret)goto err;return ;"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) {if (ret)goto err;/* power-up the banks in sequence */ for (i = 0; i < regs->n_pwd; ++i) {if (ret)goto err;/* allow bank to power-up */ if (ret)goto err;/* allow bank to power-up */ return 0;"Failed to write SRAM enables (%d)\n" , ret);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;if (ret) {"Failed to read #%x: %d\n" , freq_reg, ret);return ret;if (freqsel_reg) {if (ret) {"Failed to read #%x: %d\n" , freqsel_reg, ret);return ret;if (freq_sts != freq_sel) {"SYSCLK FREQ (#%x) != FREQ STS (#%x)\n" ,return -ETIMEDOUT;if (ret) {"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[] = {struct cs48l32_codec *cs48l32_codec = data;struct regmap *regmap = cs48l32_codec->core.regmap;unsigned int eint_pending;int i, ret;if (ret) {"irq could not get pm runtime: %d\n" , ret);return IRQ_NONE;if (ret) {"Read IRQ1_STATUS failed: %d\n" , ret);return IRQ_NONE;if ((eint_pending & CS48L32_IRQ1_STS_MASK) == 0)goto out;if (ret) {"Read IRQ regs failed: %d\n" , ret);return IRQ_NONE;for (i = 0; i < ARRAY_SIZE(reg_vals); i += 2) {if (reg_vals[0] & CS48L32_DSP1_IRQ0_EINT1_MASK)if (reg_vals[2] & CS48L32_DSP1_MPU_ERR_EINT1_MASK) {"MPU err IRQ\n" );if (reg_vals[2] & CS48L32_DSP1_WDT_EXPIRE_EINT1_MASK) {"WDT expire IRQ\n" );return result;static int cs48l32_get_dspclk_setting(struct cs48l32_codec *cs48l32_codec, unsigned int freq,int src, unsigned int *val)/* convert to 1/64ths of 1MHz */ 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:break ;default :"Invalid PDM FLLCLK src %d\n" , source);return -EINVAL;return regmap_update_bits(regmap, CS48L32_INPUT_CONTROL2,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:"SYSCLK" ;break ;case CS48L32_CLK_DSPCLK:"DSPCLK" ;break ;case CS48L32_CLK_PDM_FLLCLK:return cs48l32_set_pdm_fllclk(component, source);default :return -EINVAL;if (clk_freq_sel < 0) {"Failed to get %s setting for %dHZ\n" , name, freq);return clk_freq_sel;if (freq == 0) {"%s cleared\n" , name);return 0;if (freq % 6144000)"%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;if (ret != 0) {"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;"Waiting for FLL...\n" );for (i = 0; i < 30; i++) {if (!!(val & fll->sts_mask) == requested)return 0;switch (i) {case 0 ... 5:break ;case 6 ... 20:break ;default :break ;"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;"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. 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 if (change)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;"fin=%d, fout=%d\n" , fin, fll->fout);for (refdiv = 0; refdiv < 4; refdiv++) {if ((fin / (1 << refdiv)) <= CS48L32_FLLHJ_MAX_THRESH)break ;/* * Use simple heuristic approach to find a configuration that * should work for most input clocks. if (fref < CS48L32_FLLHJ_LOW_THRESH) {if (frac)else else if (fref < CS48L32_FLLHJ_MID_THRESH) {else {/* Use high performance mode for fractional configurations. */ if (frac) {else {if (fref < CS48L32_FLLHJ_LP_INT_MODE_THRESH)else "refdiv=%d, fref=%d, frac:%d\n" , refdiv, fref, frac);while (ratio / fbdiv < min_n) {if (fbdiv < min_n) {"FBDIV (%u) < minimum N (%u)\n" , fbdiv, min_n);return -EINVAL;while (frac && (ratio / fbdiv > max_n)) {if (fbdiv >= 1024) {"FBDIV (%u) >= 1024\n" , fbdiv);return -EINVAL;"lockdet=%d, hp=#%x, fbdiv:%d\n" , lockdet_thr, hp, fbdiv);/* Calculate N.K values */ "fll_n=%d, gcd=%d, theta=%d, lambda=%d\n" ,/* Some sanity checks before any registers are written. */ if (fll_n < min_n || fll_n > max_n) {"N not in valid %s mode range %d-%d: %d\n" ,"fractional" : "integer" , min_n, max_n, fll_n);return -EINVAL;if (fbdiv < 1 || (frac && fbdiv >= 1024) || (!frac && fbdiv >= 256)) {"Invalid fbdiv for %s mode (%u)\n" ,"fractional" : "integer" , fbdiv);return -EINVAL;/* clear the ctrl_upd bit to guarantee we write to it later. */ 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)"Enabling FLL, initially %s\n" ,/* FLLn_HOLD must be set before configuring any registers */ /* Apply refclk */ if (ret) {"Failed to set FLL: %d\n" , ret);goto out;/* Release the hold so that flln locks to external frequency */ if (!already_enabled)true );return 0;static int cs48l32_fllhj_validate(struct cs48l32_fll *fll,unsigned int ref_in,unsigned int fout)if (fout && !ref_in) {"fllout set without valid input clk\n" );return -EINVAL;if (fll->fout && fout != fll->fout) {"Can't change output on active FLL\n" );return -EINVAL;if (ref_in / CS48L32_FLL_MAX_REFDIV > CS48L32_FLLHJ_MAX_THRESH) {"Can't scale %dMHz to <=13MHz\n" , ref_in);return -EINVAL;if (fout > CS48L32_FLL_MAX_FOUT) {"Fout=%dMHz exceeds maximum %dMHz\n" ,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;if (fout)else return ret;static int cs48l32_init_fll(struct cs48l32_fll *fll)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:break ;case 2:break ;default :return -EINVAL;for (last_pin_reg = pin_reg + 12; pin_reg <= last_pin_reg; ++pin_reg)/* DOUT high-impendance when not transmitting */ 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 |switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {case SND_SOC_DAIFMT_DSP_A:break ;case SND_SOC_DAIFMT_DSP_B:if ((fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) != SND_SOC_DAIFMT_BP_FP) {"DSP_B cannot be clock consumer\n" );return -EINVAL;break ;case SND_SOC_DAIFMT_I2S:break ;case SND_SOC_DAIFMT_LEFT_J:if ((fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) != SND_SOC_DAIFMT_BP_FP) {"LEFT_J cannot be clock consumer\n" );return -EINVAL;break ;default :"Unsupported DAI format %d\n" ,return -EINVAL;switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {case SND_SOC_DAIFMT_BC_FC:break ;case SND_SOC_DAIFMT_BC_FP:break ;case SND_SOC_DAIFMT_BP_FC:break ;case SND_SOC_DAIFMT_BP_FP:break ;default :"Unsupported clock direction %d\n" ,return -EINVAL;switch (fmt & SND_SOC_DAIFMT_INV_MASK) {case SND_SOC_DAIFMT_NB_NF:break ;case SND_SOC_DAIFMT_IB_IF:break ;case SND_SOC_DAIFMT_IB_NF:break ;case SND_SOC_DAIFMT_NB_IF:break ;default :return -EINVAL;return 0;static const struct {#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[] = {/* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_44K1_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ /* CS48L32_48K_RATE_MASK */ static const struct snd_pcm_hw_constraint_list cs48l32_constraint = {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:break ;default :return 0;if (base_rate == 0)else if (base_rate % 4000)else return snd_pcm_hw_constraint_list(substream->runtime, 0,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;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)) {"Unsupported sample rate %dHz\n" , rate);return -EINVAL;switch (dai_priv->clk) {case CS48L32_CLK_SYSCLK_1:break ;case CS48L32_CLK_SYSCLK_2:break ;case CS48L32_CLK_SYSCLK_3:break ;case CS48L32_CLK_SYSCLK_4:break ;default :return -EINVAL;);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;if (sclk != (val & CS48L32_ASP_BCLK_FREQ_MASK))return true ;if (slotws != (val & (CS48L32_ASP_RX_WIDTH_MASK | CS48L32_ASP_TX_WIDTH_MASK)))return true ;if (dataw != (val & (CS48L32_ASP_TX_WL_MASK)))return true ;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;"hwparams in: ch:%u dataw:%u rate:%u\n" ,/* * The following calculations hold only under the assumption that * symmetric_[rates|channels|samplebits] are set to 1 if (cs48l32_codec->tdm_slots[dai_id]) {else {if (val == CS48L32_ASP_FMT_I2S_MODE)else if (sclk_target < 0) {"Invalid parameters\n" );return sclk_target;for (i = 0; i < ARRAY_SIZE(cs48l32_sclk_rates); i++) {if ((cs48l32_sclk_rates[i].freq >= sclk_target) &&break ;if (i == ARRAY_SIZE(cs48l32_sclk_rates)) {"Unsupported sample rate %dHz\n" , rate);return -EINVAL;"hwparams out: n_slots:%u dataw:%u slotw:%u bclk:%u bclkid:%u\n" ,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 */ if (ret != 0)goto restore_asp;/* Restore ASP TX/RX enable 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)) {"Can't change clock on active DAI\n" );return -EBUSY;switch (clk_id) {case CS48L32_CLK_SYSCLK_1:break ;case CS48L32_CLK_SYSCLK_2:break ;case CS48L32_CLK_SYSCLK_3:break ;case CS48L32_CLK_SYSCLK_4:break ;default :return -EINVAL;"Setting to %s\n" , cs48l32_dai_clk_str(clk_id));if (base) {if (ret != 0) {"Failed to check rate: %d\n" , ret);return ret;if ((current_asp_rate & CS48L32_ASP_RATE_MASK) !=true ;/* Guard the rate change with SYSCLK cycles */ if (change_rate_domain) {return 0;static void cs48l32_set_channels_to_mask(struct snd_soc_dai *dai,unsigned int base,
Messung V0.5 C=95 H=95 G=94
¤ Dauer der Verarbeitung: 0.22 Sekunden
(vorverarbeitet)
¤ *© Formatika GbR, Deutschland
