ASoC: Ensure we get an impedence reported for WM8958 jack detect
Occasionally we may see an accessory reported before we have a stable impedance for the accessory. If this happens then reread the status in order to ensure that the handler can take the appropriate action for the status change. Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
@@ -1962,6 +1962,21 @@
|
|||||||
#define WM8958_MICB2_DISCH_SHIFT 0 /* MICB2_DISCH */
|
#define WM8958_MICB2_DISCH_SHIFT 0 /* MICB2_DISCH */
|
||||||
#define WM8958_MICB2_DISCH_WIDTH 1 /* MICB2_DISCH */
|
#define WM8958_MICB2_DISCH_WIDTH 1 /* MICB2_DISCH */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* R210 (0xD2) - Mic Detect 3
|
||||||
|
*/
|
||||||
|
#define WM8958_MICD_LVL_MASK 0x07FC /* MICD_LVL - [10:2] */
|
||||||
|
#define WM8958_MICD_LVL_SHIFT 2 /* MICD_LVL - [10:2] */
|
||||||
|
#define WM8958_MICD_LVL_WIDTH 9 /* MICD_LVL - [10:2] */
|
||||||
|
#define WM8958_MICD_VALID 0x0002 /* MICD_VALID */
|
||||||
|
#define WM8958_MICD_VALID_MASK 0x0002 /* MICD_VALID */
|
||||||
|
#define WM8958_MICD_VALID_SHIFT 1 /* MICD_VALID */
|
||||||
|
#define WM8958_MICD_VALID_WIDTH 1 /* MICD_VALID */
|
||||||
|
#define WM8958_MICD_STS 0x0001 /* MICD_STS */
|
||||||
|
#define WM8958_MICD_STS_MASK 0x0001 /* MICD_STS */
|
||||||
|
#define WM8958_MICD_STS_SHIFT 0 /* MICD_STS */
|
||||||
|
#define WM8958_MICD_STS_WIDTH 1 /* MICD_STS */
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* R76 (0x4C) - Charge Pump (1)
|
* R76 (0x4C) - Charge Pump (1)
|
||||||
*/
|
*/
|
||||||
|
@@ -3030,19 +3030,34 @@ static irqreturn_t wm8958_mic_irq(int irq, void *data)
|
|||||||
{
|
{
|
||||||
struct wm8994_priv *wm8994 = data;
|
struct wm8994_priv *wm8994 = data;
|
||||||
struct snd_soc_codec *codec = wm8994->codec;
|
struct snd_soc_codec *codec = wm8994->codec;
|
||||||
int reg;
|
int reg, count;
|
||||||
|
|
||||||
reg = snd_soc_read(codec, WM8958_MIC_DETECT_3);
|
/* We may occasionally read a detection without an impedence
|
||||||
if (reg < 0) {
|
* range being provided - if that happens loop again.
|
||||||
dev_err(codec->dev, "Failed to read mic detect status: %d\n",
|
*/
|
||||||
reg);
|
count = 10;
|
||||||
return IRQ_NONE;
|
do {
|
||||||
}
|
reg = snd_soc_read(codec, WM8958_MIC_DETECT_3);
|
||||||
|
if (reg < 0) {
|
||||||
|
dev_err(codec->dev,
|
||||||
|
"Failed to read mic detect status: %d\n",
|
||||||
|
reg);
|
||||||
|
return IRQ_NONE;
|
||||||
|
}
|
||||||
|
|
||||||
if (!(reg & WM8958_MICD_VALID)) {
|
if (!(reg & WM8958_MICD_VALID)) {
|
||||||
dev_dbg(codec->dev, "Mic detect data not valid\n");
|
dev_dbg(codec->dev, "Mic detect data not valid\n");
|
||||||
goto out;
|
goto out;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (!(reg & WM8958_MICD_STS) || (reg & WM8958_MICD_LVL_MASK))
|
||||||
|
break;
|
||||||
|
|
||||||
|
msleep(1);
|
||||||
|
} while (count--);
|
||||||
|
|
||||||
|
if (count == 0)
|
||||||
|
dev_warn(codec->dev, "No impedence range reported for jack\n");
|
||||||
|
|
||||||
#ifndef CONFIG_SND_SOC_WM8994_MODULE
|
#ifndef CONFIG_SND_SOC_WM8994_MODULE
|
||||||
trace_snd_soc_jack_irq(dev_name(codec->dev));
|
trace_snd_soc_jack_irq(dev_name(codec->dev));
|
||||||
|
Reference in New Issue
Block a user