|
@@ -245,8 +245,34 @@ static int rockchip_i2s_hw_params(struct snd_pcm_substream *substream,
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
- regmap_update_bits(i2s->regmap, I2S_TXCR, I2S_TXCR_VDW_MASK, val);
|
|
|
- regmap_update_bits(i2s->regmap, I2S_RXCR, I2S_RXCR_VDW_MASK, val);
|
|
|
+ switch (params_channels(params)) {
|
|
|
+ case 8:
|
|
|
+ val |= I2S_CHN_8;
|
|
|
+ break;
|
|
|
+ case 6:
|
|
|
+ val |= I2S_CHN_6;
|
|
|
+ break;
|
|
|
+ case 4:
|
|
|
+ val |= I2S_CHN_4;
|
|
|
+ break;
|
|
|
+ case 2:
|
|
|
+ val |= I2S_CHN_2;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ dev_err(i2s->dev, "invalid channel: %d\n",
|
|
|
+ params_channels(params));
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (substream->stream == SNDRV_PCM_STREAM_CAPTURE)
|
|
|
+ regmap_update_bits(i2s->regmap, I2S_RXCR,
|
|
|
+ I2S_RXCR_VDW_MASK | I2S_RXCR_CSR_MASK,
|
|
|
+ val);
|
|
|
+ else
|
|
|
+ regmap_update_bits(i2s->regmap, I2S_TXCR,
|
|
|
+ I2S_TXCR_VDW_MASK | I2S_TXCR_CSR_MASK,
|
|
|
+ val);
|
|
|
+
|
|
|
regmap_update_bits(i2s->regmap, I2S_DMACR, I2S_DMACR_TDL_MASK,
|
|
|
I2S_DMACR_TDL(16));
|
|
|
regmap_update_bits(i2s->regmap, I2S_DMACR, I2S_DMACR_RDL_MASK,
|
|
@@ -415,10 +441,12 @@ static const struct regmap_config rockchip_i2s_regmap_config = {
|
|
|
|
|
|
static int rockchip_i2s_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
+ struct device_node *node = pdev->dev.of_node;
|
|
|
struct rk_i2s_dev *i2s;
|
|
|
struct resource *res;
|
|
|
void __iomem *regs;
|
|
|
int ret;
|
|
|
+ int val;
|
|
|
|
|
|
i2s = devm_kzalloc(&pdev->dev, sizeof(*i2s), GFP_KERNEL);
|
|
|
if (!i2s) {
|
|
@@ -475,6 +503,14 @@ static int rockchip_i2s_probe(struct platform_device *pdev)
|
|
|
goto err_pm_disable;
|
|
|
}
|
|
|
|
|
|
+ /* refine capture channels */
|
|
|
+ if (!of_property_read_u32(node, "rockchip,capture-channels", &val)) {
|
|
|
+ if (val >= 2 && val <= 8)
|
|
|
+ rockchip_i2s_dai.capture.channels_max = val;
|
|
|
+ else
|
|
|
+ rockchip_i2s_dai.capture.channels_max = 2;
|
|
|
+ }
|
|
|
+
|
|
|
ret = devm_snd_soc_register_component(&pdev->dev,
|
|
|
&rockchip_i2s_component,
|
|
|
&rockchip_i2s_dai, 1);
|