Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit beccfad9 authored by Vatsal Bucha's avatar Vatsal Bucha Committed by Meng Wang
Browse files

ASoC: wcd937x: Enable watchdog interrupt 



Handle PDM watchdog interrupt. Enable watchdog
before analog PA is enabled and disable it
after analog PA is disabled so as to prevent false alarms.

CRs-Fixed: 2336526
Change-Id: I3c16a9dcd0f4f84bf8ad0bfde9560330c143cdf9
Signed-off-by: default avatarVatsal Bucha <vbucha@codeaurora.org>
parent 63f48155

asoc/codecs/wcd937x/internal.h

+2 −1
Original line number Diff line number Diff line 
/* SPDX-License-Identifier: GPL-2.0-only */

/* Copyright (c) 2018, The Linux Foundation. All rights reserved.

/* Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.

 */



#ifndef _WCD937X_INTERNAL_H
@@ -82,6 +82,7 @@ struct wcd937x_priv { 
	/* Entry for version info */

	struct snd_info_entry *entry;

	struct snd_info_entry *version_entry;

	int ear_rx_path;

};



struct wcd937x_micbias_setting {

asoc/codecs/wcd937x/wcd937x.c

+61 −3
Original line number Diff line number Diff line 
// SPDX-License-Identifier: GPL-2.0-only

/*

 * Copyright (c) 2018, The Linux Foundation. All rights reserved.

 * Copyright (c) 2018-2019, The Linux Foundation. All rights reserved.

 */



#include <linux/module.h>
@@ -34,6 +34,7 @@ 


#define WCD937X_VERSION_1_0 1

#define WCD937X_VERSION_ENTRY_SIZE 32

#define EAR_RX_PATH_AUX 1



enum {

	CODEC_TX = 0,
@@ -653,6 +654,11 @@ static int wcd937x_codec_enable_hphr_pa(struct snd_soc_dapm_widget *w, 
					0x10, 0x10);

		usleep_range(100, 110);

		set_bit(HPH_PA_DELAY, &wcd937x->status_mask);

		ret = swr_slvdev_datapath_control(wcd937x->rx_swr_dev,

					    wcd937x->rx_swr_dev->dev_num,

					    true);

		snd_soc_component_update_bits(component,

				WCD937X_DIGITAL_PDM_WD_CTL1, 0x17, 0x13);

		break;

	case SND_SOC_DAPM_POST_PMU:

		/*
@@ -691,6 +697,8 @@ static int wcd937x_codec_enable_hphr_pa(struct snd_soc_dapm_widget *w, 
		break;

	case SND_SOC_DAPM_POST_PMD:

		usleep_range(7000, 7010);

		snd_soc_component_update_bits(component,

				WCD937X_DIGITAL_PDM_WD_CTL1, 0x17, 0x00);

		blocking_notifier_call_chain(&wcd937x->mbhc->notifier,

					     WCD_EVENT_POST_HPHR_PA_OFF,

					     &wcd937x->mbhc->wcd_mbhc);
@@ -731,6 +739,8 @@ static int wcd937x_codec_enable_hphl_pa(struct snd_soc_dapm_widget *w, 
				0x20, 0x20);

		usleep_range(100, 110);

		set_bit(HPH_PA_DELAY, &wcd937x->status_mask);

		snd_soc_component_update_bits(component,

				WCD937X_DIGITAL_PDM_WD_CTL0, 0x17, 0x13);

		break;

	case SND_SOC_DAPM_POST_PMU:

		/*
@@ -769,6 +779,8 @@ static int wcd937x_codec_enable_hphl_pa(struct snd_soc_dapm_widget *w, 
		break;

	case SND_SOC_DAPM_POST_PMD:

		usleep_range(7000, 7010);

		snd_soc_component_update_bits(component,

				WCD937X_DIGITAL_PDM_WD_CTL0, 0x17, 0x00);

		blocking_notifier_call_chain(&wcd937x->mbhc->notifier,

					     WCD_EVENT_POST_HPHL_PA_OFF,

					     &wcd937x->mbhc->wcd_mbhc);
@@ -801,6 +813,8 @@ static int wcd937x_codec_enable_aux_pa(struct snd_soc_dapm_widget *w, 
		ret = swr_slvdev_datapath_control(wcd937x->rx_swr_dev,

			    wcd937x->rx_swr_dev->dev_num,

			    true);

		snd_soc_component_update_bits(component,

				WCD937X_DIGITAL_PDM_WD_CTL2, 0x05, 0x05);

		break;

	case SND_SOC_DAPM_POST_PMU:

		usleep_range(1000, 1010);
@@ -820,12 +834,14 @@ static int wcd937x_codec_enable_aux_pa(struct snd_soc_dapm_widget *w, 
						(WCD_RX3 << 0x10 | 0x1));

		break;

	case SND_SOC_DAPM_POST_PMD:

		usleep_range(1000, 1010);

		usleep_range(1000, 1010);

		/* Add delay as per hw requirement */

