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: Mark Brown <broonie@opensource.wolfsonmicro.com> Acked-by: Liam Girdwood <lrg@slimlogic.co.uk>
This commit is contained in:
		
					parent
					
						
							
								722bc28384
							
						
					
				
			
			
				commit
				
					
						6d3c26bcb7
					
				
			
		
					 1 changed files with 51 additions and 27 deletions
				
			
		| 
						 | 
				
			
			@ -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,37 +1336,13 @@ 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;
 | 
			
		||||
	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;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	/* Debounce */
 | 
			
		||||
	msleep(200);
 | 
			
		||||
 | 
			
		||||
	reg = wm8350_reg_read(wm8350, WM8350_JACK_PIN_STATUS);
 | 
			
		||||
	if (reg & mask)
 | 
			
		||||
| 
						 | 
				
			
			@ -1375,6 +1352,48 @@ static irqreturn_t wm8350_hp_jack_handler(int irq, void *data)
 | 
			
		|||
 | 
			
		||||
	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;
 | 
			
		||||
		break;
 | 
			
		||||
 | 
			
		||||
	case WM8350_IRQ_CODEC_JCK_DET_R:
 | 
			
		||||
		jack = &priv->hpr;
 | 
			
		||||
		break;
 | 
			
		||||
 | 
			
		||||
	default:
 | 
			
		||||
		BUG();
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (device_may_wakeup(wm8350->dev))
 | 
			
		||||
		pm_wakeup_event(wm8350->dev, 250);
 | 
			
		||||
 | 
			
		||||
	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);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue