asoc: bolero: Update PCM_RATE based delay for amic

The PCM_RATE bit field in LPASS_TX_CDC_TXn_TX_PATH_CTL
ranges from 0 to 6.
In the current implementation of tx-macro, the value
read is mapped directly to the sample rate instead of
the indices. Change is to correct this.
Add the delay based on pcm_rate in va-macro as well.

Change-Id: I6cb7e58e71f2a25356608611f1dfed83171706f6
Signed-off-by: Soumya Managoli <smanag@codeaurora.org>
This commit is contained in:
Soumya Managoli
2021-02-10 17:42:05 +05:30
committed by Gerrit - the friendly Code Review server
parent f1b8ccfee3
commit afde3b3eb2
4 changed files with 76 additions and 22 deletions

View File

@@ -176,7 +176,7 @@ struct tx_macro_priv {
int bcs_ch; int bcs_ch;
bool bcs_clk_en; bool bcs_clk_en;
bool hs_slow_insert_complete; bool hs_slow_insert_complete;
int amic_sample_rate; int pcm_rate[NUM_DECIMATORS];
bool lpi_enable; bool lpi_enable;
bool register_event_listener; bool register_event_listener;
u16 current_clk_id; u16 current_clk_id;
@@ -545,23 +545,23 @@ static void tx_macro_tx_hpf_corner_freq_callback(struct work_struct *work)
snd_soc_component_update_bits(component, hpf_gate_reg, snd_soc_component_update_bits(component, hpf_gate_reg,
0x03, 0x02); 0x03, 0x02);
/* Add delay between toggle hpf gate based on sample rate */ /* Add delay between toggle hpf gate based on sample rate */
switch(tx_priv->amic_sample_rate) { switch (tx_priv->pcm_rate[hpf_work->decimator]) {
case 8000: case 0:
usleep_range(125, 130); usleep_range(125, 130);
break; break;
case 16000: case 1:
usleep_range(62, 65); usleep_range(62, 65);
break; break;
case 32000: case 3:
usleep_range(31, 32); usleep_range(31, 32);
break; break;
case 48000: case 4:
usleep_range(20, 21); usleep_range(20, 21);
break; break;
case 96000: case 5:
usleep_range(10, 11); usleep_range(10, 11);
break; break;
case 192000: case 6:
usleep_range(5, 6); usleep_range(5, 6);
break; break;
default: default:
@@ -1061,7 +1061,7 @@ static int tx_macro_enable_dec(struct snd_soc_dapm_widget *w,
tx_fs_reg = BOLERO_CDC_TX0_TX_PATH_CTL + tx_fs_reg = BOLERO_CDC_TX0_TX_PATH_CTL +
TX_MACRO_TX_PATH_OFFSET * decimator; TX_MACRO_TX_PATH_OFFSET * decimator;
tx_priv->amic_sample_rate = (snd_soc_component_read(component, tx_priv->pcm_rate[decimator] = (snd_soc_component_read(component,
tx_fs_reg) & 0x0F); tx_fs_reg) & 0x0F);
switch (event) { switch (event) {

View File

@@ -178,6 +178,7 @@ struct va_macro_priv {
bool clk_div_switch; bool clk_div_switch;
int dec_mode[VA_MACRO_NUM_DECIMATORS]; int dec_mode[VA_MACRO_NUM_DECIMATORS];
u16 current_clk_id; u16 current_clk_id;
int pcm_rate[VA_MACRO_NUM_DECIMATORS];
}; };
static bool va_macro_get_data(struct snd_soc_component *component, static bool va_macro_get_data(struct snd_soc_component *component,
@@ -895,8 +896,29 @@ static void va_macro_tx_hpf_corner_freq_callback(struct work_struct *work)
hpf_cut_off_freq << 5); hpf_cut_off_freq << 5);
snd_soc_component_update_bits(component, hpf_gate_reg, snd_soc_component_update_bits(component, hpf_gate_reg,
0x03, 0x02); 0x03, 0x02);
/* Minimum 1 clk cycle delay is required as per HW spec */ /* Add delay between toggle hpf gate based on sample rate */
usleep_range(1000, 1010); switch (va_priv->pcm_rate[hpf_work->decimator]) {
case 0:
usleep_range(125, 130);
break;
case 1:
usleep_range(62, 65);
break;
case 3:
usleep_range(31, 32);
break;
case 4:
usleep_range(20, 21);
break;
case 5:
usleep_range(10, 11);
break;
case 6:
usleep_range(5, 6);
break;
default:
usleep_range(125, 130);
}
snd_soc_component_update_bits(component, hpf_gate_reg, snd_soc_component_update_bits(component, hpf_gate_reg,
0x03, 0x01); 0x03, 0x01);
} else { } else {
@@ -1150,6 +1172,7 @@ static int va_macro_enable_dec(struct snd_soc_dapm_widget *w,
u16 tx_gain_ctl_reg; u16 tx_gain_ctl_reg;
u8 hpf_cut_off_freq; u8 hpf_cut_off_freq;
u16 adc_mux_reg = 0; u16 adc_mux_reg = 0;
u16 tx_fs_reg = 0;
struct device *va_dev = NULL; struct device *va_dev = NULL;
struct va_macro_priv *va_priv = NULL; struct va_macro_priv *va_priv = NULL;
int hpf_delay = BOLERO_CDC_VA_TX_DMIC_HPF_DELAY_MS; int hpf_delay = BOLERO_CDC_VA_TX_DMIC_HPF_DELAY_MS;
@@ -1173,6 +1196,10 @@ static int va_macro_enable_dec(struct snd_soc_dapm_widget *w,
VA_MACRO_TX_PATH_OFFSET * decimator; VA_MACRO_TX_PATH_OFFSET * decimator;
adc_mux_reg = BOLERO_CDC_VA_INP_MUX_ADC_MUX0_CFG1 + adc_mux_reg = BOLERO_CDC_VA_INP_MUX_ADC_MUX0_CFG1 +
VA_MACRO_ADC_MUX_CFG_OFFSET * decimator; VA_MACRO_ADC_MUX_CFG_OFFSET * decimator;
tx_fs_reg = BOLERO_CDC_VA_TX0_TX_PATH_CTL +
VA_MACRO_TX_PATH_OFFSET * decimator;
va_priv->pcm_rate[decimator] = (snd_soc_component_read(component,
tx_fs_reg) & 0x0F);
switch (event) { switch (event) {
case SND_SOC_DAPM_PRE_PMU: case SND_SOC_DAPM_PRE_PMU:

View File

@@ -144,7 +144,7 @@ struct lpass_cdc_tx_macro_priv {
int bcs_ch; int bcs_ch;
bool bcs_clk_en; bool bcs_clk_en;
bool hs_slow_insert_complete; bool hs_slow_insert_complete;
int amic_sample_rate; int pcm_rate[NUM_DECIMATORS];
}; };
static bool lpass_cdc_tx_macro_get_data(struct snd_soc_component *component, static bool lpass_cdc_tx_macro_get_data(struct snd_soc_component *component,
@@ -399,23 +399,23 @@ static void lpass_cdc_tx_macro_tx_hpf_corner_freq_callback(struct work_struct *w
snd_soc_component_update_bits(component, hpf_gate_reg, snd_soc_component_update_bits(component, hpf_gate_reg,
0x03, 0x02); 0x03, 0x02);
/* Add delay between toggle hpf gate based on sample rate */ /* Add delay between toggle hpf gate based on sample rate */
switch(tx_priv->amic_sample_rate) { switch (tx_priv->pcm_rate[hpf_work->decimator]) {
case 8000: case 0:
usleep_range(125, 130); usleep_range(125, 130);
break; break;
case 16000: case 1:
usleep_range(62, 65); usleep_range(62, 65);
break; break;
case 32000: case 3:
usleep_range(31, 32); usleep_range(31, 32);
break; break;
case 48000: case 4:
usleep_range(20, 21); usleep_range(20, 21);
break; break;
case 96000: case 5:
usleep_range(10, 11); usleep_range(10, 11);
break; break;
case 192000: case 6:
usleep_range(5, 6); usleep_range(5, 6);
break; break;
default: default:
@@ -877,7 +877,7 @@ static int lpass_cdc_tx_macro_enable_dec(struct snd_soc_dapm_widget *w,
tx_fs_reg = LPASS_CDC_TX0_TX_PATH_CTL + tx_fs_reg = LPASS_CDC_TX0_TX_PATH_CTL +
LPASS_CDC_TX_MACRO_TX_PATH_OFFSET * decimator; LPASS_CDC_TX_MACRO_TX_PATH_OFFSET * decimator;
tx_priv->amic_sample_rate = (snd_soc_component_read(component, tx_priv->pcm_rate[decimator] = (snd_soc_component_read(component,
tx_fs_reg) & 0x0F); tx_fs_reg) & 0x0F);
switch (event) { switch (event) {

View File

@@ -171,6 +171,7 @@ struct lpass_cdc_va_macro_priv {
bool lpi_enable; bool lpi_enable;
bool clk_div_switch; bool clk_div_switch;
int dec_mode[LPASS_CDC_VA_MACRO_NUM_DECIMATORS]; int dec_mode[LPASS_CDC_VA_MACRO_NUM_DECIMATORS];
int pcm_rate[LPASS_CDC_VA_MACRO_NUM_DECIMATORS];
}; };
static bool lpass_cdc_va_macro_get_data(struct snd_soc_component *component, static bool lpass_cdc_va_macro_get_data(struct snd_soc_component *component,
@@ -834,8 +835,29 @@ static void lpass_cdc_va_macro_tx_hpf_corner_freq_callback(
hpf_cut_off_freq << 5); hpf_cut_off_freq << 5);
snd_soc_component_update_bits(component, hpf_gate_reg, snd_soc_component_update_bits(component, hpf_gate_reg,
0x03, 0x02); 0x03, 0x02);
/* Minimum 1 clk cycle delay is required as per HW spec */ /* Add delay between toggle hpf gate based on sample rate */
usleep_range(1000, 1010); switch (va_priv->pcm_rate[hpf_work->decimator]) {
case 0:
usleep_range(125, 130);
break;
case 1:
usleep_range(62, 65);
break;
case 3:
usleep_range(31, 32);
break;
case 4:
usleep_range(20, 21);
break;
case 5:
usleep_range(10, 11);
break;
case 6:
usleep_range(5, 6);
break;
default:
usleep_range(125, 130);
}
snd_soc_component_update_bits(component, hpf_gate_reg, snd_soc_component_update_bits(component, hpf_gate_reg,
0x03, 0x01); 0x03, 0x01);
} else { } else {
@@ -1085,6 +1107,7 @@ static int lpass_cdc_va_macro_enable_dec(struct snd_soc_dapm_widget *w,
u16 tx_gain_ctl_reg; u16 tx_gain_ctl_reg;
u8 hpf_cut_off_freq; u8 hpf_cut_off_freq;
u16 adc_mux_reg = 0; u16 adc_mux_reg = 0;
u16 tx_fs_reg = 0;
struct device *va_dev = NULL; struct device *va_dev = NULL;
struct lpass_cdc_va_macro_priv *va_priv = NULL; struct lpass_cdc_va_macro_priv *va_priv = NULL;
int hpf_delay = LPASS_CDC_VA_TX_DMIC_HPF_DELAY_MS; int hpf_delay = LPASS_CDC_VA_TX_DMIC_HPF_DELAY_MS;
@@ -1109,6 +1132,10 @@ static int lpass_cdc_va_macro_enable_dec(struct snd_soc_dapm_widget *w,
LPASS_CDC_VA_MACRO_TX_PATH_OFFSET * decimator; LPASS_CDC_VA_MACRO_TX_PATH_OFFSET * decimator;
adc_mux_reg = LPASS_CDC_VA_INP_MUX_ADC_MUX0_CFG1 + adc_mux_reg = LPASS_CDC_VA_INP_MUX_ADC_MUX0_CFG1 +
LPASS_CDC_VA_MACRO_ADC_MUX_CFG_OFFSET * decimator; LPASS_CDC_VA_MACRO_ADC_MUX_CFG_OFFSET * decimator;
tx_fs_reg = LPASS_CDC_VA_TX0_TX_PATH_CTL +
LPASS_CDC_VA_MACRO_TX_PATH_OFFSET * decimator;
va_priv->pcm_rate[decimator] = (snd_soc_component_read(component,
tx_fs_reg) & 0x0F);
switch (event) { switch (event) {
case SND_SOC_DAPM_PRE_PMU: case SND_SOC_DAPM_PRE_PMU: