ASoC: Implement DC servo completion IRQ handling for wm_hubs devices

[deliverable/linux.git] / sound / soc / codecs / wm_hubs.c

diff --git a/sound/soc/codecs/wm_hubs.c b/sound/soc/codecs/wm_hubs.c
index 7e60e227967160b083bd11bbf3a37e32f03fb841..5c2d5657b472552d72a4f47d5dedf1034490afd3 100644 (file)
--- a/sound/soc/codecs/wm_hubs.c
+++ b/sound/soc/codecs/wm_hubs.c
@@ -63,9 +63,11 @@ static const struct soc_enum speaker_mode =
 
 static void wait_for_dc_servo(struct snd_soc_codec *codec, unsigned int op)
 {
+       struct wm_hubs_data *hubs = snd_soc_codec_get_drvdata(codec);
        unsigned int reg;
        int count = 0;
        unsigned int val;
+       unsigned long timeout;
 
        val = op | WM8993_DCS_ENA_CHAN_0 | WM8993_DCS_ENA_CHAN_1;
 
@@ -74,18 +76,37 @@ static void wait_for_dc_servo(struct snd_soc_codec *codec, unsigned int op)
 
        dev_dbg(codec->dev, "Waiting for DC servo...\n");
 
-       do {
-               count++;
-               msleep(1);
+       if (hubs->dcs_done_irq) {
+               timeout = wait_for_completion_timeout(&hubs->dcs_done,
+                                                     msecs_to_jiffies(500));
+               if (timeout == 0)
+                       dev_warn(codec->dev, "No DC servo interrupt\n");
+
                reg = snd_soc_read(codec, WM8993_DC_SERVO_0);
-               dev_dbg(codec->dev, "DC servo: %x\n", reg);
-       } while (reg & op && count < 400);
+       } else {
+               do {
+                       count++;
+                       msleep(1);
+                       reg = snd_soc_read(codec, WM8993_DC_SERVO_0);
+                       dev_dbg(codec->dev, "DC servo: %x\n", reg);
+               } while (reg & op && count < 400);
+       }
 
        if (reg & op)
                dev_err(codec->dev, "Timed out waiting for DC Servo %x\n",
                        op);
 }
 
+irqreturn_t wm_hubs_dcs_done(int irq, void *data)
+{
+       struct wm_hubs_data *hubs = data;
+
+       complete(&hubs->dcs_done);
+
+       return IRQ_HANDLED;
+}
+EXPORT_SYMBOL_GPL(wm_hubs_dcs_done);
+
 /*
  * Startup calibration of the DC servo
  */
@@ -863,8 +884,11 @@ EXPORT_SYMBOL_GPL(wm_hubs_add_analogue_controls);
 int wm_hubs_add_analogue_routes(struct snd_soc_codec *codec,
                                int lineout1_diff, int lineout2_diff)
 {
+       struct wm_hubs_data *hubs = snd_soc_codec_get_drvdata(codec);
        struct snd_soc_dapm_context *dapm = &codec->dapm;
 
+       init_completion(&hubs->dcs_done);
+
        snd_soc_dapm_add_routes(dapm, analogue_routes,
                                ARRAY_SIZE(analogue_routes));