1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/init.h>
24#include <linux/module.h>
25#include <linux/device.h>
26#include <linux/delay.h>
27#include <linux/slab.h>
28#include <linux/io.h>
29#include <linux/mfd/davinci_voicecodec.h>
30
31#include <sound/core.h>
32#include <sound/pcm.h>
33#include <sound/pcm_params.h>
34#include <sound/initval.h>
35#include <sound/soc.h>
36
37#include "davinci-pcm.h"
38#include "davinci-i2s.h"
39
40#define MOD_REG_BIT(val, mask, set) do { \
41 if (set) { \
42 val |= mask; \
43 } else { \
44 val &= ~mask; \
45 } \
46} while (0)
47
48struct davinci_vcif_dev {
49 struct davinci_vc *davinci_vc;
50 struct davinci_pcm_dma_params dma_params[2];
51};
52
53static void davinci_vcif_start(struct snd_pcm_substream *substream)
54{
55 struct snd_soc_pcm_runtime *rtd = substream->private_data;
56 struct davinci_vcif_dev *davinci_vcif_dev =
57 snd_soc_dai_get_drvdata(rtd->cpu_dai);
58 struct davinci_vc *davinci_vc = davinci_vcif_dev->davinci_vc;
59 u32 w;
60
61
62 w = readl(davinci_vc->base + DAVINCI_VC_CTRL);
63
64 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
65 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTDAC, 0);
66 else
67 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTADC, 0);
68
69 writel(w, davinci_vc->base + DAVINCI_VC_CTRL);
70}
71
72static void davinci_vcif_stop(struct snd_pcm_substream *substream)
73{
74 struct snd_soc_pcm_runtime *rtd = substream->private_data;
75 struct davinci_vcif_dev *davinci_vcif_dev =
76 snd_soc_dai_get_drvdata(rtd->cpu_dai);
77 struct davinci_vc *davinci_vc = davinci_vcif_dev->davinci_vc;
78 u32 w;
79
80
81 w = readl(davinci_vc->base + DAVINCI_VC_CTRL);
82 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
83 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTDAC, 1);
84 else
85 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RSTADC, 1);
86
87 writel(w, davinci_vc->base + DAVINCI_VC_CTRL);
88}
89
90static int davinci_vcif_hw_params(struct snd_pcm_substream *substream,
91 struct snd_pcm_hw_params *params,
92 struct snd_soc_dai *dai)
93{
94 struct davinci_vcif_dev *davinci_vcif_dev = snd_soc_dai_get_drvdata(dai);
95 struct davinci_vc *davinci_vc = davinci_vcif_dev->davinci_vc;
96 struct davinci_pcm_dma_params *dma_params =
97 &davinci_vcif_dev->dma_params[substream->stream];
98 u32 w;
99
100
101 davinci_vcif_stop(substream);
102 davinci_vcif_start(substream);
103
104
105 writel(DAVINCI_VC_CTRL_MASK, davinci_vc->base + DAVINCI_VC_CTRL);
106
107 writel(DAVINCI_VC_INT_MASK, davinci_vc->base + DAVINCI_VC_INTCLR);
108
109 writel(DAVINCI_VC_INT_MASK, davinci_vc->base + DAVINCI_VC_INTEN);
110
111 w = readl(davinci_vc->base + DAVINCI_VC_CTRL);
112
113
114 switch (params_format(params)) {
115 case SNDRV_PCM_FORMAT_U8:
116 dma_params->data_type = 0;
117
118 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_BITS_8 |
119 DAVINCI_VC_CTRL_RD_UNSIGNED |
120 DAVINCI_VC_CTRL_WD_BITS_8 |
121 DAVINCI_VC_CTRL_WD_UNSIGNED, 1);
122 break;
123 case SNDRV_PCM_FORMAT_S8:
124 dma_params->data_type = 1;
125
126 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_BITS_8 |
127 DAVINCI_VC_CTRL_WD_BITS_8, 1);
128
129 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_UNSIGNED |
130 DAVINCI_VC_CTRL_WD_UNSIGNED, 0);
131 break;
132 case SNDRV_PCM_FORMAT_S16_LE:
133 dma_params->data_type = 2;
134
135 MOD_REG_BIT(w, DAVINCI_VC_CTRL_RD_BITS_8 |
136 DAVINCI_VC_CTRL_RD_UNSIGNED |
137 DAVINCI_VC_CTRL_WD_BITS_8 |
138 DAVINCI_VC_CTRL_WD_UNSIGNED, 0);
139 break;
140 default:
141 printk(KERN_WARNING "davinci-vcif: unsupported PCM format");
142 return -EINVAL;
143 }
144
145 dma_params->acnt = dma_params->data_type;
146
147 writel(w, davinci_vc->base + DAVINCI_VC_CTRL);
148
149 return 0;
150}
151
152static int davinci_vcif_trigger(struct snd_pcm_substream *substream, int cmd,
153 struct snd_soc_dai *dai)
154{
155 int ret = 0;
156
157 switch (cmd) {
158 case SNDRV_PCM_TRIGGER_START:
159 case SNDRV_PCM_TRIGGER_RESUME:
160 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
161 davinci_vcif_start(substream);
162 break;
163 case SNDRV_PCM_TRIGGER_STOP:
164 case SNDRV_PCM_TRIGGER_SUSPEND:
165 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
166 davinci_vcif_stop(substream);
167 break;
168 default:
169 ret = -EINVAL;
170 }
171
172 return ret;
173}
174
175static int davinci_vcif_startup(struct snd_pcm_substream *substream,
176 struct snd_soc_dai *dai)
177{
178 struct davinci_vcif_dev *dev = snd_soc_dai_get_drvdata(dai);
179
180 snd_soc_dai_set_dma_data(dai, substream, dev->dma_params);
181 return 0;
182}
183
184#define DAVINCI_VCIF_RATES SNDRV_PCM_RATE_8000_48000
185
186static const struct snd_soc_dai_ops davinci_vcif_dai_ops = {
187 .startup = davinci_vcif_startup,
188 .trigger = davinci_vcif_trigger,
189 .hw_params = davinci_vcif_hw_params,
190};
191
192static struct snd_soc_dai_driver davinci_vcif_dai = {
193 .playback = {
194 .channels_min = 1,
195 .channels_max = 2,
196 .rates = DAVINCI_VCIF_RATES,
197 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
198 .capture = {
199 .channels_min = 1,
200 .channels_max = 2,
201 .rates = DAVINCI_VCIF_RATES,
202 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
203 .ops = &davinci_vcif_dai_ops,
204
205};
206
207static const struct snd_soc_component_driver davinci_vcif_component = {
208 .name = "davinci-vcif",
209};
210
211static int davinci_vcif_probe(struct platform_device *pdev)
212{
213 struct davinci_vc *davinci_vc = pdev->dev.platform_data;
214 struct davinci_vcif_dev *davinci_vcif_dev;
215 int ret;
216
217 davinci_vcif_dev = devm_kzalloc(&pdev->dev,
218 sizeof(struct davinci_vcif_dev),
219 GFP_KERNEL);
220 if (!davinci_vcif_dev) {
221 dev_dbg(&pdev->dev,
222 "could not allocate memory for private data\n");
223 return -ENOMEM;
224 }
225
226
227 davinci_vcif_dev->davinci_vc = davinci_vc;
228 davinci_vcif_dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK].channel =
229 davinci_vc->davinci_vcif.dma_tx_channel;
230 davinci_vcif_dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK].dma_addr =
231 davinci_vc->davinci_vcif.dma_tx_addr;
232
233
234 davinci_vcif_dev->dma_params[SNDRV_PCM_STREAM_CAPTURE].channel =
235 davinci_vc->davinci_vcif.dma_rx_channel;
236 davinci_vcif_dev->dma_params[SNDRV_PCM_STREAM_CAPTURE].dma_addr =
237 davinci_vc->davinci_vcif.dma_rx_addr;
238
239 dev_set_drvdata(&pdev->dev, davinci_vcif_dev);
240
241 ret = snd_soc_register_component(&pdev->dev, &davinci_vcif_component,
242 &davinci_vcif_dai, 1);
243 if (ret != 0) {
244 dev_err(&pdev->dev, "could not register dai\n");
245 return ret;
246 }
247
248 ret = davinci_soc_platform_register(&pdev->dev);
249 if (ret) {
250 dev_err(&pdev->dev, "register PCM failed: %d\n", ret);
251 snd_soc_unregister_component(&pdev->dev);
252 return ret;
253 }
254
255 return 0;
256}
257
258static int davinci_vcif_remove(struct platform_device *pdev)
259{
260 snd_soc_unregister_component(&pdev->dev);
261 davinci_soc_platform_unregister(&pdev->dev);
262
263 return 0;
264}
265
266static struct platform_driver davinci_vcif_driver = {
267 .probe = davinci_vcif_probe,
268 .remove = davinci_vcif_remove,
269 .driver = {
270 .name = "davinci-vcif",
271 .owner = THIS_MODULE,
272 },
273};
274
275module_platform_driver(davinci_vcif_driver);
276
277MODULE_AUTHOR("Miguel Aguilar");
278MODULE_DESCRIPTION("Texas Instruments DaVinci ASoC Voice Codec Interface");
279MODULE_LICENSE("GPL");
280