		usleep_range(2000, 2010);

		wcd_cls_h_fsm(component, &wcd937x->clsh_info,

			     WCD_CLSH_EVENT_POST_PA,

			     WCD_CLSH_STATE_AUX,

			     hph_mode);

		snd_soc_component_update_bits(component,

				WCD937X_DIGITAL_PDM_WD_CTL2, 0x05, 0x00);

		break;

	};

	return ret;
@@ -849,6 +865,21 @@ static int wcd937x_codec_enable_ear_pa(struct snd_soc_dapm_widget *w, 
		ret = swr_slvdev_datapath_control(wcd937x->rx_swr_dev,

			    wcd937x->rx_swr_dev->dev_num,

			    true);

		/*

		 * Enable watchdog interrupt for HPHL or AUX

		 * depending on mux value

		 */

		wcd937x->ear_rx_path =

			snd_soc_component_read32(

				component, WCD937X_DIGITAL_CDC_EAR_PATH_CTL);

		if (wcd937x->ear_rx_path & EAR_RX_PATH_AUX)

			snd_soc_component_update_bits(component,

					WCD937X_DIGITAL_PDM_WD_CTL2,

					0x05, 0x05);

		else

			snd_soc_component_update_bits(component,

					WCD937X_DIGITAL_PDM_WD_CTL0,

					0x17, 0x13);

		break;

	case SND_SOC_DAPM_POST_PMU:

		usleep_range(6000, 6010);
@@ -873,6 +904,14 @@ static int wcd937x_codec_enable_ear_pa(struct snd_soc_dapm_widget *w, 
			     WCD_CLSH_EVENT_POST_PA,

			     WCD_CLSH_STATE_EAR,

			     hph_mode);

		if (wcd937x->ear_rx_path & EAR_RX_PATH_AUX)

			snd_soc_component_update_bits(component,

					WCD937X_DIGITAL_PDM_WD_CTL2,

					0x05, 0x00);

		else

			snd_soc_component_update_bits(component,

					WCD937X_DIGITAL_PDM_WD_CTL0,

					0x17, 0x00);

		break;

	};

	return ret;
@@ -2445,6 +2484,13 @@ static int wcd937x_wakeup(void *handle, bool enable) 
		return swr_device_wakeup_unvote(priv->tx_swr_dev);

}



static irqreturn_t wcd937x_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 wcd937x_bind(struct device *dev)

{

	int ret = 0, i = 0;
@@ -2575,6 +2621,18 @@ static int wcd937x_bind(struct device *dev) 
	wcd937x->tx_swr_dev->slave_irq = wcd937x->virq;



	mutex_init(&wcd937x->micb_lock);

	/* Request for watchdog interrupt */

	wcd_request_irq(&wcd937x->irq_info, WCD937X_IRQ_HPHR_PDM_WD_INT,

			"HPHR PDM WD INT", wcd937x_wd_handle_irq, NULL);

	wcd_request_irq(&wcd937x->irq_info, WCD937X_IRQ_HPHL_PDM_WD_INT,

			"HPHL PDM WD INT", wcd937x_wd_handle_irq, NULL);

	wcd_request_irq(&wcd937x->irq_info, WCD937X_IRQ_AUX_PDM_WD_INT,

			"AUX PDM WD INT", wcd937x_wd_handle_irq, NULL);

	/* Enable watchdog interrupt for HPH and AUX */

	wcd_enable_irq(&wcd937x->irq_info, WCD937X_IRQ_HPHR_PDM_WD_INT);

	wcd_enable_irq(&wcd937x->irq_info, WCD937X_IRQ_HPHL_PDM_WD_INT);

	wcd_enable_irq(&wcd937x->irq_info, WCD937X_IRQ_AUX_PDM_WD_INT);



	ret = snd_soc_register_component(dev, &soc_codec_dev_wcd937x,

				     NULL, 0);

	if (ret) {