Commit | Line | Data |
---|---|---|
1082e270 WZ |
1 | /* |
2 | * Copyright (c) 2010 Nuvoton technology corporation. | |
3 | * | |
4 | * Wan ZongShun <mcuos.com@gmail.com> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation;version 2 of the License. | |
9 | * | |
10 | */ | |
11 | ||
12 | #include <linux/module.h> | |
13 | #include <linux/init.h> | |
14 | #include <linux/io.h> | |
15 | #include <linux/platform_device.h> | |
16 | #include <linux/slab.h> | |
17 | #include <linux/dma-mapping.h> | |
18 | ||
19 | #include <sound/core.h> | |
20 | #include <sound/pcm.h> | |
21 | #include <sound/pcm_params.h> | |
22 | #include <sound/soc.h> | |
23 | ||
24 | #include <mach/hardware.h> | |
25 | ||
019afb58 | 26 | #include "nuc900-audio.h" |
1082e270 WZ |
27 | |
28 | static const struct snd_pcm_hardware nuc900_pcm_hardware = { | |
29 | .info = SNDRV_PCM_INFO_INTERLEAVED | | |
30 | SNDRV_PCM_INFO_BLOCK_TRANSFER | | |
31 | SNDRV_PCM_INFO_MMAP | | |
32 | SNDRV_PCM_INFO_MMAP_VALID | | |
33 | SNDRV_PCM_INFO_PAUSE | | |
34 | SNDRV_PCM_INFO_RESUME, | |
1082e270 WZ |
35 | .buffer_bytes_max = 4*1024, |
36 | .period_bytes_min = 1*1024, | |
37 | .period_bytes_max = 4*1024, | |
38 | .periods_min = 1, | |
39 | .periods_max = 1024, | |
40 | }; | |
41 | ||
42 | static int nuc900_dma_hw_params(struct snd_pcm_substream *substream, | |
43 | struct snd_pcm_hw_params *params) | |
44 | { | |
fa41181f | 45 | return snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params)); |
1082e270 WZ |
46 | } |
47 | ||
fa41181f | 48 | static void nuc900_update_dma_register(struct snd_pcm_substream *substream) |
1082e270 WZ |
49 | { |
50 | struct snd_pcm_runtime *runtime = substream->runtime; | |
51 | struct nuc900_audio *nuc900_audio = runtime->private_data; | |
52 | void __iomem *mmio_addr, *mmio_len; | |
53 | ||
018334c0 | 54 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
1082e270 WZ |
55 | mmio_addr = nuc900_audio->mmio + ACTL_PDSTB; |
56 | mmio_len = nuc900_audio->mmio + ACTL_PDST_LENGTH; | |
57 | } else { | |
58 | mmio_addr = nuc900_audio->mmio + ACTL_RDSTB; | |
59 | mmio_len = nuc900_audio->mmio + ACTL_RDST_LENGTH; | |
60 | } | |
61 | ||
fa41181f LPC |
62 | AUDIO_WRITE(mmio_addr, runtime->dma_addr); |
63 | AUDIO_WRITE(mmio_len, runtime->dma_bytes); | |
1082e270 WZ |
64 | } |
65 | ||
66 | static void nuc900_dma_start(struct snd_pcm_substream *substream) | |
67 | { | |
68 | struct snd_pcm_runtime *runtime = substream->runtime; | |
69 | struct nuc900_audio *nuc900_audio = runtime->private_data; | |
70 | unsigned long val; | |
71 | ||
72 | val = AUDIO_READ(nuc900_audio->mmio + ACTL_CON); | |
73 | val |= (T_DMA_IRQ | R_DMA_IRQ); | |
74 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_CON, val); | |
75 | } | |
76 | ||
77 | static void nuc900_dma_stop(struct snd_pcm_substream *substream) | |
78 | { | |
79 | struct snd_pcm_runtime *runtime = substream->runtime; | |
80 | struct nuc900_audio *nuc900_audio = runtime->private_data; | |
81 | unsigned long val; | |
82 | ||
83 | val = AUDIO_READ(nuc900_audio->mmio + ACTL_CON); | |
84 | val &= ~(T_DMA_IRQ | R_DMA_IRQ); | |
85 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_CON, val); | |
86 | } | |
87 | ||
88 | static irqreturn_t nuc900_dma_interrupt(int irq, void *dev_id) | |
89 | { | |
90 | struct snd_pcm_substream *substream = dev_id; | |
91 | struct nuc900_audio *nuc900_audio = substream->runtime->private_data; | |
92 | unsigned long val; | |
93 | ||
94 | spin_lock(&nuc900_audio->lock); | |
95 | ||
96 | val = AUDIO_READ(nuc900_audio->mmio + ACTL_CON); | |
97 | ||
98 | if (val & R_DMA_IRQ) { | |
99 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_CON, val | R_DMA_IRQ); | |
100 | ||
101 | val = AUDIO_READ(nuc900_audio->mmio + ACTL_RSR); | |
102 | ||
103 | if (val & R_DMA_MIDDLE_IRQ) { | |
104 | val |= R_DMA_MIDDLE_IRQ; | |
105 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_RSR, val); | |
106 | } | |
107 | ||
108 | if (val & R_DMA_END_IRQ) { | |
109 | val |= R_DMA_END_IRQ; | |
110 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_RSR, val); | |
111 | } | |
112 | } else if (val & T_DMA_IRQ) { | |
113 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_CON, val | T_DMA_IRQ); | |
114 | ||
115 | val = AUDIO_READ(nuc900_audio->mmio + ACTL_PSR); | |
116 | ||
117 | if (val & P_DMA_MIDDLE_IRQ) { | |
118 | val |= P_DMA_MIDDLE_IRQ; | |
119 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_PSR, val); | |
120 | } | |
121 | ||
122 | if (val & P_DMA_END_IRQ) { | |
123 | val |= P_DMA_END_IRQ; | |
124 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_PSR, val); | |
125 | } | |
126 | } else { | |
127 | dev_err(nuc900_audio->dev, "Wrong DMA interrupt status!\n"); | |
128 | spin_unlock(&nuc900_audio->lock); | |
129 | return IRQ_HANDLED; | |
130 | } | |
131 | ||
132 | spin_unlock(&nuc900_audio->lock); | |
133 | ||
134 | snd_pcm_period_elapsed(substream); | |
135 | ||
136 | return IRQ_HANDLED; | |
137 | } | |
138 | ||
139 | static int nuc900_dma_hw_free(struct snd_pcm_substream *substream) | |
140 | { | |
141 | snd_pcm_lib_free_pages(substream); | |
142 | return 0; | |
143 | } | |
144 | ||
145 | static int nuc900_dma_prepare(struct snd_pcm_substream *substream) | |
146 | { | |
147 | struct snd_pcm_runtime *runtime = substream->runtime; | |
148 | struct nuc900_audio *nuc900_audio = runtime->private_data; | |
018334c0 | 149 | unsigned long flags, val; |
3f1af9d2 | 150 | int ret = 0; |
1082e270 WZ |
151 | |
152 | spin_lock_irqsave(&nuc900_audio->lock, flags); | |
153 | ||
fa41181f | 154 | nuc900_update_dma_register(substream); |
1082e270 WZ |
155 | |
156 | val = AUDIO_READ(nuc900_audio->mmio + ACTL_RESET); | |
157 | ||
158 | switch (runtime->channels) { | |
159 | case 1: | |
018334c0 | 160 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
1082e270 WZ |
161 | val &= ~(PLAY_LEFT_CHNNEL | PLAY_RIGHT_CHNNEL); |
162 | val |= PLAY_RIGHT_CHNNEL; | |
163 | } else { | |
164 | val &= ~(RECORD_LEFT_CHNNEL | RECORD_RIGHT_CHNNEL); | |
165 | val |= RECORD_RIGHT_CHNNEL; | |
166 | } | |
167 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val); | |
168 | break; | |
169 | case 2: | |
018334c0 | 170 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
1082e270 WZ |
171 | val |= (PLAY_LEFT_CHNNEL | PLAY_RIGHT_CHNNEL); |
172 | else | |
173 | val |= (RECORD_LEFT_CHNNEL | RECORD_RIGHT_CHNNEL); | |
174 | AUDIO_WRITE(nuc900_audio->mmio + ACTL_RESET, val); | |
175 | break; | |
176 | default: | |
3f1af9d2 | 177 | ret = -EINVAL; |
1082e270 WZ |
178 | } |
179 | spin_unlock_irqrestore(&nuc900_audio->lock, flags); | |
3f1af9d2 | 180 | return ret; |
1082e270 WZ |
181 | } |
182 | ||
183 | static int nuc900_dma_trigger(struct snd_pcm_substream *substream, int cmd) | |
184 | { | |
185 | int ret = 0; | |
186 | ||
187 | switch (cmd) { | |
188 | case SNDRV_PCM_TRIGGER_START: | |
189 | case SNDRV_PCM_TRIGGER_RESUME: | |
190 | nuc900_dma_start(substream); | |
191 | break; | |
192 | ||
193 | case SNDRV_PCM_TRIGGER_STOP: | |
194 | case SNDRV_PCM_TRIGGER_SUSPEND: | |
195 | nuc900_dma_stop(substream); | |
196 | break; | |
197 | ||
198 | default: | |
199 | ret = -EINVAL; | |
200 | break; | |
201 | } | |
202 | ||
203 | return ret; | |
204 | } | |
205 | ||
49acf73b | 206 | static int nuc900_dma_getposition(struct snd_pcm_substream *substream, |
1082e270 WZ |
207 | dma_addr_t *src, dma_addr_t *dst) |
208 | { | |
209 | struct snd_pcm_runtime *runtime = substream->runtime; | |
210 | struct nuc900_audio *nuc900_audio = runtime->private_data; | |
211 | ||
212 | if (src != NULL) | |
213 | *src = AUDIO_READ(nuc900_audio->mmio + ACTL_PDSTC); | |
214 | ||
215 | if (dst != NULL) | |
216 | *dst = AUDIO_READ(nuc900_audio->mmio + ACTL_RDSTC); | |
217 | ||
218 | return 0; | |
219 | } | |
220 | ||
221 | static snd_pcm_uframes_t nuc900_dma_pointer(struct snd_pcm_substream *substream) | |
222 | { | |
223 | struct snd_pcm_runtime *runtime = substream->runtime; | |
224 | dma_addr_t src, dst; | |
225 | unsigned long res; | |
226 | ||
227 | nuc900_dma_getposition(substream, &src, &dst); | |
228 | ||
229 | if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) | |
230 | res = dst - runtime->dma_addr; | |
231 | else | |
232 | res = src - runtime->dma_addr; | |
233 | ||
234 | return bytes_to_frames(substream->runtime, res); | |
235 | } | |
236 | ||
237 | static int nuc900_dma_open(struct snd_pcm_substream *substream) | |
238 | { | |
239 | struct snd_pcm_runtime *runtime = substream->runtime; | |
240 | struct nuc900_audio *nuc900_audio; | |
241 | ||
242 | snd_soc_set_runtime_hwparams(substream, &nuc900_pcm_hardware); | |
243 | ||
244 | nuc900_audio = nuc900_ac97_data; | |
245 | ||
246 | if (request_irq(nuc900_audio->irq_num, nuc900_dma_interrupt, | |
88e24c3a | 247 | 0, "nuc900-dma", substream)) |
1082e270 WZ |
248 | return -EBUSY; |
249 | ||
250 | runtime->private_data = nuc900_audio; | |
251 | ||
252 | return 0; | |
253 | } | |
254 | ||
255 | static int nuc900_dma_close(struct snd_pcm_substream *substream) | |
256 | { | |
257 | struct snd_pcm_runtime *runtime = substream->runtime; | |
258 | struct nuc900_audio *nuc900_audio = runtime->private_data; | |
259 | ||
260 | free_irq(nuc900_audio->irq_num, substream); | |
261 | ||
262 | return 0; | |
263 | } | |
264 | ||
265 | static int nuc900_dma_mmap(struct snd_pcm_substream *substream, | |
266 | struct vm_area_struct *vma) | |
267 | { | |
268 | struct snd_pcm_runtime *runtime = substream->runtime; | |
269 | ||
f6e45661 LR |
270 | return dma_mmap_wc(substream->pcm->card->dev, vma, runtime->dma_area, |
271 | runtime->dma_addr, runtime->dma_bytes); | |
1082e270 WZ |
272 | } |
273 | ||
274 | static struct snd_pcm_ops nuc900_dma_ops = { | |
275 | .open = nuc900_dma_open, | |
276 | .close = nuc900_dma_close, | |
277 | .ioctl = snd_pcm_lib_ioctl, | |
278 | .hw_params = nuc900_dma_hw_params, | |
279 | .hw_free = nuc900_dma_hw_free, | |
280 | .prepare = nuc900_dma_prepare, | |
281 | .trigger = nuc900_dma_trigger, | |
282 | .pointer = nuc900_dma_pointer, | |
283 | .mmap = nuc900_dma_mmap, | |
284 | }; | |
285 | ||
552d1ef6 | 286 | static int nuc900_dma_new(struct snd_soc_pcm_runtime *rtd) |
1082e270 | 287 | { |
552d1ef6 | 288 | struct snd_card *card = rtd->card->snd_card; |
552d1ef6 | 289 | struct snd_pcm *pcm = rtd->pcm; |
c9bd5e69 | 290 | int ret; |
552d1ef6 | 291 | |
c9bd5e69 RK |
292 | ret = dma_coerce_mask_and_coherent(card->dev, DMA_BIT_MASK(32)); |
293 | if (ret) | |
294 | return ret; | |
1082e270 WZ |
295 | |
296 | snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV, | |
297 | card->dev, 4 * 1024, (4 * 1024) - 1); | |
298 | ||
299 | return 0; | |
300 | } | |
301 | ||
f0fba2ad LG |
302 | static struct snd_soc_platform_driver nuc900_soc_platform = { |
303 | .ops = &nuc900_dma_ops, | |
1082e270 | 304 | .pcm_new = nuc900_dma_new, |
a7a9820b | 305 | }; |
1082e270 | 306 | |
ce69ace5 | 307 | static int nuc900_soc_platform_probe(struct platform_device *pdev) |
1082e270 | 308 | { |
d5f1117f | 309 | return devm_snd_soc_register_platform(&pdev->dev, &nuc900_soc_platform); |
1082e270 WZ |
310 | } |
311 | ||
f0fba2ad LG |
312 | static struct platform_driver nuc900_pcm_driver = { |
313 | .driver = { | |
314 | .name = "nuc900-pcm-audio", | |
f0fba2ad LG |
315 | }, |
316 | ||
317 | .probe = nuc900_soc_platform_probe, | |
f0fba2ad LG |
318 | }; |
319 | ||
d0efa6a2 | 320 | module_platform_driver(nuc900_pcm_driver); |
1082e270 WZ |
321 | |
322 | MODULE_AUTHOR("Wan ZongShun, <mcuos.com@gmail.com>"); | |
323 | MODULE_DESCRIPTION("nuc900 Audio DMA module"); | |
324 | MODULE_LICENSE("GPL"); |