vidcaudio.c revision 1.18 1 1.18 bjh21 /* $NetBSD: vidcaudio.c,v 1.18 2003/12/29 16:20:46 bjh21 Exp $ */
2 1.1 reinoud
3 1.1 reinoud /*
4 1.1 reinoud * Copyright (c) 1995 Melvin Tang-Richardson
5 1.1 reinoud *
6 1.1 reinoud * Redistribution and use in source and binary forms, with or without
7 1.1 reinoud * modification, are permitted provided that the following conditions
8 1.1 reinoud * are met:
9 1.1 reinoud * 1. Redistributions of source code must retain the above copyright
10 1.1 reinoud * notice, this list of conditions and the following disclaimer.
11 1.1 reinoud * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 reinoud * notice, this list of conditions and the following disclaimer in the
13 1.1 reinoud * documentation and/or other materials provided with the distribution.
14 1.1 reinoud * 3. All advertising materials mentioning features or use of this software
15 1.1 reinoud * must display the following acknowledgement:
16 1.1 reinoud * This product includes software developed by the RiscBSD team.
17 1.1 reinoud * 4. The name of the author may not be used to endorse or promote products
18 1.1 reinoud * derived from this software without specific prior written permission.
19 1.1 reinoud *
20 1.1 reinoud * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.1 reinoud * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.1 reinoud * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.1 reinoud * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.1 reinoud * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.1 reinoud * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.1 reinoud * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.1 reinoud * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.1 reinoud * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.1 reinoud * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.1 reinoud */
31 1.1 reinoud
32 1.1 reinoud /*
33 1.1 reinoud * audio driver for the RiscPC 16 bit sound
34 1.1 reinoud *
35 1.1 reinoud * Interfaces with the NetBSD generic audio driver to provide SUN
36 1.1 reinoud * /dev/audio (partial) compatibility.
37 1.1 reinoud */
38 1.1 reinoud
39 1.1 reinoud #include <sys/param.h> /* proc.h */
40 1.5 bjh21
41 1.18 bjh21 __KERNEL_RCSID(0, "$NetBSD: vidcaudio.c,v 1.18 2003/12/29 16:20:46 bjh21 Exp $");
42 1.5 bjh21
43 1.18 bjh21 #include <sys/audioio.h>
44 1.1 reinoud #include <sys/conf.h> /* autoconfig functions */
45 1.1 reinoud #include <sys/device.h> /* device calls */
46 1.18 bjh21 #include <sys/errno.h>
47 1.1 reinoud #include <sys/proc.h> /* device calls */
48 1.1 reinoud #include <sys/systm.h>
49 1.1 reinoud
50 1.1 reinoud #include <uvm/uvm_extern.h>
51 1.1 reinoud
52 1.1 reinoud #include <dev/audio_if.h>
53 1.1 reinoud
54 1.4 thorpej #include <machine/intr.h>
55 1.3 thorpej #include <arm/arm32/katelib.h>
56 1.1 reinoud
57 1.5 bjh21 #include <arm/iomd/vidcaudiovar.h>
58 1.1 reinoud #include <arm/iomd/iomdreg.h>
59 1.1 reinoud #include <arm/iomd/iomdvar.h>
60 1.1 reinoud #include <arm/iomd/vidc.h>
61 1.1 reinoud #include <arm/mainbus/mainbus.h>
62 1.1 reinoud #include <arm/iomd/waveform.h>
63 1.1 reinoud #include "vidcaudio.h"
64 1.1 reinoud
65 1.1 reinoud extern int *vidc_base;
66 1.1 reinoud
67 1.1 reinoud #undef DEBUG
68 1.1 reinoud
69 1.1 reinoud struct audio_general {
70 1.18 bjh21 vaddr_t silence;
71 1.18 bjh21 irqhandler_t ih;
72 1.1 reinoud
73 1.18 bjh21 void (*intr)(void *);
74 1.18 bjh21 void *arg;
75 1.1 reinoud
76 1.18 bjh21 paddr_t next_cur;
77 1.18 bjh21 paddr_t next_end;
78 1.18 bjh21 void (*next_intr)(void *);
79 1.18 bjh21 void *next_arg;
80 1.1 reinoud
81 1.18 bjh21 int buffer;
82 1.18 bjh21 int in_progress;
83 1.1 reinoud
84 1.18 bjh21 int open;
85 1.1 reinoud } ag;
86 1.1 reinoud
87 1.1 reinoud struct vidcaudio_softc {
88 1.18 bjh21 struct device device;
89 1.1 reinoud
90 1.18 bjh21 int open;
91 1.1 reinoud };
92 1.1 reinoud
93 1.18 bjh21 int vidcaudio_probe(struct device *, struct cfdata *, void *);
94 1.18 bjh21 void vidcaudio_attach(struct device *, struct device *, void *);
95 1.18 bjh21 int vidcaudio_open(void *, int);
96 1.18 bjh21 void vidcaudio_close(void *);
97 1.18 bjh21
98 1.18 bjh21 int vidcaudio_intr(void *);
99 1.18 bjh21 int vidcaudio_dma_program(vaddr_t, vaddr_t, void (*)(void *), void *);
100 1.18 bjh21 void vidcaudio_dummy_routine(void *);
101 1.18 bjh21 int vidcaudio_stereo(int, int);
102 1.18 bjh21 int vidcaudio_rate(int);
103 1.17 bjh21 void vidcaudio_shutdown(void);
104 1.1 reinoud
105 1.1 reinoud static int sound_dma_intr;
106 1.1 reinoud
107 1.12 thorpej CFATTACH_DECL(vidcaudio, sizeof(struct vidcaudio_softc),
108 1.13 thorpej vidcaudio_probe, vidcaudio_attach, NULL, NULL);
109 1.1 reinoud
110 1.17 bjh21 int vidcaudio_query_encoding(void *, struct audio_encoding *);
111 1.18 bjh21 int vidcaudio_set_params(void *, int, int, struct audio_params *,
112 1.18 bjh21 struct audio_params *);
113 1.17 bjh21 int vidcaudio_round_blocksize(void *, int);
114 1.17 bjh21 int vidcaudio_start_output(void *, void *, int, void (*)(void *), void *);
115 1.17 bjh21 int vidcaudio_start_input(void *, void *, int, void (*)(void *), void *);
116 1.17 bjh21 int vidcaudio_halt_output(void *);
117 1.17 bjh21 int vidcaudio_halt_input(void *);
118 1.17 bjh21 int vidcaudio_speaker_ctl(void *, int);
119 1.17 bjh21 int vidcaudio_getdev(void *, struct audio_device *);
120 1.17 bjh21 int vidcaudio_set_port(void *, mixer_ctrl_t *);
121 1.17 bjh21 int vidcaudio_get_port(void *, mixer_ctrl_t *);
122 1.17 bjh21 int vidcaudio_query_devinfo(void *, mixer_devinfo_t *);
123 1.17 bjh21 int vidcaudio_get_props(void *);
124 1.1 reinoud
125 1.1 reinoud struct audio_device vidcaudio_device = {
126 1.1 reinoud "VidcAudio 8-bit",
127 1.1 reinoud "x",
128 1.1 reinoud "vidcaudio"
129 1.1 reinoud };
130 1.1 reinoud
131 1.1 reinoud struct audio_hw_if vidcaudio_hw_if = {
132 1.1 reinoud vidcaudio_open,
133 1.1 reinoud vidcaudio_close,
134 1.1 reinoud 0,
135 1.1 reinoud vidcaudio_query_encoding,
136 1.1 reinoud vidcaudio_set_params,
137 1.1 reinoud vidcaudio_round_blocksize,
138 1.1 reinoud 0,
139 1.1 reinoud 0,
140 1.1 reinoud 0,
141 1.1 reinoud vidcaudio_start_output,
142 1.1 reinoud vidcaudio_start_input,
143 1.1 reinoud vidcaudio_halt_output,
144 1.1 reinoud vidcaudio_halt_input,
145 1.1 reinoud vidcaudio_speaker_ctl,
146 1.1 reinoud vidcaudio_getdev,
147 1.1 reinoud 0,
148 1.1 reinoud vidcaudio_set_port,
149 1.1 reinoud vidcaudio_get_port,
150 1.1 reinoud vidcaudio_query_devinfo,
151 1.1 reinoud 0,
152 1.1 reinoud 0,
153 1.1 reinoud 0,
154 1.1 reinoud 0,
155 1.1 reinoud vidcaudio_get_props,
156 1.1 reinoud 0,
157 1.1 reinoud 0,
158 1.1 reinoud 0,
159 1.1 reinoud };
160 1.1 reinoud
161 1.1 reinoud
162 1.1 reinoud void
163 1.17 bjh21 vidcaudio_beep_generate(void)
164 1.1 reinoud {
165 1.18 bjh21
166 1.1 reinoud vidcaudio_dma_program(ag.silence, ag.silence+sizeof(beep_waveform)-16,
167 1.1 reinoud vidcaudio_dummy_routine, NULL);
168 1.1 reinoud }
169 1.1 reinoud
170 1.1 reinoud
171 1.1 reinoud int
172 1.17 bjh21 vidcaudio_probe(struct device *parent, struct cfdata *cf, void *aux)
173 1.1 reinoud {
174 1.1 reinoud int id;
175 1.1 reinoud
176 1.1 reinoud id = IOMD_ID;
177 1.1 reinoud
178 1.1 reinoud /* So far I only know about this IOMD */
179 1.1 reinoud switch (id) {
180 1.1 reinoud case RPC600_IOMD_ID:
181 1.18 bjh21 return 1;
182 1.1 reinoud break;
183 1.1 reinoud case ARM7500_IOC_ID:
184 1.1 reinoud case ARM7500FE_IOC_ID:
185 1.18 bjh21 return 1;
186 1.1 reinoud break;
187 1.1 reinoud default:
188 1.1 reinoud printf("vidcaudio: Unknown IOMD id=%04x", id);
189 1.1 reinoud break;
190 1.1 reinoud }
191 1.1 reinoud
192 1.18 bjh21 return 0;
193 1.1 reinoud }
194 1.1 reinoud
195 1.1 reinoud
196 1.1 reinoud void
197 1.17 bjh21 vidcaudio_attach(struct device *parent, struct device *self, void *aux)
198 1.1 reinoud {
199 1.1 reinoud struct vidcaudio_softc *sc = (void *)self;
200 1.1 reinoud int id;
201 1.1 reinoud
202 1.1 reinoud sc->open = 0;
203 1.1 reinoud ag.in_progress = 0;
204 1.1 reinoud
205 1.1 reinoud ag.next_cur = 0;
206 1.1 reinoud ag.next_end = 0;
207 1.1 reinoud ag.next_intr = NULL;
208 1.1 reinoud ag.next_arg = NULL;
209 1.1 reinoud
210 1.18 bjh21 vidcaudio_rate(32); /* 24*1024 */
211 1.1 reinoud
212 1.1 reinoud /* Program the silence buffer and reset the DMA channel */
213 1.14 thorpej ag.silence = uvm_km_alloc(kernel_map, PAGE_SIZE);
214 1.15 jdolecek if (ag.silence == 0)
215 1.10 provos panic("vidcaudio: Cannot allocate memory");
216 1.1 reinoud
217 1.14 thorpej memset((char *)ag.silence, 0, PAGE_SIZE);
218 1.1 reinoud memcpy((char *)ag.silence, (char *)beep_waveform, sizeof(beep_waveform));
219 1.1 reinoud
220 1.1 reinoud ag.buffer = 0;
221 1.1 reinoud
222 1.1 reinoud /* Install the irq handler for the DMA interrupt */
223 1.1 reinoud ag.ih.ih_func = vidcaudio_intr;
224 1.1 reinoud ag.ih.ih_arg = NULL;
225 1.1 reinoud ag.ih.ih_level = IPL_AUDIO;
226 1.1 reinoud ag.ih.ih_name = "vidcaudio";
227 1.1 reinoud
228 1.1 reinoud ag.intr = NULL;
229 1.1 reinoud /* ag.nextintr = NULL;*/
230 1.1 reinoud
231 1.1 reinoud id = IOMD_ID;
232 1.1 reinoud
233 1.1 reinoud switch (id) {
234 1.1 reinoud case RPC600_IOMD_ID:
235 1.1 reinoud sound_dma_intr = IRQ_DMASCH0;
236 1.1 reinoud break;
237 1.1 reinoud case ARM7500_IOC_ID:
238 1.1 reinoud case ARM7500FE_IOC_ID:
239 1.1 reinoud sound_dma_intr = IRQ_SDMA;
240 1.1 reinoud break;
241 1.1 reinoud }
242 1.1 reinoud
243 1.1 reinoud disable_irq(sound_dma_intr);
244 1.1 reinoud
245 1.1 reinoud if (irq_claim(sound_dma_intr, &(ag.ih)))
246 1.10 provos panic("vidcaudio: couldn't claim IRQ %d", sound_dma_intr);
247 1.1 reinoud
248 1.1 reinoud disable_irq(sound_dma_intr);
249 1.1 reinoud
250 1.1 reinoud printf("\n");
251 1.1 reinoud
252 1.14 thorpej vidcaudio_dma_program(ag.silence, ag.silence+PAGE_SIZE-16,
253 1.1 reinoud vidcaudio_dummy_routine, NULL);
254 1.1 reinoud
255 1.1 reinoud audio_attach_mi(&vidcaudio_hw_if, sc, &sc->device);
256 1.1 reinoud
257 1.1 reinoud #ifdef DEBUG
258 1.1 reinoud printf(" UNDER DEVELOPMENT (nuts)\n");
259 1.1 reinoud #endif
260 1.1 reinoud }
261 1.1 reinoud
262 1.1 reinoud int
263 1.17 bjh21 vidcaudio_open(void *addr, int flags)
264 1.1 reinoud {
265 1.1 reinoud struct vidcaudio_softc *sc = addr;
266 1.1 reinoud
267 1.1 reinoud #ifdef DEBUG
268 1.1 reinoud printf("DEBUG: vidcaudio_open called\n");
269 1.1 reinoud #endif
270 1.1 reinoud
271 1.1 reinoud if (sc->open)
272 1.1 reinoud return EBUSY;
273 1.1 reinoud
274 1.1 reinoud sc->open = 1;
275 1.1 reinoud ag.open = 1;
276 1.1 reinoud
277 1.1 reinoud return 0;
278 1.1 reinoud }
279 1.1 reinoud
280 1.1 reinoud void
281 1.17 bjh21 vidcaudio_close(void *addr)
282 1.1 reinoud {
283 1.1 reinoud struct vidcaudio_softc *sc = addr;
284 1.1 reinoud
285 1.1 reinoud vidcaudio_shutdown();
286 1.1 reinoud
287 1.1 reinoud #ifdef DEBUG
288 1.1 reinoud printf("DEBUG: vidcaudio_close called\n");
289 1.1 reinoud #endif
290 1.1 reinoud
291 1.1 reinoud sc->open = 0;
292 1.1 reinoud ag.open = 0;
293 1.1 reinoud }
294 1.1 reinoud
295 1.18 bjh21 /*
296 1.18 bjh21 * Interface to the generic audio driver
297 1.18 bjh21 */
298 1.1 reinoud
299 1.1 reinoud int
300 1.17 bjh21 vidcaudio_query_encoding(void *addr, struct audio_encoding *fp)
301 1.1 reinoud {
302 1.18 bjh21
303 1.1 reinoud switch (fp->index) {
304 1.1 reinoud case 0:
305 1.1 reinoud strcpy(fp->name, "vidc");
306 1.1 reinoud fp->encoding = AUDIO_ENCODING_ULAW;
307 1.1 reinoud fp->precision = 8;
308 1.1 reinoud fp->flags = 0;
309 1.1 reinoud break;
310 1.1 reinoud
311 1.1 reinoud default:
312 1.18 bjh21 return EINVAL;
313 1.1 reinoud }
314 1.1 reinoud return 0;
315 1.1 reinoud }
316 1.1 reinoud
317 1.1 reinoud int
318 1.17 bjh21 vidcaudio_set_params(void *addr, int setmode, int usemode,
319 1.17 bjh21 struct audio_params *p, struct audio_params *r)
320 1.1 reinoud {
321 1.18 bjh21
322 1.16 bjh21 if (p->encoding != AUDIO_ENCODING_ULAW)
323 1.1 reinoud return EINVAL;
324 1.16 bjh21 /* FIXME Handle number of channels properly. */
325 1.1 reinoud vidcaudio_rate(4 * p->sample_rate / (3 * 1024)); /* XXX probably wrong */
326 1.1 reinoud
327 1.1 reinoud return 0;
328 1.1 reinoud }
329 1.1 reinoud
330 1.1 reinoud int
331 1.17 bjh21 vidcaudio_round_blocksize(void *addr, int blk)
332 1.1 reinoud {
333 1.18 bjh21
334 1.14 thorpej if (blk > PAGE_SIZE)
335 1.14 thorpej blk = PAGE_SIZE;
336 1.1 reinoud return (blk);
337 1.1 reinoud }
338 1.1 reinoud
339 1.14 thorpej #define ROUND(s) ( ((int)s) & (~(PAGE_SIZE-1)) )
340 1.1 reinoud
341 1.1 reinoud int
342 1.17 bjh21 vidcaudio_start_output(void *addr, void *p, int cc, void (*intr)(void *),
343 1.17 bjh21 void *arg)
344 1.1 reinoud {
345 1.18 bjh21
346 1.1 reinoud /* I can only DMA inside 1 page */
347 1.1 reinoud
348 1.1 reinoud #ifdef DEBUG
349 1.1 reinoud printf("vidcaudio_start_output (%d) %08x %08x\n", cc, intr, arg);
350 1.1 reinoud #endif
351 1.1 reinoud
352 1.1 reinoud if (ROUND(p) != ROUND(p+cc)) {
353 1.1 reinoud /*
354 1.1 reinoud * If it's over a page I can fix it up by copying it into
355 1.1 reinoud * my buffer
356 1.1 reinoud */
357 1.1 reinoud
358 1.1 reinoud #ifdef DEBUG
359 1.1 reinoud printf("vidcaudio: DMA over page boundary requested."
360 1.1 reinoud " Fixing up\n");
361 1.1 reinoud #endif
362 1.14 thorpej memcpy(p, (char *)ag.silence, cc > PAGE_SIZE ? PAGE_SIZE : cc);
363 1.1 reinoud p = (void *)ag.silence;
364 1.1 reinoud
365 1.1 reinoud /*
366 1.1 reinoud * I can't DMA any more than that, but it is possible to
367 1.1 reinoud * fix it up by handling multiple buffers and only
368 1.1 reinoud * interrupting the audio driver after sending out all the
369 1.1 reinoud * stuff it gave me. That it more than I can be bothered
370 1.1 reinoud * to do right now and it probablly wont happen so I'll just
371 1.1 reinoud * truncate the buffer and tell the user.
372 1.1 reinoud */
373 1.1 reinoud
374 1.14 thorpej if (cc > PAGE_SIZE) {
375 1.1 reinoud printf("vidcaudio: DMA buffer truncated. I could fix this up\n");
376 1.14 thorpej cc = PAGE_SIZE;
377 1.1 reinoud }
378 1.1 reinoud }
379 1.8 thorpej vidcaudio_dma_program((vaddr_t)p, (vaddr_t)((char *)p+cc),
380 1.1 reinoud intr, arg);
381 1.1 reinoud return 0;
382 1.1 reinoud }
383 1.1 reinoud
384 1.1 reinoud int
385 1.17 bjh21 vidcaudio_start_input(void *addr, void *p, int cc, void (*intr)(void *),
386 1.17 bjh21 void *arg)
387 1.1 reinoud {
388 1.1 reinoud return EIO;
389 1.1 reinoud }
390 1.1 reinoud
391 1.1 reinoud int
392 1.17 bjh21 vidcaudio_halt_output(void *addr)
393 1.1 reinoud {
394 1.18 bjh21
395 1.1 reinoud #ifdef DEBUG
396 1.1 reinoud printf("DEBUG: vidcaudio_halt_output\n");
397 1.1 reinoud #endif
398 1.1 reinoud return EIO;
399 1.1 reinoud }
400 1.1 reinoud
401 1.1 reinoud int
402 1.17 bjh21 vidcaudio_halt_input(void *addr)
403 1.1 reinoud {
404 1.18 bjh21
405 1.1 reinoud #ifdef DEBUG
406 1.1 reinoud printf("DEBUG: vidcaudio_halt_input\n");
407 1.1 reinoud #endif
408 1.1 reinoud return EIO;
409 1.1 reinoud }
410 1.1 reinoud
411 1.1 reinoud int
412 1.17 bjh21 vidcaudio_speaker_ctl(void *addr, int newstate)
413 1.1 reinoud {
414 1.18 bjh21
415 1.1 reinoud #ifdef DEBUG
416 1.1 reinoud printf("DEBUG: vidcaudio_speaker_ctl\n");
417 1.1 reinoud #endif
418 1.1 reinoud return 0;
419 1.1 reinoud }
420 1.1 reinoud
421 1.1 reinoud int
422 1.17 bjh21 vidcaudio_getdev(void *addr, struct audio_device *retp)
423 1.1 reinoud {
424 1.18 bjh21
425 1.1 reinoud *retp = vidcaudio_device;
426 1.1 reinoud return 0;
427 1.1 reinoud }
428 1.1 reinoud
429 1.1 reinoud
430 1.1 reinoud int
431 1.17 bjh21 vidcaudio_set_port(void *addr, mixer_ctrl_t *cp)
432 1.1 reinoud {
433 1.18 bjh21
434 1.1 reinoud return EINVAL;
435 1.1 reinoud }
436 1.1 reinoud
437 1.1 reinoud int
438 1.17 bjh21 vidcaudio_get_port(void *addr, mixer_ctrl_t *cp)
439 1.1 reinoud {
440 1.18 bjh21
441 1.1 reinoud return EINVAL;
442 1.1 reinoud }
443 1.1 reinoud
444 1.1 reinoud int
445 1.17 bjh21 vidcaudio_query_devinfo(void *addr, mixer_devinfo_t *dip)
446 1.1 reinoud {
447 1.18 bjh21
448 1.1 reinoud return ENXIO;
449 1.1 reinoud }
450 1.1 reinoud
451 1.1 reinoud int
452 1.17 bjh21 vidcaudio_get_props(void *addr)
453 1.1 reinoud {
454 1.18 bjh21
455 1.1 reinoud return 0;
456 1.1 reinoud }
457 1.1 reinoud void
458 1.17 bjh21 vidcaudio_dummy_routine(void *arg)
459 1.1 reinoud {
460 1.18 bjh21
461 1.1 reinoud #ifdef DEBUG
462 1.1 reinoud printf("vidcaudio_dummy_routine\n");
463 1.1 reinoud #endif
464 1.1 reinoud }
465 1.1 reinoud
466 1.1 reinoud int
467 1.17 bjh21 vidcaudio_rate(int rate)
468 1.1 reinoud {
469 1.18 bjh21
470 1.1 reinoud WriteWord(vidc_base, VIDC_SFR | rate);
471 1.1 reinoud return 0;
472 1.1 reinoud }
473 1.1 reinoud
474 1.1 reinoud int
475 1.17 bjh21 vidcaudio_stereo(int channel, int position)
476 1.1 reinoud {
477 1.18 bjh21
478 1.1 reinoud if (channel < 0) return EINVAL;
479 1.1 reinoud if (channel > 7) return EINVAL;
480 1.18 bjh21 channel = channel << 24 | VIDC_SIR0;
481 1.1 reinoud WriteWord(vidc_base, channel | position);
482 1.1 reinoud return 0;
483 1.1 reinoud }
484 1.1 reinoud
485 1.7 thorpej #define PHYS(x, y) pmap_extract(pmap_kernel(), ((x)&L2_S_FRAME), (paddr_t *)(y))
486 1.1 reinoud
487 1.1 reinoud /*
488 1.1 reinoud * Program the next buffer to be used
489 1.1 reinoud * This function must be re-entrant, maximum re-entrancy of 2
490 1.1 reinoud */
491 1.1 reinoud
492 1.1 reinoud #define FLAGS (0)
493 1.1 reinoud
494 1.1 reinoud int
495 1.17 bjh21 vidcaudio_dma_program(vaddr_t cur, vaddr_t end, void (*intr)(void *),
496 1.17 bjh21 void *arg)
497 1.1 reinoud {
498 1.1 reinoud paddr_t pa1, pa2;
499 1.1 reinoud
500 1.1 reinoud /* If there isn't a transfer in progress then start a new one */
501 1.1 reinoud if (ag.in_progress == 0) {
502 1.1 reinoud ag.buffer = 0;
503 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CR, 0x90); /* Reset State Machine */
504 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CR, 0x30); /* Reset State Machine */
505 1.1 reinoud
506 1.1 reinoud PHYS(cur, &pa1);
507 1.1 reinoud PHYS(end - 16, &pa2);
508 1.1 reinoud
509 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURB, pa1);
510 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0ENDB, pa2|FLAGS);
511 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURA, pa1);
512 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0ENDA, pa2|FLAGS);
513 1.1 reinoud
514 1.1 reinoud ag.in_progress = 1;
515 1.1 reinoud
516 1.1 reinoud ag.next_cur = ag.next_end = 0;
517 1.1 reinoud ag.next_intr = ag.next_arg = 0;
518 1.1 reinoud
519 1.1 reinoud ag.intr = intr;
520 1.1 reinoud ag.arg = arg;
521 1.1 reinoud
522 1.1 reinoud /*
523 1.1 reinoud * The driver 'clicks' between buffer swaps, leading me
524 1.1 reinoud * to think that the fifo is much small than on other
525 1.1 reinoud * sound cards so I'm going to have to do some tricks here
526 1.1 reinoud */
527 1.1 reinoud
528 1.18 bjh21 (*ag.intr)(ag.arg); /* Schedule the next buffer */
529 1.18 bjh21 ag.intr = vidcaudio_dummy_routine; /* Already done this */
530 1.1 reinoud ag.arg = NULL;
531 1.1 reinoud
532 1.1 reinoud #ifdef PRINT
533 1.1 reinoud printf("vidcaudio: start output\n");
534 1.1 reinoud #endif
535 1.1 reinoud #ifdef DEBUG
536 1.1 reinoud printf("SE");
537 1.1 reinoud #endif
538 1.1 reinoud enable_irq(sound_dma_intr);
539 1.1 reinoud } else {
540 1.1 reinoud /* Otherwise schedule the next one */
541 1.1 reinoud if (ag.next_cur != 0) {
542 1.1 reinoud /* If there's one scheduled then complain */
543 1.1 reinoud printf("vidcaudio: Buffer already Q'ed\n");
544 1.1 reinoud return EIO;
545 1.1 reinoud } else {
546 1.1 reinoud /* We're OK to schedule it now */
547 1.1 reinoud ag.buffer = (++ag.buffer) & 1;
548 1.1 reinoud PHYS(cur, &ag.next_cur);
549 1.1 reinoud PHYS(end - 16, &ag.next_end);
550 1.1 reinoud ag.next_intr = intr;
551 1.1 reinoud ag.next_arg = arg;
552 1.1 reinoud #ifdef DEBUG
553 1.1 reinoud printf("s");
554 1.1 reinoud #endif
555 1.1 reinoud }
556 1.1 reinoud }
557 1.1 reinoud return 0;
558 1.1 reinoud }
559 1.1 reinoud
560 1.1 reinoud void
561 1.1 reinoud vidcaudio_shutdown(void)
562 1.1 reinoud {
563 1.18 bjh21
564 1.1 reinoud /* Shut down the channel */
565 1.1 reinoud ag.intr = NULL;
566 1.1 reinoud ag.in_progress = 0;
567 1.1 reinoud #ifdef PRINT
568 1.1 reinoud printf("vidcaudio: stop output\n");
569 1.1 reinoud #endif
570 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURB, ag.silence);
571 1.18 bjh21 IOMD_WRITE_WORD(IOMD_SD0ENDB,
572 1.18 bjh21 (ag.silence + PAGE_SIZE - 16) | (1 << 30));
573 1.1 reinoud disable_irq(sound_dma_intr);
574 1.1 reinoud }
575 1.1 reinoud
576 1.1 reinoud int
577 1.17 bjh21 vidcaudio_intr(void *arg)
578 1.1 reinoud {
579 1.1 reinoud int status = IOMD_READ_BYTE(IOMD_SD0ST);
580 1.5 bjh21 void (*nintr)(void *);
581 1.1 reinoud void *narg;
582 1.5 bjh21 void (*xintr)(void *);
583 1.1 reinoud void *xarg;
584 1.1 reinoud int xcur, xend;
585 1.18 bjh21
586 1.1 reinoud IOMD_WRITE_WORD(IOMD_DMARQ, 0x10);
587 1.1 reinoud
588 1.1 reinoud #ifdef PRINT
589 1.1 reinoud printf ( "I" );
590 1.1 reinoud #endif
591 1.1 reinoud
592 1.1 reinoud if (ag.open == 0) {
593 1.1 reinoud vidcaudio_shutdown();
594 1.1 reinoud return 0;
595 1.1 reinoud }
596 1.1 reinoud
597 1.1 reinoud /* Have I got the generic audio device attached */
598 1.1 reinoud
599 1.1 reinoud #ifdef DEBUG
600 1.1 reinoud printf ( "[B%01x]", status );
601 1.1 reinoud #endif
602 1.1 reinoud
603 1.1 reinoud nintr = ag.intr;
604 1.1 reinoud narg = ag.arg;
605 1.1 reinoud ag.intr = NULL;
606 1.1 reinoud
607 1.1 reinoud xintr = ag.next_intr;
608 1.1 reinoud xarg = ag.next_arg;
609 1.1 reinoud xcur = ag.next_cur;
610 1.1 reinoud xend = ag.next_end;
611 1.1 reinoud ag.next_cur = 0;
612 1.1 reinoud ag.intr = xintr;
613 1.1 reinoud ag.arg = xarg;
614 1.1 reinoud
615 1.1 reinoud if (nintr) {
616 1.1 reinoud #ifdef DEBUG
617 1.1 reinoud printf("i");
618 1.1 reinoud #endif
619 1.1 reinoud (*nintr)(narg);
620 1.1 reinoud }
621 1.1 reinoud
622 1.1 reinoud if (xcur == 0) {
623 1.18 bjh21 vidcaudio_shutdown();
624 1.1 reinoud } else {
625 1.1 reinoud #define OVERRUN (0x04)
626 1.1 reinoud #define INTERRUPT (0x02)
627 1.1 reinoud #define BANK_A (0x00)
628 1.1 reinoud #define BANK_B (0x01)
629 1.1 reinoud switch (status & 0x7) {
630 1.1 reinoud case (INTERRUPT|BANK_A):
631 1.1 reinoud #ifdef PRINT
632 1.1 reinoud printf("B");
633 1.1 reinoud #endif
634 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURB, xcur);
635 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0ENDB, xend|FLAGS);
636 1.1 reinoud break;
637 1.1 reinoud
638 1.1 reinoud case (INTERRUPT|BANK_B):
639 1.1 reinoud #ifdef PRINT
640 1.1 reinoud printf("A");
641 1.1 reinoud #endif
642 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURA, xcur);
643 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0ENDA, xend|FLAGS);
644 1.1 reinoud break;
645 1.1 reinoud
646 1.1 reinoud case (OVERRUN|INTERRUPT|BANK_A):
647 1.1 reinoud #ifdef PRINT
648 1.1 reinoud printf("A");
649 1.1 reinoud #endif
650 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURA, xcur);
651 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0ENDA, xend|FLAGS);
652 1.1 reinoud break;
653 1.1 reinoud
654 1.1 reinoud case (OVERRUN|INTERRUPT|BANK_B):
655 1.1 reinoud #ifdef PRINT
656 1.1 reinoud printf("B");
657 1.1 reinoud #endif
658 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0CURB, xcur);
659 1.1 reinoud IOMD_WRITE_WORD(IOMD_SD0ENDB, xend|FLAGS);
660 1.1 reinoud break;
661 1.1 reinoud }
662 1.1 reinoud /*
663 1.1 reinoud ag.next_cur = 0;
664 1.1 reinoud ag.intr = xintr;
665 1.1 reinoud ag.arg = xarg;
666 1.1 reinoud */
667 1.1 reinoud }
668 1.1 reinoud #ifdef PRINT
669 1.1 reinoud printf ( "i" );
670 1.1 reinoud #endif
671 1.1 reinoud
672 1.1 reinoud if (ag.next_cur == 0) {
673 1.18 bjh21 (*ag.intr)(ag.arg); /* Schedule the next buffer */
674 1.18 bjh21 ag.intr = vidcaudio_dummy_routine; /* Already done this */
675 1.1 reinoud ag.arg = NULL;
676 1.1 reinoud }
677 1.18 bjh21 return 0 ; /* Pass interrupt on down the chain */
678 1.1 reinoud }
679