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

Commit 6d3c26bc authored by Mark Brown's avatar Mark Brown
Browse files

ASoC: Use delayed work to debounce WM8350 jack IRQs 



This avoids blocking the IRQ thread and allows further bounces to extend
the debounce time.

Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
Acked-by: default avatarLiam Girdwood <lrg@slimlogic.co.uk>
parent 722bc283

sound/soc/codecs/wm8350.c

+43 −19
Original line number Diff line number Diff line
@@ -53,6 +53,7 @@ struct wm8350_output { 


struct wm8350_jack_data {

	struct snd_soc_jack *jack;

	struct delayed_work work;

	int report;

	int short_report;

};
@@ -1335,45 +1336,63 @@ static int wm8350_resume(struct snd_soc_codec *codec) 
	return 0;

}



static irqreturn_t wm8350_hp_jack_handler(int irq, void *data)

static void wm8350_hp_work(struct wm8350_data *priv,

			   struct wm8350_jack_data *jack,

			   u16 mask)

{

	struct wm8350_data *priv = data;

	struct wm8350 *wm8350 = priv->codec.control_data;

	u16 reg;

	int report;

	int mask;



	reg = wm8350_reg_read(wm8350, WM8350_JACK_PIN_STATUS);

	if (reg & mask)

		report = jack->report;

	else

		report = 0;



	snd_soc_jack_report(jack->jack, report, jack->report);



}



static void wm8350_hpl_work(struct work_struct *work)

{

	struct wm8350_data *priv =

	    container_of(work, struct wm8350_data, hpl.work.work);



	wm8350_hp_work(priv, &priv->hpl, WM8350_JACK_L_LVL);

}



static void wm8350_hpr_work(struct work_struct *work)

{

	struct wm8350_data *priv =

	    container_of(work, struct wm8350_data, hpr.work.work);

	

	wm8350_hp_work(priv, &priv->hpr, WM8350_JACK_R_LVL);

}



static irqreturn_t wm8350_hp_jack_handler(int irq, void *data)

{

	struct wm8350_data *priv = data;

	struct wm8350 *wm8350 = priv->codec.control_data;

	struct wm8350_jack_data *jack = NULL;



	switch (irq - wm8350->irq_base) {

	case WM8350_IRQ_CODEC_JCK_DET_L:

		jack = &priv->hpl;

		mask = WM8350_JACK_L_LVL;

		break;



	case WM8350_IRQ_CODEC_JCK_DET_R:

		jack = &priv->hpr;

		mask = WM8350_JACK_R_LVL;

		break;



	default:

		BUG();

	}



	if (!jack->jack) {

		dev_warn(wm8350->dev, "Jack interrupt called with no jack\n");

		return IRQ_NONE;

	}

	if (device_may_wakeup(wm8350->dev))

		pm_wakeup_event(wm8350->dev, 250);



	/* Debounce */

	msleep(200);



	reg = wm8350_reg_read(wm8350, WM8350_JACK_PIN_STATUS);

	if (reg & mask)

		report = jack->report;

	else

		report = 0;



	snd_soc_jack_report(jack->jack, report, jack->report);

	schedule_delayed_work(&jack->work, 200);



	return IRQ_HANDLED;

}
@@ -1552,6 +1571,8 @@ static int wm8350_codec_probe(struct snd_soc_codec *codec) 
	wm8350_clear_bits(wm8350, WM8350_POWER_MGMT_5, WM8350_CODEC_ENA);



	INIT_DELAYED_WORK(&codec->dapm.delayed_work, wm8350_pga_work);

	INIT_DELAYED_WORK(&priv->hpl.work, wm8350_hpl_work);

	INIT_DELAYED_WORK(&priv->hpr.work, wm8350_hpr_work);



	/* Enable the codec */

	wm8350_set_bits(wm8350, WM8350_POWER_MGMT_5, WM8350_CODEC_ENA);
@@ -1641,6 +1662,9 @@ static int wm8350_codec_remove(struct snd_soc_codec *codec) 
	priv->hpr.jack = NULL;

	priv->mic.jack = NULL;



	cancel_delayed_work_sync(&priv->hpl.work);

	cancel_delayed_work_sync(&priv->hpr.work);



	/* if there was any work waiting then we run it now and

	 * wait for its completion */

	flush_delayed_work_sync(&codec->dapm.delayed_work);