1 files changed, 56 insertions, 54 deletions

diff --git a/sound/soc/codecs/rt5631.c b/sound/soc/codecs/rt5631.c
index 20c324c7c349..960d0e93cce9 100644
--- a/sound/soc/codecs/rt5631.c
+++ b/sound/soc/codecs/rt5631.c
@@ -18,7 +18,7 @@
 #include <linux/delay.h>
 #include <linux/pm.h>
 #include <linux/i2c.h>
-#include <linux/spi/spi.h>
+#include <linux/regmap.h>
 #include <sound/core.h>
 #include <sound/pcm.h>
 #include <sound/pcm_params.h>
@@ -30,6 +30,7 @@
 #include "rt5631.h"
 
 struct rt5631_priv {
+        struct regmap *regmap;
         int codec_version;
         int master;
         int sysclk;
@@ -38,33 +39,33 @@ struct rt5631_priv {
         int dmic_used_flag;
 };
 
-static const u16 rt5631_reg[RT5631_VENDOR_ID2 + 1] = {
-        [RT5631_SPK_OUT_VOL] = 0x8888,
-        [RT5631_HP_OUT_VOL] = 0x8080,
-        [RT5631_MONO_AXO_1_2_VOL] = 0xa080,
-        [RT5631_AUX_IN_VOL] = 0x0808,
-        [RT5631_ADC_REC_MIXER] = 0xf0f0,
-        [RT5631_VDAC_DIG_VOL] = 0x0010,
-        [RT5631_OUTMIXER_L_CTRL] = 0xffc0,
-        [RT5631_OUTMIXER_R_CTRL] = 0xffc0,
-        [RT5631_AXO1MIXER_CTRL] = 0x88c0,
-        [RT5631_AXO2MIXER_CTRL] = 0x88c0,
-        [RT5631_DIG_MIC_CTRL] = 0x3000,
-        [RT5631_MONO_INPUT_VOL] = 0x8808,
-        [RT5631_SPK_MIXER_CTRL] = 0xf8f8,
-        [RT5631_SPK_MONO_OUT_CTRL] = 0xfc00,
-        [RT5631_SPK_MONO_HP_OUT_CTRL] = 0x4440,
-        [RT5631_SDP_CTRL] = 0x8000,
-        [RT5631_MONO_SDP_CTRL] = 0x8000,
-        [RT5631_STEREO_AD_DA_CLK_CTRL] = 0x2010,
-        [RT5631_GEN_PUR_CTRL_REG] = 0x0e00,
-        [RT5631_INT_ST_IRQ_CTRL_2] = 0x071a,
-        [RT5631_MISC_CTRL] = 0x2040,
-        [RT5631_DEPOP_FUN_CTRL_2] = 0x8000,
-        [RT5631_SOFT_VOL_CTRL] = 0x07e0,
-        [RT5631_ALC_CTRL_1] = 0x0206,
-        [RT5631_ALC_CTRL_3] = 0x2000,
-        [RT5631_PSEUDO_SPATL_CTRL] = 0x0553,
+static const struct reg_default rt5631_reg[] = {
+        { RT5631_SPK_OUT_VOL, 0x8888 },
+        { RT5631_HP_OUT_VOL, 0x8080 },
+        { RT5631_MONO_AXO_1_2_VOL, 0xa080 },
+        { RT5631_AUX_IN_VOL, 0x0808 },
+        { RT5631_ADC_REC_MIXER, 0xf0f0 },
+        { RT5631_VDAC_DIG_VOL, 0x0010 },
+        { RT5631_OUTMIXER_L_CTRL, 0xffc0 },
+        { RT5631_OUTMIXER_R_CTRL, 0xffc0 },
+        { RT5631_AXO1MIXER_CTRL, 0x88c0 },
+        { RT5631_AXO2MIXER_CTRL, 0x88c0 },
+        { RT5631_DIG_MIC_CTRL, 0x3000 },
+        { RT5631_MONO_INPUT_VOL, 0x8808 },
+        { RT5631_SPK_MIXER_CTRL, 0xf8f8 },
+        { RT5631_SPK_MONO_OUT_CTRL, 0xfc00 },
+        { RT5631_SPK_MONO_HP_OUT_CTRL, 0x4440 },
+        { RT5631_SDP_CTRL, 0x8000 },
+        { RT5631_MONO_SDP_CTRL, 0x8000 },
+        { RT5631_STEREO_AD_DA_CLK_CTRL, 0x2010 },
+        { RT5631_GEN_PUR_CTRL_REG, 0x0e00 },
+        { RT5631_INT_ST_IRQ_CTRL_2, 0x071a },
+        { RT5631_MISC_CTRL, 0x2040 },
+        { RT5631_DEPOP_FUN_CTRL_2, 0x8000 },
+        { RT5631_SOFT_VOL_CTRL, 0x07e0 },
+        { RT5631_ALC_CTRL_1, 0x0206 },
+        { RT5631_ALC_CTRL_3, 0x2000 },
+        { RT5631_PSEUDO_SPATL_CTRL, 0x0553 },
 };
 
 /**
@@ -96,8 +97,7 @@ static int rt5631_reset(struct snd_soc_codec *codec)
         return snd_soc_write(codec, RT5631_RESET, 0);
 }
 
-static int rt5631_volatile_register(struct snd_soc_codec *codec,
-                                    unsigned int reg)
+static bool rt5631_volatile_register(struct device *dev, unsigned int reg)
 {
         switch (reg) {
         case RT5631_RESET:
@@ -111,8 +111,7 @@ static int rt5631_volatile_register(struct snd_soc_codec *codec,
         }
 }
 
-static int rt5631_readable_register(struct snd_soc_codec *codec,
-                                    unsigned int reg)
+static bool rt5631_readable_register(struct device *dev, unsigned int reg)
 {
         switch (reg) {
         case RT5631_RESET:
@@ -1361,8 +1360,7 @@ static int get_coeff(int mclk, int rate, int timesofbclk)
 static int rt5631_hifi_pcm_params(struct snd_pcm_substream *substream,
                 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
 {
-        struct snd_soc_pcm_runtime *rtd = substream->private_data;
-        struct snd_soc_codec *codec = rtd->codec;
+        struct snd_soc_codec *codec = dai->codec;
         struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
         int timesofbclk = 32, coeff;
         unsigned int iface = 0;
@@ -1544,6 +1542,8 @@ static int rt5631_codec_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
 static int rt5631_set_bias_level(struct snd_soc_codec *codec,
                         enum snd_soc_bias_level level)
 {
+        struct rt5631_priv *rt5631 = snd_soc_codec_get_drvdata(codec);
+
         switch (level) {
         case SND_SOC_BIAS_ON:
         case SND_SOC_BIAS_PREPARE:
@@ -1561,8 +1561,8 @@ static int rt5631_set_bias_level(struct snd_soc_codec *codec,
                         snd_soc_update_bits(codec, RT5631_PWR_MANAG_ADD3,
                                 RT5631_PWR_FAST_VREF_CTRL,
                                 RT5631_PWR_FAST_VREF_CTRL);
-                        codec->cache_only = false;
-                        snd_soc_cache_sync(codec);
+                        regcache_cache_only(rt5631->regmap, false);
+                        regcache_sync(rt5631->regmap);
                 }
                 break;
 
@@ -1587,7 +1587,9 @@ static int rt5631_probe(struct snd_soc_codec *codec)
         unsigned int val;
         int ret;
 
-        ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
+        codec->control_data = rt5631->regmap;
+
+        ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_REGMAP);
         if (ret != 0) {
                 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
                 return ret;
@@ -1698,12 +1700,6 @@ static struct snd_soc_codec_driver soc_codec_dev_rt5631 = {
         .suspend = rt5631_suspend,
         .resume = rt5631_resume,
         .set_bias_level = rt5631_set_bias_level,
-        .reg_cache_size = RT5631_VENDOR_ID2 + 1,
-        .reg_word_size = sizeof(u16),
-        .reg_cache_default = rt5631_reg,
-        .volatile_register = rt5631_volatile_register,
-        .readable_register = rt5631_readable_register,
-        .reg_cache_step = 1,
         .controls = rt5631_snd_controls,
         .num_controls = ARRAY_SIZE(rt5631_snd_controls),
         .dapm_widgets = rt5631_dapm_widgets,
@@ -1718,6 +1714,18 @@ static const struct i2c_device_id rt5631_i2c_id[] = {
 };
 MODULE_DEVICE_TABLE(i2c, rt5631_i2c_id);
 
+static const struct regmap_config rt5631_regmap_config = {
+        .reg_bits = 8,
+        .val_bits = 16,
+
+        .readable_reg = rt5631_readable_register,
+        .volatile_reg = rt5631_volatile_register,
+        .max_register = RT5631_VENDOR_ID2,
+        .reg_defaults = rt5631_reg,
+        .num_reg_defaults = ARRAY_SIZE(rt5631_reg),
+        .cache_type = REGCACHE_RBTREE,
+};
+
 static int rt5631_i2c_probe(struct i2c_client *i2c,
                     const struct i2c_device_id *id)
 {
@@ -1731,6 +1739,10 @@ static int rt5631_i2c_probe(struct i2c_client *i2c,
 
         i2c_set_clientdata(i2c, rt5631);
 
+        rt5631->regmap = devm_regmap_init_i2c(i2c, &rt5631_regmap_config);
+        if (IS_ERR(rt5631->regmap))
+                return PTR_ERR(rt5631->regmap);
+
         ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5631,
                         rt5631_dai, ARRAY_SIZE(rt5631_dai));
         return ret;
@@ -1752,17 +1764,7 @@ static struct i2c_driver rt5631_i2c_driver = {
         .id_table = rt5631_i2c_id,
 };
 
-static int __init rt5631_modinit(void)
-{
-        return i2c_add_driver(&rt5631_i2c_driver);
-}
-module_init(rt5631_modinit);
-
-static void __exit rt5631_modexit(void)
-{
-        i2c_del_driver(&rt5631_i2c_driver);
-}
-module_exit(rt5631_modexit);
+module_i2c_driver(rt5631_i2c_driver);
 
 MODULE_DESCRIPTION("ASoC RT5631 driver");
 MODULE_AUTHOR("flove <flove@realtek.com>");