ASoC: Allow more WM8958/WM1811 button levels with default handler

The WM8958 and WM1811 support detecting a range of buttons. Allow the
user to provide platform data enabling more of these levels without
having to write a custom detection handler.

Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>

2 files changed, 35 insertions, 8 deletions

diff --git a/sound/soc/codecs/wm8994.c b/sound/soc/codecs/wm8994.c
index 45bfa09f2e45..3e52d40866d2 100644
--- a/sound/soc/codecs/wm8994.c
+++ b/sound/soc/codecs/wm8994.c
@@ -3043,6 +3043,7 @@ static void wm8958_default_micdet(u16 status, void *data)
 {
         struct snd_soc_codec *codec = data;
         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
+        int report;
 
         dev_dbg(codec->dev, "MICDET %x\n", status);
 
@@ -3055,7 +3056,7 @@ static void wm8958_default_micdet(u16 status, void *data)
                 wm8958_micd_set_rate(codec);
 
                 snd_soc_jack_report(wm8994->micdet[0].jack, 0,
-                                    SND_JACK_BTN_0 | SND_JACK_HEADSET);
+                                    wm8994->btn_mask | SND_JACK_HEADSET);
 
                 return;
         }
@@ -3088,12 +3089,27 @@ static void wm8958_default_micdet(u16 status, void *data)
 
         /* Report short circuit as a button */
         if (wm8994->jack_mic) {
+                report = 0;
                 if (status & 0x4)
-                        snd_soc_jack_report(wm8994->micdet[0].jack,
-                                            SND_JACK_BTN_0, SND_JACK_BTN_0);
-                else
-                        snd_soc_jack_report(wm8994->micdet[0].jack,
-                                            0, SND_JACK_BTN_0);
+                        report |= SND_JACK_BTN_0;
+
+                if (status & 0x8)
+                        report |= SND_JACK_BTN_1;
+
+                if (status & 0x10)
+                        report |= SND_JACK_BTN_2;
+
+                if (status & 0x20)
+                        report |= SND_JACK_BTN_3;
+
+                if (status & 0x40)
+                        report |= SND_JACK_BTN_4;
+
+                if (status & 0x80)
+                        report |= SND_JACK_BTN_5;
+
+                snd_soc_jack_report(wm8994->micdet[0].jack, report,
+                                    wm8994->btn_mask);
         }
 }
 
@@ -3118,6 +3134,7 @@ int wm8958_mic_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack,
 {
         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
         struct wm8994 *control = wm8994->wm8994;
+        u16 micd_lvl_sel;
 
         switch (control->type) {
         case WM1811:
@@ -3145,9 +3162,18 @@ int wm8958_mic_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack,
 
                 wm8958_micd_set_rate(codec);
 
-                /* Detect microphones and short circuits */
+                /* Detect microphones and short circuits by default */
+                if (wm8994->pdata->micd_lvl_sel)
+                        micd_lvl_sel = wm8994->pdata->micd_lvl_sel;
+                else
+                        micd_lvl_sel = 0x41;
+
+                wm8994->btn_mask = SND_JACK_BTN_0 | SND_JACK_BTN_1 |
+                        SND_JACK_BTN_2 | SND_JACK_BTN_3 |
+                        SND_JACK_BTN_4 | SND_JACK_BTN_5;
+
                 snd_soc_update_bits(codec, WM8958_MIC_DETECT_2,
-                                    WM8958_MICD_LVL_SEL_MASK, 0x41);
+                                    WM8958_MICD_LVL_SEL_MASK, micd_lvl_sel);
 
                 snd_soc_update_bits(codec, WM8958_MIC_DETECT_1,
                                     WM8958_MICD_ENA, WM8958_MICD_ENA);
diff --git a/sound/soc/codecs/wm8994.h b/sound/soc/codecs/wm8994.h
index c3e71d72eb6a..77e3d8c9eeb8 100644
--- a/sound/soc/codecs/wm8994.h
+++ b/sound/soc/codecs/wm8994.h
@@ -129,6 +129,7 @@ struct wm8994_priv {
         struct wm8994_micdet micdet[2];
         bool detecting;
         bool jack_mic;
+        int btn_mask;
 
         wm8958_micdet_cb jack_cb;
         void *jack_cb_data;