ASoC: arizona: Add DVFS handling for sample rate control

The WM8997 and WM5102 codecs need to boost DVFS for higher sample rates.

Signed-off-by: Richard Fitzgerald <rf@opensource.wolfsonmicro.com>
Signed-off-by: Charles Keepax <ckeepax@opensource.wolfsonmicro.com>
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/arizona.c b/sound/soc/codecs/arizona.c
index b2d8b048b82548e91a5f6eb6880888dba91c2497..5939ce467352fdbc4ac61df8c12605a3f1993149 100644 (file)
--- a/sound/soc/codecs/arizona.c
+++ b/sound/soc/codecs/arizona.c
@@ -1394,7 +1394,7 @@ static int arizona_hw_params_rate(struct snd_pcm_substream *substream,
        struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
        struct arizona_dai_priv *dai_priv = &priv->dai[dai->id - 1];
        int base = dai->driver->base;
-       int i, sr_val;
+       int i, sr_val, ret;
 
        /*
         * We will need to be more flexible than this in future,
@@ -1410,6 +1410,23 @@ static int arizona_hw_params_rate(struct snd_pcm_substream *substream,
        }
        sr_val = i;
 
+       switch (priv->arizona->type) {
+       case WM5102:
+       case WM8997:
+               if (arizona_sr_vals[sr_val] >= 88200)
+                       ret = arizona_dvfs_up(codec, ARIZONA_DVFS_SR1_RQ);
+               else
+                       ret = arizona_dvfs_down(codec, ARIZONA_DVFS_SR1_RQ);
+
+               if (ret) {
+                       arizona_aif_err(dai, "Failed to change DVFS %d\n", ret);
+                       return ret;
+               }
+               break;
+       default:
+               break;
+       }
+
        switch (dai_priv->clk) {
        case ARIZONA_CLK_SYSCLK:
                switch (priv->arizona->type) {