ASoC: tlv320aic32x4: Model DAC/ADC dividers in CCF

commit a51b50062091619915c5155085bbe13a7aca6903 upstream.

Model and manage DAC/ADC dividers as components in the Core
Clock Framework.  This should allow us to do some more complex
clock management and power control.  Also, some of the
on-board chip clocks can be exposed to the outside, and this
change will make those clocks easier to consume by other
parts of the kernel.

Signed-off-by: Annaliese McDermond <nh6z@nh6z.net>
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/tlv320aic32x4-clk.c b/sound/soc/codecs/tlv320aic32x4-clk.c
index cded850..daf1492 100644 (file)
--- a/sound/soc/codecs/tlv320aic32x4-clk.c
+++ b/sound/soc/codecs/tlv320aic32x4-clk.c
@@ -289,6 +289,68 @@ static const struct clk_ops aic32x4_codec_clkin_ops = {
        .get_parent = clk_aic32x4_codec_clkin_get_parent,
 };
 
+static int clk_aic32x4_div_prepare(struct clk_hw *hw)
+{
+       struct clk_aic32x4 *div = to_clk_aic32x4(hw);
+
+       return regmap_update_bits(div->regmap, div->reg,
+                               AIC32X4_DIVEN, AIC32X4_DIVEN);
+}
+
+static void clk_aic32x4_div_unprepare(struct clk_hw *hw)
+{
+       struct clk_aic32x4 *div = to_clk_aic32x4(hw);
+
+       regmap_update_bits(div->regmap, div->reg,
+                       AIC32X4_DIVEN, 0);
+}
+
+static int clk_aic32x4_div_set_rate(struct clk_hw *hw, unsigned long rate,
+                               unsigned long parent_rate)
+{
+       struct clk_aic32x4 *div = to_clk_aic32x4(hw);
+       u8 divisor;
+
+       divisor = DIV_ROUND_UP(parent_rate, rate);
+       if (divisor > 128)
+               return -EINVAL;
+
+       return regmap_update_bits(div->regmap, div->reg,
+                               AIC32X4_DIV_MASK, divisor);
+}
+
+static long clk_aic32x4_div_round_rate(struct clk_hw *hw, unsigned long rate,
+                               unsigned long *parent_rate)
+{
+       unsigned long divisor;
+
+       divisor = DIV_ROUND_UP(*parent_rate, rate);
+       if (divisor > 128)
+               return -EINVAL;
+
+       return DIV_ROUND_UP(*parent_rate, divisor);
+}
+
+static unsigned long clk_aic32x4_div_recalc_rate(struct clk_hw *hw,
+                                               unsigned long parent_rate)
+{
+       struct clk_aic32x4 *div = to_clk_aic32x4(hw);
+
+       unsigned int val;
+
+       regmap_read(div->regmap, div->reg, &val);
+
+       return DIV_ROUND_UP(parent_rate, val & AIC32X4_DIV_MASK);
+}
+
+static const struct clk_ops aic32x4_div_ops = {
+       .prepare = clk_aic32x4_div_prepare,
+       .unprepare = clk_aic32x4_div_unprepare,
+       .set_rate = clk_aic32x4_div_set_rate,
+       .round_rate = clk_aic32x4_div_round_rate,
+       .recalc_rate = clk_aic32x4_div_recalc_rate,
+};
+
 static struct aic32x4_clkdesc aic32x4_clkdesc_array[] = {
        {
                .name = "pll",
@@ -306,6 +368,34 @@ static struct aic32x4_clkdesc aic32x4_clkdesc_array[] = {
                .ops = &aic32x4_codec_clkin_ops,
                .reg = 0,
        },
+       {
+               .name = "ndac",
+               .parent_names = (const char * []) { "codec_clkin" },
+               .num_parents = 1,
+               .ops = &aic32x4_div_ops,
+               .reg = AIC32X4_NDAC,
+       },
+       {
+               .name = "mdac",
+               .parent_names = (const char * []) { "ndac" },
+               .num_parents = 1,
+               .ops = &aic32x4_div_ops,
+               .reg = AIC32X4_MDAC,
+       },
+       {
+               .name = "nadc",
+               .parent_names = (const char * []) { "codec_clkin" },
+               .num_parents = 1,
+               .ops = &aic32x4_div_ops,
+               .reg = AIC32X4_NADC,
+       },
+       {
+               .name = "madc",
+               .parent_names = (const char * []) { "nadc" },
+               .num_parents = 1,
+               .ops = &aic32x4_div_ops,
+               .reg = AIC32X4_MADC,
+       },
 };
 
 static struct clk *aic32x4_register_clk(struct device *dev,

diff --git a/sound/soc/codecs/tlv320aic32x4.c b/sound/soc/codecs/tlv320aic32x4.c
index 62d6ee4..df4b625 100644 (file)
--- a/sound/soc/codecs/tlv320aic32x4.c
+++ b/sound/soc/codecs/tlv320aic32x4.c
@@ -52,11 +52,11 @@ struct aic32x4_rate_divs {
        u32 rate;
        unsigned long pll_rate;
        u16 dosr;
-       u8 ndac;
-       u8 mdac;
+       unsigned long ndac_rate;
+       unsigned long mdac_rate;
        u8 aosr;
-       u8 nadc;
-       u8 madc;
+       unsigned long nadc_rate;
+       unsigned long madc_rate;
        u8 blck_N;
        u8 r_block;
        u8 p_block;
@@ -309,34 +309,54 @@ static const struct snd_kcontrol_new aic32x4_snd_controls[] = {
 
 static const struct aic32x4_rate_divs aic32x4_divs[] = {
        /* 8k rate */
-       { 12000000, 8000, 57120000, 768, 5, 3, 128, 5, 18, 24, 1, 1 },
-       { 24000000, 8000, 57120000, 768, 15, 1, 64, 45, 4, 24, 1, 1 },
-       { 25000000, 8000, 32620000, 768, 15, 1, 64, 45, 4, 24, 1, 1 },
+       { 12000000, 8000, 57120000, 768, 18432000, 6144000, 128, 18432000,
+               1024000, 24, 1, 1 },
+       { 24000000, 8000, 57120000, 768, 6144000, 6144000, 64, 2048000,
+               512000, 24, 1, 1 },
+       { 25000000, 8000, 32620000, 768, 6144000, 6144000, 64, 2048000,
+               512000, 24, 1, 1 },
        /* 11.025k rate */
-       { 12000000, 11025, 44217600, 512, 8, 2, 128, 8, 8, 16, 1, 1 },
-       { 24000000, 11025, 44217600, 512, 16, 1, 64, 32, 4, 16, 1, 1 },
+       { 12000000, 11025, 44217600, 512, 11289600, 5644800, 128, 11289600,
+               1411200, 16, 1, 1 },
+       { 24000000, 11025, 44217600, 512, 5644800, 5644800, 64, 2822400,
+               705600, 16, 1, 1 },
        /* 16k rate */
-       { 12000000, 16000, 57120000, 384, 5, 3, 128, 5, 9, 12, 1, 1 },
-       { 24000000, 16000, 57120000, 384, 15, 1, 64, 18, 5, 12, 1, 1 },
-       { 25000000, 16000, 32620000, 384, 15, 1, 64, 18, 5, 12, 1, 1 },
+       { 12000000, 16000, 57120000, 384, 18432000, 6144000, 128, 18432000,
+               2048000, 12, 1, 1 },
+       { 24000000, 16000, 57120000, 384, 6144000, 6144000, 64, 5120000,
+               1024000, 12, 1, 1 },
+       { 25000000, 16000, 32620000, 384, 6144000, 6144000, 64, 5120000,
+               1024000, 12, 1, 1 },
        /* 22.05k rate */
-       { 12000000, 22050, 44217600, 256, 4, 4, 128, 4, 8, 8, 1, 1 },
-       { 24000000, 22050, 44217600, 256, 16, 1, 64, 16, 4, 8, 1, 1 },
-       { 25000000, 22050, 19713750, 256, 16, 1, 64, 16, 4, 8, 1, 1 },
+       { 12000000, 22050, 44217600, 256, 22579200, 5644800, 128, 22579200,
+               2822400, 8, 1, 1 },
+       { 24000000, 22050, 44217600, 256, 5644800, 5644800, 64, 5644800,
+               1411200, 8, 1, 1 },
+       { 25000000, 22050, 19713750, 256, 5644800, 5644800, 64, 5644800,
+               1411200, 8, 1, 1 },
        /* 32k rate */
-       { 12000000, 32000, 14112000, 192, 2, 7, 64, 2, 21, 6, 1, 1 },
-       { 24000000, 32000, 14112000, 192, 7, 2, 64, 7, 6, 6, 1, 1 },
+       { 12000000, 32000, 14112000, 192, 43008000, 6144000, 64, 43008000,
+               2048000, 6, 1, 1 },
+       { 24000000, 32000, 14112000, 192, 12288000, 6144000, 64, 12288000,
+               2048000, 6, 1, 1 },
        /* 44.1k rate */
-       { 12000000, 44100, 44217600, 128, 2, 8, 128, 2, 8, 4, 1, 1 },
-       { 24000000, 44100, 44217600, 128, 8, 2, 64, 8, 4, 4, 1, 1 },
-       { 25000000, 44100, 19713750, 128, 8, 2, 64, 8, 4, 4, 1, 1 },
+       { 12000000, 44100, 44217600, 128, 45158400, 5644800, 128, 45158400,
+               5644800, 4, 1, 1 },
+       { 24000000, 44100, 44217600, 128, 11289600, 5644800, 64, 11289600,
+               2822400, 4, 1, 1 },
+       { 25000000, 44100, 19713750, 128, 11289600, 5644800, 64, 11289600,
+               2822400, 4, 1, 1 },
        /* 48k rate */
-       { 12000000, 48000, 18432000, 128, 2, 8, 128, 2, 8, 4, 1, 1 },
-       { 24000000, 48000, 18432000, 128, 8, 2, 64, 8, 4, 4, 1, 1 },
-       { 25000000, 48000, 75626250, 128, 8, 2, 64, 8, 4, 4, 1, 1 },
+       { 12000000, 48000, 18432000, 128, 49152000, 6144000, 128, 49152000,
+               6144000, 4, 1, 1 },
+       { 24000000, 48000, 18432000, 128, 12288000, 6144000, 64, 12288000,
+               3072000, 4, 1, 1 },
+       { 25000000, 48000, 75626250, 128, 12288000, 6144000, 64, 12288000,
+               3072000, 4, 1, 1 },
 
        /* 96k rate */
-       { 25000000, 96000, 75626250, 64, 4, 4, 64, 4, 4, 1, 1, 9 },
+       { 25000000, 96000, 75626250, 64, 24576000, 6144000, 64, 24576000,
+               6144000, 1, 1, 9 },
 };
 
 static const struct snd_kcontrol_new hpl_output_mixer_controls[] = {
@@ -721,6 +741,10 @@ static int aic32x4_setup_clocks(struct snd_soc_component *component,
 
        struct clk_bulk_data clocks[] = {
                { .id = "pll" },
+               { .id = "nadc" },
+               { .id = "madc" },
+               { .id = "ndac" },
+               { .id = "mdac" },
        };
 
        i = aic32x4_get_divs(parent_rate, sample_rate);
@@ -733,7 +757,11 @@ static int aic32x4_setup_clocks(struct snd_soc_component *component,
        if (ret)
                return ret;
 
-       clk_set_rate(clocks[0].clk, sample_rate);
+       clk_set_rate(clocks[0].clk, aic32x4_divs[i].pll_rate);
+       clk_set_rate(clocks[1].clk, aic32x4_divs[i].nadc_rate);
+       clk_set_rate(clocks[2].clk, aic32x4_divs[i].madc_rate);
+       clk_set_rate(clocks[3].clk, aic32x4_divs[i].ndac_rate);
+       clk_set_rate(clocks[4].clk, aic32x4_divs[i].mdac_rate);
 
        aic32x4_set_processing_blocks(component, aic32x4_divs[i].r_block, aic32x4_divs[i].p_block);
 
@@ -742,26 +770,10 @@ static int aic32x4_setup_clocks(struct snd_soc_component *component,
                                AIC32X4_BDIVCLK_MASK,
                                AIC32X4_DACMOD2BCLK << AIC32X4_BDIVCLK_SHIFT);
 
-       /* NDAC divider value */
-       snd_soc_component_update_bits(component, AIC32X4_NDAC,
-                               AIC32X4_NDAC_MASK, aic32x4_divs[i].ndac);
-
-       /* MDAC divider value */
-       snd_soc_component_update_bits(component, AIC32X4_MDAC,
-                               AIC32X4_MDAC_MASK, aic32x4_divs[i].mdac);
-
        /* DOSR MSB & LSB values */
        snd_soc_component_write(component, AIC32X4_DOSRMSB, aic32x4_divs[i].dosr >> 8);
        snd_soc_component_write(component, AIC32X4_DOSRLSB, (aic32x4_divs[i].dosr & 0xff));
 
-       /* NADC divider value */
-       snd_soc_component_update_bits(component, AIC32X4_NADC,
-                               AIC32X4_NADC_MASK, aic32x4_divs[i].nadc);
-
-       /* MADC divider value */
-       snd_soc_component_update_bits(component, AIC32X4_MADC,
-                               AIC32X4_MADC_MASK, aic32x4_divs[i].madc);
-
        /* AOSR value */
        snd_soc_component_write(component, AIC32X4_AOSR, aic32x4_divs[i].aosr);
 
@@ -773,8 +785,8 @@ static int aic32x4_setup_clocks(struct snd_soc_component *component,
 }
 
 static int aic32x4_hw_params(struct snd_pcm_substream *substream,
-                            struct snd_pcm_hw_params *params,
-                            struct snd_soc_dai *dai)
+                                struct snd_pcm_hw_params *params,
+                                struct snd_soc_dai *dai)
 {
        struct snd_soc_component *component = dai->component;
        struct aic32x4_priv *aic32x4 = snd_soc_component_get_drvdata(component);
@@ -989,7 +1001,8 @@ static int aic32x4_component_probe(struct snd_soc_component *component)
        int ret;
 
        struct clk_bulk_data clocks[] = {
-           { .id = "codec_clkin" },
+               { .id = "codec_clkin" },
+               { .id = "pll" },
        };
 
        ret = devm_clk_bulk_get(component->dev, ARRAY_SIZE(clocks), clocks);

diff --git a/sound/soc/codecs/tlv320aic32x4.h b/sound/soc/codecs/tlv320aic32x4.h
index e2b65bb..6ede877 100644 (file)
--- a/sound/soc/codecs/tlv320aic32x4.h
+++ b/sound/soc/codecs/tlv320aic32x4.h
@@ -206,6 +206,10 @@ int aic32x4_register_clocks(struct device *dev, const char *mclk_name);
 #define AIC32X4_RMICPGANIN_IN1L_10K    0x10
 #define AIC32X4_RMICPGANIN_CM1R_10K    0x40
 
+/* Common mask and enable for all of the dividers */
+#define AIC32X4_DIVEN           BIT(7)
+#define AIC32X4_DIV_MASK        GENMASK(6, 0)
+
 /* Clock Limits */
 #define AIC32X4_MAX_PLL_CLKIN          20000000