ASoC: dwc: Support set_bclk_ratio

Signed-off-by: Phil Elwell <phil@raspberrypi.com>

diff --git a/sound/soc/dwc/dwc-i2s.c b/sound/soc/dwc/dwc-i2s.c
index 9ea4be5..dacb160 100644 (file)
--- a/sound/soc/dwc/dwc-i2s.c
+++ b/sound/soc/dwc/dwc-i2s.c
@@ -460,6 +460,40 @@ static int dw_i2s_set_tdm_slot(struct snd_soc_dai *cpu_dai,        unsigned int tx_mask
        return 0;
 }
 
+static int dw_i2s_set_bclk_ratio(struct snd_soc_dai *cpu_dai,
+                                unsigned int ratio)
+{
+       struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(cpu_dai);
+       struct i2s_clk_config_data *config = &dev->config;
+
+       dev_err(dev->dev, "%s(%d)\n", __func__, ratio);
+       switch (ratio) {
+       case 32:
+               config->data_width = 16;
+               dev->ccr = 0x00;
+               dev->xfer_resolution = 0x02;
+               break;
+
+       case 48:
+               config->data_width = 24;
+               dev->ccr = 0x08;
+               dev->xfer_resolution = 0x04;
+               break;
+
+       case 64:
+               config->data_width = 32;
+               dev->ccr = 0x10;
+               dev->xfer_resolution = 0x05;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       i2s_write_reg(dev->i2s_base, CCR, dev->ccr);
+
+       return 0;
+}
+
 static int dw_i2s_dai_probe(struct snd_soc_dai *dai)
 {
        struct dw_i2s_dev *dev = snd_soc_dai_get_drvdata(dai);
@@ -476,6 +510,7 @@ static const struct snd_soc_dai_ops dw_i2s_dai_ops = {
        .trigger        = dw_i2s_trigger,
        .set_fmt        = dw_i2s_set_fmt,
        .set_tdm_slot   = dw_i2s_set_tdm_slot,
+       .set_bclk_ratio = dw_i2s_set_bclk_ratio,
 };
 
 #ifdef CONFIG_PM