ENGR00318773-7 ASoC: fsl_esai: Add driver suspend and resume to support MEGA Fast

For i.MX6 SoloX, there is a mode of the SoC to shutdown all power source of
modules during system suspend and resume procedure. Thus, ESAI needs to save
all the values of registers before the system suspend and restore them after
the system resume.

Acked-by: Wang Shengjiu <b02247@freescale.com>
Signed-off-by: Nicolin Chen <Guangyu.Chen@freescale.com>

1 files changed, 69 insertions, 0 deletions

diff --git a/sound/soc/fsl/fsl_esai.c b/sound/soc/fsl/fsl_esai.c
index 09d904a064cc..7204171edca6 100644
--- a/sound/soc/fsl/fsl_esai.c
+++ b/sound/soc/fsl/fsl_esai.c
@@ -655,6 +655,32 @@ static bool fsl_esai_readable_reg(struct device *dev, unsigned int reg)
         }
 }
 
+static bool fsl_esai_volatile_reg(struct device *dev, unsigned int reg)
+{
+        switch (reg) {
+        case REG_ESAI_ETDR:
+        case REG_ESAI_ERDR:
+        case REG_ESAI_ESR:
+        case REG_ESAI_TFSR:
+        case REG_ESAI_RFSR:
+        case REG_ESAI_TX0:
+        case REG_ESAI_TX1:
+        case REG_ESAI_TX2:
+        case REG_ESAI_TX3:
+        case REG_ESAI_TX4:
+        case REG_ESAI_TX5:
+        case REG_ESAI_RX0:
+        case REG_ESAI_RX1:
+        case REG_ESAI_RX2:
+        case REG_ESAI_RX3:
+        case REG_ESAI_SAISR:
+                return true;
+        default:
+                return false;
+        }
+
+}
+
 static bool fsl_esai_writeable_reg(struct device *dev, unsigned int reg)
 {
         switch (reg) {
@@ -693,7 +719,9 @@ static const struct regmap_config fsl_esai_regmap_config = {
 
         .max_register = REG_ESAI_PCRC,
         .readable_reg = fsl_esai_readable_reg,
+        .volatile_reg = fsl_esai_volatile_reg,
         .writeable_reg = fsl_esai_writeable_reg,
+        .cache_type = REGCACHE_RBTREE,
 };
 
 static bool fsl_esai_check_xrun(struct snd_pcm_substream *substream)
@@ -978,11 +1006,52 @@ static const struct of_device_id fsl_esai_dt_ids[] = {
 };
 MODULE_DEVICE_TABLE(of, fsl_esai_dt_ids);
 
+#if CONFIG_PM_SLEEP
+static int fsl_esai_suspend(struct device *dev)
+{
+        struct fsl_esai *esai = dev_get_drvdata(dev);
+
+        regcache_cache_only(esai->regmap, true);
+        regcache_mark_dirty(esai->regmap);
+
+        return 0;
+}
+
+static int fsl_esai_resume(struct device *dev)
+{
+        struct fsl_esai *esai = dev_get_drvdata(dev);
+        int ret;
+
+        regcache_cache_only(esai->regmap, false);
+
+        /* FIFO reset for safety */
+        regmap_update_bits(esai->regmap, REG_ESAI_TFCR,
+                           ESAI_xFCR_xFR, ESAI_xFCR_xFR);
+        regmap_update_bits(esai->regmap, REG_ESAI_RFCR,
+                           ESAI_xFCR_xFR, ESAI_xFCR_xFR);
+
+        ret = regcache_sync(esai->regmap);
+        if (ret)
+                return ret;
+
+        /* FIFO reset done */
+        regmap_update_bits(esai->regmap, REG_ESAI_TFCR, ESAI_xFCR_xFR, 0);
+        regmap_update_bits(esai->regmap, REG_ESAI_RFCR, ESAI_xFCR_xFR, 0);
+
+        return 0;
+}
+#endif /* CONFIG_PM_SLEEP */
+
+static const struct dev_pm_ops fsl_esai_pm_ops = {
+        SET_SYSTEM_SLEEP_PM_OPS(fsl_esai_suspend, fsl_esai_resume)
+};
+
 static struct platform_driver fsl_esai_driver = {
         .probe = fsl_esai_probe,
         .driver = {
                 .name = "fsl-esai-dai",
                 .owner = THIS_MODULE,
+                .pm = &fsl_esai_pm_ops,
                 .of_match_table = fsl_esai_dt_ids,
         },
 };