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