Re: [PATCH v5 04/15] ASoC: sun4i-i2s: Support more formats on newer SoCs
On Wed, 14 Aug 2019 at 13:08, Maxime Ripard wrote: > > On Wed, Aug 14, 2019 at 08:08:43AM +0200, codekip...@gmail.com wrote: > > From: Marcus Cooper > > > > There is a need to support more formats on the newer SoCs(H3 and later). > > Extend the formats supported to include DSP_A and DSP_B modes. > > > > Signed-off-by: Marcus Cooper > > --- > > sound/soc/sunxi/sun4i-i2s.c | 87 +++-- > > 1 file changed, 63 insertions(+), 24 deletions(-) > > > > diff --git a/sound/soc/sunxi/sun4i-i2s.c b/sound/soc/sunxi/sun4i-i2s.c > > index 34f31439ae7b..3553c17318b0 100644 > > --- a/sound/soc/sunxi/sun4i-i2s.c > > +++ b/sound/soc/sunxi/sun4i-i2s.c > > @@ -27,6 +27,8 @@ > > #define SUN4I_I2S_CTRL_MODE_MASK BIT(5) > > #define SUN4I_I2S_CTRL_MODE_SLAVE(1 << 5) > > #define SUN4I_I2S_CTRL_MODE_MASTER (0 << 5) > > +#define SUN4I_I2S_CTRL_PCM BIT(4) > > +#define SUN4I_I2S_CTRL_LOOP BIT(3) > > #define SUN4I_I2S_CTRL_TX_EN BIT(2) > > #define SUN4I_I2S_CTRL_RX_EN BIT(1) > > #define SUN4I_I2S_CTRL_GL_EN BIT(0) > > @@ -91,6 +93,9 @@ > > /* Defines required for sun8i-h3 support */ > > #define SUN8I_I2S_CTRL_BCLK_OUT BIT(18) > > #define SUN8I_I2S_CTRL_LRCK_OUT BIT(17) > > +#define SUN8I_I2S_CTRL_MODE_RIGHT_J (2 << 0) > > +#define SUN8I_I2S_CTRL_MODE_I2S_LEFT_J (1 << 0) > > +#define SUN8I_I2S_CTRL_MODE_PCM (0 << 0) > > > > #define SUN8I_I2S_FMT0_LRCK_PERIOD_MASK GENMASK(17, 8) > > #define SUN8I_I2S_FMT0_LRCK_PERIOD(period) ((period - 1) << 8) > > @@ -164,6 +169,7 @@ struct sun4i_i2s_quirks { > > > > s8 (*get_sr)(const struct sun4i_i2s *, int); > > s8 (*get_wss)(const struct sun4i_i2s *, int); > > + int (*set_format)(struct sun4i_i2s *, unsigned int); > > }; > > > > struct sun4i_i2s { > > @@ -194,6 +200,7 @@ struct sun4i_i2s { > > > > unsigned inttdm_slots; > > unsigned intslot_width; > > + unsigned intoffset; > > }; > > > > struct sun4i_i2s_clk_div { > > @@ -484,19 +491,14 @@ static int sun4i_i2s_hw_params(struct > > snd_pcm_substream *substream, > > i2s->slot_width : params_width(params)); > > } > > > > -static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) > > +static int sun4i_i2s_set_format(struct sun4i_i2s *i2s, unsigned int fmt) > > { > > - struct sun4i_i2s *i2s = snd_soc_dai_get_drvdata(dai); > > u32 val; > > - u32 offset = 0; > > - 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) { > > case SND_SOC_DAIFMT_I2S: > > val = SUN4I_I2S_FMT0_FMT_I2S; > > - offset = 1; > > break; > > case SND_SOC_DAIFMT_LEFT_J: > > val = SUN4I_I2S_FMT0_FMT_LEFT_J; > > @@ -505,32 +507,64 @@ static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, > > unsigned int fmt) > > val = SUN4I_I2S_FMT0_FMT_RIGHT_J; > > break; > > default: > > - dev_err(dai->dev, "Unsupported format: %d\n", > > - fmt & SND_SOC_DAIFMT_FORMAT_MASK); > > return -EINVAL; > > } > > > > - if (i2s->variant->has_chsel_offset) { > > - /* > > - * offset being set indicates that we're connected to an i2s > > - * device, however offset is only used on the sun8i block and > > - * i2s shares the same setting with the LJ format. Increment > > - * val so that the bit to value to write is correct. > > - */ > > - if (offset > 0) > > - val++; > > - /* blck offset determines whether i2s or LJ */ > > - regmap_update_bits(i2s->regmap, SUN8I_I2S_TX_CHAN_SEL_REG, > > -SUN8I_I2S_TX_CHAN_OFFSET_MASK, > > -SUN8I_I2S_TX_CHAN_OFFSET(offset)); > > + regmap_field_write(i2s->field_fmt_mode, val); > > + > > + return 0; > > +} > > + > > +static int sun8i_i2s_set_format(struct sun4i_i2s *i2s, unsigned int fmt) > > +{ > > + u32 val; > > > > - regmap_update_bits(i2s->regmap, SUN8I_I2S_RX_CHAN_SEL_REG, > > -SUN8I_I2S_TX_CHAN_OFFSET_MASK, > > -SUN8I_I2S_TX_CHAN_OFFSET(offset)); > > + /* DAI Mode */ > > + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { > > + case SND_SOC_DAIFMT_I2S: > > + i2s->offset = 1; > > + case SND_SOC_DAIFMT_LEFT_J: > > + val = SUN8I_I2S_CTRL_MODE_I2S_LEFT_J; > > + break; > > + case SND_SOC_DAIFMT_RIGHT_J: > > + val =
Re: [PATCH v5 04/15] ASoC: sun4i-i2s: Support more formats on newer SoCs
On Wed, Aug 14, 2019 at 08:08:43AM +0200, codekip...@gmail.com wrote: > From: Marcus Cooper > > There is a need to support more formats on the newer SoCs(H3 and later). > Extend the formats supported to include DSP_A and DSP_B modes. > > Signed-off-by: Marcus Cooper > --- > sound/soc/sunxi/sun4i-i2s.c | 87 +++-- > 1 file changed, 63 insertions(+), 24 deletions(-) > > diff --git a/sound/soc/sunxi/sun4i-i2s.c b/sound/soc/sunxi/sun4i-i2s.c > index 34f31439ae7b..3553c17318b0 100644 > --- a/sound/soc/sunxi/sun4i-i2s.c > +++ b/sound/soc/sunxi/sun4i-i2s.c > @@ -27,6 +27,8 @@ > #define SUN4I_I2S_CTRL_MODE_MASK BIT(5) > #define SUN4I_I2S_CTRL_MODE_SLAVE(1 << 5) > #define SUN4I_I2S_CTRL_MODE_MASTER (0 << 5) > +#define SUN4I_I2S_CTRL_PCM BIT(4) > +#define SUN4I_I2S_CTRL_LOOP BIT(3) > #define SUN4I_I2S_CTRL_TX_EN BIT(2) > #define SUN4I_I2S_CTRL_RX_EN BIT(1) > #define SUN4I_I2S_CTRL_GL_EN BIT(0) > @@ -91,6 +93,9 @@ > /* Defines required for sun8i-h3 support */ > #define SUN8I_I2S_CTRL_BCLK_OUT BIT(18) > #define SUN8I_I2S_CTRL_LRCK_OUT BIT(17) > +#define SUN8I_I2S_CTRL_MODE_RIGHT_J (2 << 0) > +#define SUN8I_I2S_CTRL_MODE_I2S_LEFT_J (1 << 0) > +#define SUN8I_I2S_CTRL_MODE_PCM (0 << 0) > > #define SUN8I_I2S_FMT0_LRCK_PERIOD_MASK GENMASK(17, 8) > #define SUN8I_I2S_FMT0_LRCK_PERIOD(period) ((period - 1) << 8) > @@ -164,6 +169,7 @@ struct sun4i_i2s_quirks { > > s8 (*get_sr)(const struct sun4i_i2s *, int); > s8 (*get_wss)(const struct sun4i_i2s *, int); > + int (*set_format)(struct sun4i_i2s *, unsigned int); > }; > > struct sun4i_i2s { > @@ -194,6 +200,7 @@ struct sun4i_i2s { > > unsigned inttdm_slots; > unsigned intslot_width; > + unsigned intoffset; > }; > > struct sun4i_i2s_clk_div { > @@ -484,19 +491,14 @@ static int sun4i_i2s_hw_params(struct snd_pcm_substream > *substream, > i2s->slot_width : params_width(params)); > } > > -static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) > +static int sun4i_i2s_set_format(struct sun4i_i2s *i2s, unsigned int fmt) > { > - struct sun4i_i2s *i2s = snd_soc_dai_get_drvdata(dai); > u32 val; > - u32 offset = 0; > - 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) { > case SND_SOC_DAIFMT_I2S: > val = SUN4I_I2S_FMT0_FMT_I2S; > - offset = 1; > break; > case SND_SOC_DAIFMT_LEFT_J: > val = SUN4I_I2S_FMT0_FMT_LEFT_J; > @@ -505,32 +507,64 @@ static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, > unsigned int fmt) > val = SUN4I_I2S_FMT0_FMT_RIGHT_J; > break; > default: > - dev_err(dai->dev, "Unsupported format: %d\n", > - fmt & SND_SOC_DAIFMT_FORMAT_MASK); > return -EINVAL; > } > > - if (i2s->variant->has_chsel_offset) { > - /* > - * offset being set indicates that we're connected to an i2s > - * device, however offset is only used on the sun8i block and > - * i2s shares the same setting with the LJ format. Increment > - * val so that the bit to value to write is correct. > - */ > - if (offset > 0) > - val++; > - /* blck offset determines whether i2s or LJ */ > - regmap_update_bits(i2s->regmap, SUN8I_I2S_TX_CHAN_SEL_REG, > -SUN8I_I2S_TX_CHAN_OFFSET_MASK, > -SUN8I_I2S_TX_CHAN_OFFSET(offset)); > + regmap_field_write(i2s->field_fmt_mode, val); > + > + return 0; > +} > + > +static int sun8i_i2s_set_format(struct sun4i_i2s *i2s, unsigned int fmt) > +{ > + u32 val; > > - regmap_update_bits(i2s->regmap, SUN8I_I2S_RX_CHAN_SEL_REG, > -SUN8I_I2S_TX_CHAN_OFFSET_MASK, > -SUN8I_I2S_TX_CHAN_OFFSET(offset)); > + /* DAI Mode */ > + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { > + case SND_SOC_DAIFMT_I2S: > + i2s->offset = 1; > + case SND_SOC_DAIFMT_LEFT_J: > + val = SUN8I_I2S_CTRL_MODE_I2S_LEFT_J; > + break; > + case SND_SOC_DAIFMT_RIGHT_J: > + val = SUN8I_I2S_CTRL_MODE_RIGHT_J; > + break; > + case SND_SOC_DAIFMT_DSP_A: > + i2s->offset = 1; > + case SND_SOC_DAIFMT_DSP_B: > + val = SUN8I_I2S_CTRL_MODE_PCM; > + break; > + > + default: > + return -EINVAL; > } > > +
[PATCH v5 04/15] ASoC: sun4i-i2s: Support more formats on newer SoCs
From: Marcus Cooper There is a need to support more formats on the newer SoCs(H3 and later). Extend the formats supported to include DSP_A and DSP_B modes. Signed-off-by: Marcus Cooper --- sound/soc/sunxi/sun4i-i2s.c | 87 +++-- 1 file changed, 63 insertions(+), 24 deletions(-) diff --git a/sound/soc/sunxi/sun4i-i2s.c b/sound/soc/sunxi/sun4i-i2s.c index 34f31439ae7b..3553c17318b0 100644 --- a/sound/soc/sunxi/sun4i-i2s.c +++ b/sound/soc/sunxi/sun4i-i2s.c @@ -27,6 +27,8 @@ #define SUN4I_I2S_CTRL_MODE_MASK BIT(5) #define SUN4I_I2S_CTRL_MODE_SLAVE (1 << 5) #define SUN4I_I2S_CTRL_MODE_MASTER (0 << 5) +#define SUN4I_I2S_CTRL_PCM BIT(4) +#define SUN4I_I2S_CTRL_LOOPBIT(3) #define SUN4I_I2S_CTRL_TX_EN BIT(2) #define SUN4I_I2S_CTRL_RX_EN BIT(1) #define SUN4I_I2S_CTRL_GL_EN BIT(0) @@ -91,6 +93,9 @@ /* Defines required for sun8i-h3 support */ #define SUN8I_I2S_CTRL_BCLK_OUTBIT(18) #define SUN8I_I2S_CTRL_LRCK_OUTBIT(17) +#define SUN8I_I2S_CTRL_MODE_RIGHT_J(2 << 0) +#define SUN8I_I2S_CTRL_MODE_I2S_LEFT_J (1 << 0) +#define SUN8I_I2S_CTRL_MODE_PCM(0 << 0) #define SUN8I_I2S_FMT0_LRCK_PERIOD_MASKGENMASK(17, 8) #define SUN8I_I2S_FMT0_LRCK_PERIOD(period) ((period - 1) << 8) @@ -164,6 +169,7 @@ struct sun4i_i2s_quirks { s8 (*get_sr)(const struct sun4i_i2s *, int); s8 (*get_wss)(const struct sun4i_i2s *, int); + int (*set_format)(struct sun4i_i2s *, unsigned int); }; struct sun4i_i2s { @@ -194,6 +200,7 @@ struct sun4i_i2s { unsigned inttdm_slots; unsigned intslot_width; + unsigned intoffset; }; struct sun4i_i2s_clk_div { @@ -484,19 +491,14 @@ static int sun4i_i2s_hw_params(struct snd_pcm_substream *substream, i2s->slot_width : params_width(params)); } -static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) +static int sun4i_i2s_set_format(struct sun4i_i2s *i2s, unsigned int fmt) { - struct sun4i_i2s *i2s = snd_soc_dai_get_drvdata(dai); u32 val; - u32 offset = 0; - 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) { case SND_SOC_DAIFMT_I2S: val = SUN4I_I2S_FMT0_FMT_I2S; - offset = 1; break; case SND_SOC_DAIFMT_LEFT_J: val = SUN4I_I2S_FMT0_FMT_LEFT_J; @@ -505,32 +507,64 @@ static int sun4i_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) val = SUN4I_I2S_FMT0_FMT_RIGHT_J; break; default: - dev_err(dai->dev, "Unsupported format: %d\n", - fmt & SND_SOC_DAIFMT_FORMAT_MASK); return -EINVAL; } - if (i2s->variant->has_chsel_offset) { - /* -* offset being set indicates that we're connected to an i2s -* device, however offset is only used on the sun8i block and -* i2s shares the same setting with the LJ format. Increment -* val so that the bit to value to write is correct. -*/ - if (offset > 0) - val++; - /* blck offset determines whether i2s or LJ */ - regmap_update_bits(i2s->regmap, SUN8I_I2S_TX_CHAN_SEL_REG, - SUN8I_I2S_TX_CHAN_OFFSET_MASK, - SUN8I_I2S_TX_CHAN_OFFSET(offset)); + regmap_field_write(i2s->field_fmt_mode, val); + + return 0; +} + +static int sun8i_i2s_set_format(struct sun4i_i2s *i2s, unsigned int fmt) +{ + u32 val; - regmap_update_bits(i2s->regmap, SUN8I_I2S_RX_CHAN_SEL_REG, - SUN8I_I2S_TX_CHAN_OFFSET_MASK, - SUN8I_I2S_TX_CHAN_OFFSET(offset)); + /* DAI Mode */ + switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { + case SND_SOC_DAIFMT_I2S: + i2s->offset = 1; + case SND_SOC_DAIFMT_LEFT_J: + val = SUN8I_I2S_CTRL_MODE_I2S_LEFT_J; + break; + case SND_SOC_DAIFMT_RIGHT_J: + val = SUN8I_I2S_CTRL_MODE_RIGHT_J; + break; + case SND_SOC_DAIFMT_DSP_A: + i2s->offset = 1; + case SND_SOC_DAIFMT_DSP_B: + val = SUN8I_I2S_CTRL_MODE_PCM; + break; + + default: + return -EINVAL; } + /* +* bclk offset determines whether i2s or LJ if in i2s mode and +* DSP_A or DSP_B if in PCM mode. +*/ +