1 // SPDX-License-Identifier: GPL-2.0
3 // Common functions for loongson I2S controller driver
5 // Copyright (C) 2023 Loongson Technology Corporation Limited.
6 // Author: Yingkun Meng <mengyingkun@loongson.cn>
9 #include <linux/module.h>
10 #include <linux/platform_device.h>
11 #include <linux/delay.h>
12 #include <linux/pm_runtime.h>
13 #include <linux/dma-mapping.h>
14 #include <sound/soc.h>
15 #include <linux/regmap.h>
16 #include <sound/pcm_params.h>
17 #include "loongson_i2s.h"
19 #define LOONGSON_I2S_FORMATS (SNDRV_PCM_FMTBIT_S8 | \
20 SNDRV_PCM_FMTBIT_S16_LE | \
21 SNDRV_PCM_FMTBIT_S20_3LE | \
22 SNDRV_PCM_FMTBIT_S24_LE)
24 static int loongson_i2s_trigger(struct snd_pcm_substream *substream, int cmd,
25 struct snd_soc_dai *dai)
27 struct loongson_i2s *i2s = snd_soc_dai_get_drvdata(dai);
31 case SNDRV_PCM_TRIGGER_START:
32 case SNDRV_PCM_TRIGGER_RESUME:
33 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
34 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
35 regmap_update_bits(i2s->regmap, LS_I2S_CTRL,
36 I2S_CTRL_TX_EN | I2S_CTRL_TX_DMA_EN,
37 I2S_CTRL_TX_EN | I2S_CTRL_TX_DMA_EN);
39 regmap_update_bits(i2s->regmap, LS_I2S_CTRL,
40 I2S_CTRL_RX_EN | I2S_CTRL_RX_DMA_EN,
41 I2S_CTRL_RX_EN | I2S_CTRL_RX_DMA_EN);
43 case SNDRV_PCM_TRIGGER_STOP:
44 case SNDRV_PCM_TRIGGER_SUSPEND:
45 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
46 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
47 regmap_update_bits(i2s->regmap, LS_I2S_CTRL,
48 I2S_CTRL_TX_EN | I2S_CTRL_TX_DMA_EN, 0);
50 regmap_update_bits(i2s->regmap, LS_I2S_CTRL,
51 I2S_CTRL_RX_EN | I2S_CTRL_RX_DMA_EN, 0);
60 static int loongson_i2s_hw_params(struct snd_pcm_substream *substream,
61 struct snd_pcm_hw_params *params,
62 struct snd_soc_dai *dai)
64 struct loongson_i2s *i2s = snd_soc_dai_get_drvdata(dai);
65 u32 clk_rate = i2s->clk_rate;
66 u32 sysclk = i2s->sysclk;
67 u32 bits = params_width(params);
68 u32 chans = params_channels(params);
69 u32 fs = params_rate(params);
70 u32 bclk_ratio, mclk_ratio;
74 switch (i2s->rev_id) {
76 bclk_ratio = DIV_ROUND_CLOSEST(clk_rate,
77 (bits * chans * fs * 2)) - 1;
78 mclk_ratio = DIV_ROUND_CLOSEST(clk_rate, (sysclk * 2)) - 1;
80 /* According to 2k1000LA user manual, set bits == depth */
83 val |= (bclk_ratio << 8);
85 regmap_write(i2s->regmap, LS_I2S_CFG, val);
89 bclk_ratio = DIV_ROUND_CLOSEST(sysclk,
90 (bits * chans * fs * 2)) - 1;
91 mclk_ratio = clk_rate / sysclk;
92 mclk_ratio_frac = DIV_ROUND_CLOSEST_ULL(((u64)clk_rate << 16),
93 sysclk) - (mclk_ratio << 16);
95 regmap_read(i2s->regmap, LS_I2S_CFG, &val);
97 val |= (bclk_ratio << 8);
98 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
102 regmap_write(i2s->regmap, LS_I2S_CFG, val);
104 val = (mclk_ratio_frac << 16) | mclk_ratio;
105 regmap_write(i2s->regmap, LS_I2S_CFG1, val);
109 dev_err(i2s->dev, "I2S revision invalid\n");
116 static int loongson_i2s_set_dai_sysclk(struct snd_soc_dai *dai, int clk_id,
117 unsigned int freq, int dir)
119 struct loongson_i2s *i2s = snd_soc_dai_get_drvdata(dai);
126 static int loongson_i2s_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
128 struct loongson_i2s *i2s = snd_soc_dai_get_drvdata(dai);
132 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
133 case SND_SOC_DAIFMT_I2S:
135 case SND_SOC_DAIFMT_RIGHT_J:
136 regmap_update_bits(i2s->regmap, LS_I2S_CTRL, I2S_CTRL_MSB,
144 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
145 case SND_SOC_DAIFMT_BC_FC:
147 case SND_SOC_DAIFMT_BP_FC:
148 /* Enable master mode */
149 regmap_update_bits(i2s->regmap, LS_I2S_CTRL, I2S_CTRL_MASTER,
151 if (i2s->rev_id == 1) {
152 ret = regmap_read_poll_timeout_atomic(i2s->regmap,
154 val & I2S_CTRL_CLK_READY,
157 dev_warn(dai->dev, "wait BCLK ready timeout\n");
160 case SND_SOC_DAIFMT_BC_FP:
162 if (i2s->rev_id == 1) {
163 regmap_update_bits(i2s->regmap, LS_I2S_CTRL,
166 ret = regmap_read_poll_timeout_atomic(i2s->regmap,
168 val & I2S_CTRL_MCLK_READY,
171 dev_warn(dai->dev, "wait MCLK ready timeout\n");
174 case SND_SOC_DAIFMT_BP_FP:
176 if (i2s->rev_id == 1) {
177 regmap_update_bits(i2s->regmap, LS_I2S_CTRL,
180 ret = regmap_read_poll_timeout_atomic(i2s->regmap,
182 val & I2S_CTRL_MCLK_READY,
185 dev_warn(dai->dev, "wait MCLK ready timeout\n");
188 /* Enable master mode */
189 regmap_update_bits(i2s->regmap, LS_I2S_CTRL, I2S_CTRL_MASTER,
191 if (i2s->rev_id == 1) {
192 ret = regmap_read_poll_timeout_atomic(i2s->regmap,
194 val & I2S_CTRL_CLK_READY,
197 dev_warn(dai->dev, "wait BCLK ready timeout\n");
207 static int loongson_i2s_dai_probe(struct snd_soc_dai *cpu_dai)
209 struct loongson_i2s *i2s = dev_get_drvdata(cpu_dai->dev);
211 snd_soc_dai_init_dma_data(cpu_dai, &i2s->playback_dma_data,
212 &i2s->capture_dma_data);
213 snd_soc_dai_set_drvdata(cpu_dai, i2s);
218 static const struct snd_soc_dai_ops loongson_i2s_dai_ops = {
219 .probe = loongson_i2s_dai_probe,
220 .trigger = loongson_i2s_trigger,
221 .hw_params = loongson_i2s_hw_params,
222 .set_sysclk = loongson_i2s_set_dai_sysclk,
223 .set_fmt = loongson_i2s_set_fmt,
226 struct snd_soc_dai_driver loongson_i2s_dai = {
227 .name = "loongson-i2s",
229 .stream_name = "CPU-Playback",
232 .rates = SNDRV_PCM_RATE_8000_96000,
233 .formats = LOONGSON_I2S_FORMATS,
236 .stream_name = "CPU-Capture",
239 .rates = SNDRV_PCM_RATE_8000_96000,
240 .formats = LOONGSON_I2S_FORMATS,
242 .ops = &loongson_i2s_dai_ops,
246 static int i2s_suspend(struct device *dev)
248 struct loongson_i2s *i2s = dev_get_drvdata(dev);
250 regcache_cache_only(i2s->regmap, true);
255 static int i2s_resume(struct device *dev)
257 struct loongson_i2s *i2s = dev_get_drvdata(dev);
260 regcache_cache_only(i2s->regmap, false);
261 regcache_mark_dirty(i2s->regmap);
262 ret = regcache_sync(i2s->regmap);
267 const struct dev_pm_ops loongson_i2s_pm = {
268 SYSTEM_SLEEP_PM_OPS(i2s_suspend, i2s_resume)