From: Marcus Cooper <codekip...@gmail.com>

On newer SoCs the bit fields for the blck and lrclk polarity are in
a different locations. Use regmap fields to set the polarity bits
as intended.

Signed-off-by: Marcus Cooper <codekip...@gmail.com>
---
 sound/soc/sunxi/sun4i-i2s.c | 47 ++++++++++++++++++++++++++++++++-------------
 1 file changed, 34 insertions(+), 13 deletions(-)

diff --git a/sound/soc/sunxi/sun4i-i2s.c b/sound/soc/sunxi/sun4i-i2s.c
index 482fe0c65c1f..a389cdf8c4dc 100644
--- a/sound/soc/sunxi/sun4i-i2s.c
+++ b/sound/soc/sunxi/sun4i-i2s.c
@@ -50,6 +50,8 @@
 #define SUN4I_I2S_FMT0_FMT_RIGHT_J                     (2 << 0)
 #define SUN4I_I2S_FMT0_FMT_LEFT_J                      (1 << 0)
 #define SUN4I_I2S_FMT0_FMT_I2S                         (0 << 0)
+#define SUN4I_I2S_FMT0_POLARITY_INVERTED               (1)
+#define SUN4I_I2S_FMT0_POLARITY_NORMAL                 (0)
 
 #define SUN4I_I2S_FMT1_REG             0x08
 #define SUN4I_I2S_FIFO_TX_REG          0x0c
@@ -101,6 +103,8 @@
  * @fmt_offset: Value by which wss and sr needs to be adjusted.
  * @field_fmt_wss: regmap field to set word select size.
  * @field_fmt_sr: regmap field to set sample resolution.
+ * @field_fmt_bclk: regmap field to set clk polarity.
+ * @field_fmt_lrclk: regmap field to set frame polarity.
  * @field_txchanmap: location of the tx channel mapping register.
  * @field_rxchanmap: location of the rx channel mapping register.
  * @field_txchansel: location of the tx channel select bit fields.
@@ -117,6 +121,8 @@ struct sun4i_i2s_quirks {
        /* Register fields for i2s */
        struct reg_field                field_fmt_wss;
        struct reg_field                field_fmt_sr;
+       struct reg_field                field_fmt_bclk;
+       struct reg_field                field_fmt_lrclk;
        struct reg_field                field_txchanmap;
        struct reg_field                field_rxchanmap;
        struct reg_field                field_txchansel;
@@ -137,6 +143,8 @@ struct sun4i_i2s {
        /* Register fields for i2s */
        struct regmap_field     *field_fmt_wss;
        struct regmap_field     *field_fmt_sr;
+       struct regmap_field     *field_fmt_bclk;
+       struct regmap_field     *field_fmt_lrclk;
        struct regmap_field     *field_txchanmap;
        struct regmap_field     *field_rxchanmap;
        struct regmap_field     *field_txchansel;
@@ -335,6 +343,8 @@ static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, 
unsigned int fmt)
 {
        struct sun4i_i2s *i2s = snd_soc_dai_get_drvdata(dai);
        u32 val;
+       u32 bclk_polarity = SUN4I_I2S_FMT0_POLARITY_NORMAL;
+       u32 lrclk_polarity = SUN4I_I2S_FMT0_POLARITY_NORMAL;
 
        /* DAI Mode */
        switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
@@ -359,32 +369,25 @@ static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, 
unsigned int fmt)
        switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
        case SND_SOC_DAIFMT_IB_IF:
                /* Invert both clocks */
-               val = SUN4I_I2S_FMT0_BCLK_POLARITY_INVERTED |
-                       SUN4I_I2S_FMT0_LRCLK_POLARITY_INVERTED;
+               bclk_polarity = SUN4I_I2S_FMT0_POLARITY_INVERTED;
+               lrclk_polarity = SUN4I_I2S_FMT0_POLARITY_INVERTED;
                break;
        case SND_SOC_DAIFMT_IB_NF:
                /* Invert bit clock */
-               val = SUN4I_I2S_FMT0_BCLK_POLARITY_INVERTED |
-                       SUN4I_I2S_FMT0_LRCLK_POLARITY_NORMAL;
+               bclk_polarity = SUN4I_I2S_FMT0_POLARITY_INVERTED;
                break;
        case SND_SOC_DAIFMT_NB_IF:
                /* Invert frame clock */
-               val = SUN4I_I2S_FMT0_LRCLK_POLARITY_INVERTED |
-                       SUN4I_I2S_FMT0_BCLK_POLARITY_NORMAL;
+               lrclk_polarity = SUN4I_I2S_FMT0_POLARITY_INVERTED;
                break;
        case SND_SOC_DAIFMT_NB_NF:
-               /* Nothing to do for both normal cases */
-               val = SUN4I_I2S_FMT0_BCLK_POLARITY_NORMAL |
-                       SUN4I_I2S_FMT0_LRCLK_POLARITY_NORMAL;
                break;
        default:
                return -EINVAL;
        }
 
