samsung-sm8650/android_kernel_samsung_sm8650-modules
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

asoc: enable pdm_wd irq when needed

Browse Source 
Enable pdm_wd irq to report rx status.

Change-Id: I8427b136b29e87b653d4f506bae519b91752ad29
Signed-off-by: Yuhui Zhao <quic_yuhuzhao@quicinc.com>
This commit is contained in:
Yuhui Zhao
2024-04-08 18:42:58 +08:00
parent 5c9937f7ac
commit 5a30d22311
1 changed files with 47 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

53
asoc/codecs/wcd9378/wcd9378.c
View File

@@ -1498,11 +1498,6 @@ static int wcd9378_codec_hphl_dac_event(struct snd_soc_dapm_widget *w,
WCD9378_CDC_COMP_CTL_0_HPHL_COMP_EN_MASK, 0x02); WCD9378_CDC_COMP_CTL_0_HPHL_COMP_EN_MASK, 0x02);
wcd9378_rx_connect_port(component, COMP_L, true); wcd9378_rx_connect_port(component, COMP_L, true);
} }
if (wcd9378->update_wcd_event)
wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX1 << 0x10));
break; break;
case SND_SOC_DAPM_POST_PMD: case SND_SOC_DAPM_POST_PMD:
/*HPHL DISABLE*/ /*HPHL DISABLE*/
@@ -1595,6 +1590,8 @@ static int wcd9378_codec_enable_hphl_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX1 << 0x10)); (WCD_RX1 << 0x10));
wcd_enable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHL_PDM_WD_INT);
act_ps = snd_soc_component_read(component, WCD9378_PDE47_ACT_PS); act_ps = snd_soc_component_read(component, WCD9378_PDE47_ACT_PS);
if (act_ps) if (act_ps)
@@ -1609,6 +1606,8 @@ static int wcd9378_codec_enable_hphl_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX1 << 0x10 | 0x1)); (WCD_RX1 << 0x10 | 0x1));
wcd_disable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHL_PDM_WD_INT);
if (wcd9378->update_wcd_event && wcd9378->comp1_enable) if (wcd9378->update_wcd_event && wcd9378->comp1_enable)
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
@@ -1649,6 +1648,8 @@ static int wcd9378_codec_enable_hphr_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX2 << 0x10)); (WCD_RX2 << 0x10));
wcd_enable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHR_PDM_WD_INT);
act_ps = snd_soc_component_read(component, WCD9378_PDE47_ACT_PS); act_ps = snd_soc_component_read(component, WCD9378_PDE47_ACT_PS);
if (act_ps) if (act_ps)
@@ -1663,6 +1664,8 @@ static int wcd9378_codec_enable_hphr_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX2 << 0x10 | 0x1)); (WCD_RX2 << 0x10 | 0x1));
wcd_disable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHR_PDM_WD_INT);
if (wcd9378->update_wcd_event && wcd9378->comp2_enable) if (wcd9378->update_wcd_event && wcd9378->comp2_enable)
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
@@ -1713,12 +1716,15 @@ static int wcd9378_codec_enable_aux_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX2 << 0x10)); (WCD_RX2 << 0x10));
wcd_enable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHR_PDM_WD_INT);
} else { } else {
if (wcd9378->update_wcd_event) if (wcd9378->update_wcd_event)
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX3 << 0x10)); (WCD_RX3 << 0x10));
wcd_enable_irq(&wcd9378->irq_info,
WCD9378_IRQ_AUX_PDM_WD_INT);
} }
act_ps = snd_soc_component_read(component, WCD9378_PDE23_ACT_PS); act_ps = snd_soc_component_read(component, WCD9378_PDE23_ACT_PS);
@@ -1735,11 +1741,15 @@ static int wcd9378_codec_enable_aux_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX2 << 0x10 | 0x1)); (WCD_RX2 << 0x10 | 0x1));
wcd_disable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHR_PDM_WD_INT);
} else { } else {
if (wcd9378->update_wcd_event) if (wcd9378->update_wcd_event)
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX3 << 0x10 | 0x1)); (WCD_RX3 << 0x10 | 0x1));
wcd_disable_irq(&wcd9378->irq_info,
WCD9378_IRQ_AUX_PDM_WD_INT);
} }
break; break;
}; };
@@ -1777,11 +1787,16 @@ static int wcd9378_codec_enable_ear_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX1 << 0x10)); (WCD_RX1 << 0x10));
wcd_enable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHL_PDM_WD_INT);
} else { } else {
if (wcd9378->update_wcd_event) if (wcd9378->update_wcd_event)
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX3 << 0x10)); (WCD_RX3 << 0x10));
wcd_enable_irq(&wcd9378->irq_info,
WCD9378_IRQ_AUX_PDM_WD_INT);
} }
act_ps = snd_soc_component_read(component, WCD9378_PDE23_ACT_PS); act_ps = snd_soc_component_read(component, WCD9378_PDE23_ACT_PS);
@@ -1799,11 +1814,15 @@ static int wcd9378_codec_enable_ear_pa(struct snd_soc_dapm_widget *w,
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX1 << 0x10 | 0x1)); (WCD_RX1 << 0x10 | 0x1));
wcd_disable_irq(&wcd9378->irq_info,
WCD9378_IRQ_HPHL_PDM_WD_INT);
} else { } else {
if (wcd9378->update_wcd_event) if (wcd9378->update_wcd_event)
wcd9378->update_wcd_event(wcd9378->handle, wcd9378->update_wcd_event(wcd9378->handle,
SLV_BOLERO_EVT_RX_MUTE, SLV_BOLERO_EVT_RX_MUTE,
(WCD_RX3 << 0x10 | 0x1)); (WCD_RX3 << 0x10 | 0x1));
wcd_disable_irq(&wcd9378->irq_info,
WCD9378_IRQ_AUX_PDM_WD_INT);
} }
break; break;
}; };
@@ -4190,6 +4209,13 @@ static struct snd_soc_dai_driver wcd9378_dai[] = {
}, },
}; };
static irqreturn_t wcd9378_wd_handle_irq(int irq, void *data)
{
pr_err_ratelimited("%s: Watchdog interrupt for irq =%d triggered\n",
__func__, irq);
return IRQ_HANDLED;
}
static int wcd9378_bind(struct device *dev) static int wcd9378_bind(struct device *dev)
{ {
int ret = 0; int ret = 0;
@@ -4259,6 +4285,18 @@ static int wcd9378_bind(struct device *dev)
__func__); __func__);
wcd9378->tx_swr_dev->slave_irq = wcd9378->virq; wcd9378->tx_swr_dev->slave_irq = wcd9378->virq;
/* Request for watchdog interrupt */
wcd_request_irq(&wcd9378->irq_info, WCD9378_IRQ_HPHR_PDM_WD_INT,
"HPHR PDM WD INT", wcd9378_wd_handle_irq, NULL);
wcd_request_irq(&wcd9378->irq_info, WCD9378_IRQ_HPHL_PDM_WD_INT,
"HPHL PDM WD INT", wcd9378_wd_handle_irq, NULL);
wcd_request_irq(&wcd9378->irq_info, WCD9378_IRQ_AUX_PDM_WD_INT,
"AUX PDM WD INT", wcd9378_wd_handle_irq, NULL);
/* Disable watchdog interrupt for HPH and AUX */
wcd_disable_irq(&wcd9378->irq_info, WCD9378_IRQ_HPHR_PDM_WD_INT);
wcd_disable_irq(&wcd9378->irq_info, WCD9378_IRQ_HPHL_PDM_WD_INT);
wcd_disable_irq(&wcd9378->irq_info, WCD9378_IRQ_AUX_PDM_WD_INT);
ret = snd_soc_register_component(dev, &soc_codec_dev_wcd9378, ret = snd_soc_register_component(dev, &soc_codec_dev_wcd9378,
wcd9378_dai, ARRAY_SIZE(wcd9378_dai)); wcd9378_dai, ARRAY_SIZE(wcd9378_dai));
if (ret) { if (ret) {
@@ -4280,6 +4318,9 @@ static void wcd9378_unbind(struct device *dev)
{ {
struct wcd9378_priv *wcd9378 = dev_get_drvdata(dev); struct wcd9378_priv *wcd9378 = dev_get_drvdata(dev);
wcd_free_irq(&wcd9378->irq_info, WCD9378_IRQ_HPHR_PDM_WD_INT, NULL);
wcd_free_irq(&wcd9378->irq_info, WCD9378_IRQ_HPHL_PDM_WD_INT, NULL);
wcd_free_irq(&wcd9378->irq_info, WCD9378_IRQ_AUX_PDM_WD_INT, NULL);
wcd_irq_exit(&wcd9378->irq_info, wcd9378->virq); wcd_irq_exit(&wcd9378->irq_info, wcd9378->virq);
snd_soc_unregister_component(dev); snd_soc_unregister_component(dev);
component_unbind_all(dev, wcd9378); component_unbind_all(dev, wcd9378);