ASoC: arizona: Log thermal events

Help with debuggability.

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

diff --git a/sound/soc/codecs/arizona.c b/sound/soc/codecs/arizona.c
index 009810b8c667ebb03c9f4dc669edea6144c5f43d..895ddf007de225a8a2d0ff424c6dbf90e614991b 100644 (file)
--- a/sound/soc/codecs/arizona.c
+++ b/sound/soc/codecs/arizona.c
@@ -122,6 +122,42 @@ static int arizona_spk_ev(struct snd_soc_dapm_widget *w,
        return 0;
 }
 
+static irqreturn_t arizona_thermal_warn(int irq, void *data)
+{
+       struct arizona *arizona = data;
+       unsigned int val;
+       int ret;
+
+       ret = regmap_read(arizona->regmap, ARIZONA_INTERRUPT_RAW_STATUS_3,
+                         &val);
+       if (ret != 0) {
+               dev_err(arizona->dev, "Failed to read thermal status: %d\n",
+                       ret);
+       } else if (val & ARIZONA_SPK_SHUTDOWN_WARN_STS) {
+               dev_crit(arizona->dev, "Thermal warning\n");
+       }
+
+       return IRQ_HANDLED;
+}
+
+static irqreturn_t arizona_thermal_shutdown(int irq, void *data)
+{
+       struct arizona *arizona = data;
+       unsigned int val;
+       int ret;
+
+       ret = regmap_read(arizona->regmap, ARIZONA_INTERRUPT_RAW_STATUS_3,
+                         &val);
+       if (ret != 0) {
+               dev_err(arizona->dev, "Failed to read thermal status: %d\n",
+                       ret);
+       } else if (val & ARIZONA_SPK_SHUTDOWN_STS) {
+               dev_crit(arizona->dev, "Thermal shutdown\n");
+       }
+
+       return IRQ_HANDLED;
+}
+
 static const struct snd_soc_dapm_widget arizona_spkl =
        SND_SOC_DAPM_PGA_E("OUT4L", ARIZONA_OUTPUT_ENABLES_1,
                           ARIZONA_OUT4L_ENA_SHIFT, 0, NULL, 0, arizona_spk_ev,
@@ -134,6 +170,8 @@ static const struct snd_soc_dapm_widget arizona_spkr =
 
 int arizona_init_spk(struct snd_soc_codec *codec)
 {
+       struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
+       struct arizona *arizona = priv->arizona;
        int ret;
 
        ret = snd_soc_dapm_new_controls(&codec->dapm, &arizona_spkl, 1);
@@ -144,6 +182,22 @@ int arizona_init_spk(struct snd_soc_codec *codec)
        if (ret != 0)
                return ret;
 
+       ret = arizona_request_irq(arizona, ARIZONA_IRQ_SPK_SHUTDOWN_WARN,
+                                 "Thermal warning", arizona_thermal_warn,
+                                 arizona);
+       if (ret != 0)
+               dev_err(arizona->dev,
+                       "Failed to get thermal warning IRQ: %d\n",
+                       ret);
+
+       ret = arizona_request_irq(arizona, ARIZONA_IRQ_SPK_SHUTDOWN,
+                                 "Thermal shutdown", arizona_thermal_shutdown,
+                                 arizona);
+       if (ret != 0)
+               dev_err(arizona->dev,
+                       "Failed to get thermal shutdown IRQ: %d\n",
+                       ret);
+
        return 0;
 }
 EXPORT_SYMBOL_GPL(arizona_init_spk);