-       regmap_update_bits(i2s->regmap, SUN4I_I2S_FMT0_REG,
-                          SUN4I_I2S_FMT0_BCLK_POLARITY_MASK |
-                          SUN4I_I2S_FMT0_LRCLK_POLARITY_MASK,
-                          val);
+       regmap_field_write(i2s->field_fmt_bclk, bclk_polarity);
+       regmap_field_write(i2s->field_fmt_lrclk, lrclk_polarity);
 
        /* DAI clock master masks */
        switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
@@ -712,6 +715,8 @@ static const struct sun4i_i2s_quirks sun4i_a10_i2s_quirks = 
{
        .sun4i_i2s_regmap       = &sun4i_i2s_regmap_config,
        .field_fmt_wss          = REG_FIELD(SUN4I_I2S_FMT0_REG, 2, 3),
        .field_fmt_sr           = REG_FIELD(SUN4I_I2S_FMT0_REG, 4, 5),
+       .field_fmt_bclk         = REG_FIELD(SUN4I_I2S_FMT0_REG, 6, 6),
+       .field_fmt_lrclk        = REG_FIELD(SUN4I_I2S_FMT0_REG, 7, 7),
        .field_txchanmap        = REG_FIELD(SUN4I_I2S_TX_CHAN_MAP_REG, 0, 31),
        .field_rxchanmap        = REG_FIELD(SUN4I_I2S_RX_CHAN_MAP_REG, 0, 31),
        .field_txchansel        = REG_FIELD(SUN4I_I2S_TX_CHAN_SEL_REG, 0, 2),
@@ -724,6 +729,8 @@ static const struct sun4i_i2s_quirks sun6i_a31_i2s_quirks = 
{
        .sun4i_i2s_regmap       = &sun4i_i2s_regmap_config,
        .field_fmt_wss          = REG_FIELD(SUN4I_I2S_FMT0_REG, 2, 3),
        .field_fmt_sr           = REG_FIELD(SUN4I_I2S_FMT0_REG, 4, 5),
+       .field_fmt_bclk         = REG_FIELD(SUN4I_I2S_FMT0_REG, 6, 6),
+       .field_fmt_lrclk        = REG_FIELD(SUN4I_I2S_FMT0_REG, 7, 7),
        .field_txchanmap        = REG_FIELD(SUN4I_I2S_TX_CHAN_MAP_REG, 0, 31),
        .field_rxchanmap        = REG_FIELD(SUN4I_I2S_RX_CHAN_MAP_REG, 0, 31),
        .field_txchansel        = REG_FIELD(SUN4I_I2S_TX_CHAN_SEL_REG, 0, 2),
@@ -775,6 +782,20 @@ static int sun4i_i2s_init_regmap_fields(struct device *dev,
                ret = PTR_ERR_OR_ZERO(i2s->field_fmt_sr);
        }
 
+       if (!ret) {
+               i2s->field_fmt_bclk =
+                       devm_regmap_field_alloc(dev, i2s->regmap,
+                                               i2s->variant->field_fmt_bclk);
+               ret = PTR_ERR_OR_ZERO(i2s->field_fmt_bclk);
+       }
+
+       if (!ret) {
+               i2s->field_fmt_lrclk =
+                       devm_regmap_field_alloc(dev, i2s->regmap,
+                                               i2s->variant->field_fmt_lrclk);
+               ret = PTR_ERR_OR_ZERO(i2s->field_fmt_lrclk);
+       }
+
        return ret;
 }
 
-- 
2.14.1

-- 
You received this message because you are subscribed to the Google Groups 
"linux-sunxi" group.
To unsubscribe from this group and stop receiving emails from it, send an email 
to linux-sunxi+unsubscr...@googlegroups.com.
For more options, visit https://groups.google.com/d/optout.

Reply via email to