vidcaudio.c revision 1.40.2.2 1 /* $NetBSD: vidcaudio.c,v 1.40.2.2 2005/01/05 03:31:37 kent Exp $ */
2
3 /*
4 * Copyright (c) 1995 Melvin Tang-Richardson
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. All advertising materials mentioning features or use of this software
15 * must display the following acknowledgement:
16 * This product includes software developed by the RiscBSD team.
17 * 4. The name of the author may not be used to endorse or promote products
18 * derived from this software without specific prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 /*-
33 * Copyright (c) 2003 Ben Harris
34 * All rights reserved.
35 *
36 * Redistribution and use in source and binary forms, with or without
37 * modification, are permitted provided that the following conditions
38 * are met:
39 * 1. Redistributions of source code must retain the above copyright
40 * notice, this list of conditions and the following disclaimer.
41 * 2. Redistributions in binary form must reproduce the above copyright
42 * notice, this list of conditions and the following disclaimer in the
43 * documentation and/or other materials provided with the distribution.
44 * 3. The name of the author may not be used to endorse or promote products
45 * derived from this software without specific prior written permission.
46 *
47 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
48 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
49 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
50 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
51 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
52 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
53 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
54 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
55 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
56 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
57 */
58
59 /*
60 * audio driver for the RiscPC 8/16 bit sound
61 *
62 * Interfaces with the NetBSD generic audio driver to provide SUN
63 * /dev/audio (partial) compatibility.
64 */
65
66 #include <sys/param.h> /* proc.h */
67
68 __KERNEL_RCSID(0, "$NetBSD: vidcaudio.c,v 1.40.2.2 2005/01/05 03:31:37 kent Exp $");
69
70 #include <sys/audioio.h>
71 #include <sys/conf.h> /* autoconfig functions */
72 #include <sys/device.h> /* device calls */
73 #include <sys/errno.h>
74 #include <sys/malloc.h>
75 #include <sys/proc.h> /* device calls */
76 #include <sys/systm.h>
77
78 #include <uvm/uvm_extern.h>
79
80 #include <dev/audio_if.h>
81 #include <dev/audiobellvar.h>
82 #include <dev/auconv.h>
83 #include <dev/mulaw.h>
84
85 #include <machine/intr.h>
86 #include <machine/machdep.h>
87 #include <arm/arm32/katelib.h>
88
89 #include <arm/iomd/vidcaudiovar.h>
90 #include <arm/iomd/iomdreg.h>
91 #include <arm/iomd/iomdvar.h>
92 #include <arm/iomd/vidc.h>
93 #include <arm/mainbus/mainbus.h>
94
95 #include "pckbd.h"
96 #if NPCKBD > 0
97 #include <dev/pckbport/pckbdvar.h>
98 #endif
99
100 #include "rpckbd.h"
101 #if NRPCKBD > 0
102 #include <arm/iomd/rpckbdvar.h>
103 #endif
104
105 #include "vt.h"
106 #if NVT > 0
107 extern void vt_hookup_bell(void (*)(void *, u_int, u_int, u_int, int), void *);
108 #endif
109
110 extern int *vidc_base;
111
112 #ifdef VIDCAUDIO_DEBUG
113 #define DPRINTF(x) printf x
114 #else
115 #define DPRINTF(x)
116 #endif
117
118 struct vidcaudio_softc {
119 struct device sc_dev;
120
121 irqhandler_t sc_ih;
122 int sc_dma_intr;
123
124 int sc_is16bit;
125
126 size_t sc_pblksize;
127 vm_offset_t sc_poffset;
128 vm_offset_t sc_pbufsize;
129 paddr_t *sc_ppages;
130 void (*sc_pintr)(void *);
131 void *sc_parg;
132 int sc_pcountdown;
133 };
134
135 static int vidcaudio_probe(struct device *, struct cfdata *, void *);
136 static void vidcaudio_attach(struct device *, struct device *, void *);
137 static int vidcaudio_open(void *, int);
138 static void vidcaudio_close(void *);
139
140 static int vidcaudio_intr(void *);
141 static void vidcaudio_rate(int);
142 static void vidcaudio_ctrl(int);
143 static void vidcaudio_stereo(int, int);
144 static stream_filter_factory_t mulaw_to_vidc;
145 static stream_filter_factory_t mulaw_to_vidc_stereo;
146 static int mulaw_to_vidc_fetch_to(stream_fetcher_t *, audio_stream_t *, int);
147 static int mulaw_to_vidc_stereo_fetch_to(stream_fetcher_t *,
148 audio_stream_t *, int);
149
150 CFATTACH_DECL(vidcaudio, sizeof(struct vidcaudio_softc),
151 vidcaudio_probe, vidcaudio_attach, NULL, NULL);
152
153 static int vidcaudio_query_encoding(void *, struct audio_encoding *);
154 static int vidcaudio_set_params(void *, int, int, audio_params_t *,
155 audio_params_t *, stream_filter_list_t *, stream_filter_list_t *);
156 static int vidcaudio_round_blocksize(void *, int);
157 static int vidcaudio_trigger_output(void *, void *, void *, int,
158 void (*)(void *), void *, const audio_params_t *);
159 static int vidcaudio_trigger_input(void *, void *, void *, int,
160 void (*)(void *), void *, const audio_params_t *);
161 static int vidcaudio_halt_output(void *);
162 static int vidcaudio_halt_input(void *);
163 static int vidcaudio_getdev(void *, struct audio_device *);
164 static int vidcaudio_set_port(void *, mixer_ctrl_t *);
165 static int vidcaudio_get_port(void *, mixer_ctrl_t *);
166 static int vidcaudio_query_devinfo(void *, mixer_devinfo_t *);
167 static int vidcaudio_get_props(void *);
168
169 static struct audio_device vidcaudio_device = {
170 "ARM VIDC",
171 "",
172 "vidcaudio"
173 };
174
175 static const struct audio_hw_if vidcaudio_hw_if = {
176 vidcaudio_open,
177 vidcaudio_close,
178 NULL,
179 vidcaudio_query_encoding,
180 vidcaudio_set_params,
181 vidcaudio_round_blocksize,
182 NULL,
183 NULL,
184 NULL,
185 NULL,
186 NULL,
187 vidcaudio_halt_output,
188 vidcaudio_halt_input,
189 NULL,
190 vidcaudio_getdev,
191 NULL,
192 vidcaudio_set_port,
193 vidcaudio_get_port,
194 vidcaudio_query_devinfo,
195 NULL,
196 NULL,
197 NULL,
198 NULL,
199 vidcaudio_get_props,
200 vidcaudio_trigger_output,
201 vidcaudio_trigger_input,
202 NULL,
203 };
204
205 static int
206 vidcaudio_probe(struct device *parent, struct cfdata *cf, void *aux)
207 {
208 int id;
209
210 id = IOMD_ID;
211
212 /* So far I only know about this IOMD */
213 switch (id) {
214 case RPC600_IOMD_ID:
215 case ARM7500_IOC_ID:
216 case ARM7500FE_IOC_ID:
217 return 1;
218 default:
219 aprint_error("vidcaudio: Unknown IOMD id=%04x", id);
220 return 0;
221 }
222 }
223
224
225 static void
226 vidcaudio_attach(struct device *parent, struct device *self, void *aux)
227 {
228 struct vidcaudio_softc *sc = (void *)self;
229 struct device *beepdev;
230
231 switch (IOMD_ID) {
232 #ifndef EB7500ATX
233 case RPC600_IOMD_ID:
234 sc->sc_is16bit = (cmos_read(0xc4) >> 5) & 1;
235 sc->sc_dma_intr = IRQ_DMASCH0;
236 break;
237 #endif
238 case ARM7500_IOC_ID:
239 case ARM7500FE_IOC_ID:
240 sc->sc_is16bit = TRUE;
241 sc->sc_dma_intr = IRQ_SDMA;
242 break;
243 default:
244 aprint_error(": strange IOMD\n");
245 return;
246 }
247
248 if (sc->sc_is16bit)
249 aprint_normal(": 16-bit external DAC\n");
250 else
251 aprint_normal(": 8-bit internal DAC\n");
252
253 /* Install the irq handler for the DMA interrupt */
254 sc->sc_ih.ih_func = vidcaudio_intr;
255 sc->sc_ih.ih_arg = sc;
256 sc->sc_ih.ih_level = IPL_AUDIO;
257 sc->sc_ih.ih_name = self->dv_xname;
258
259 if (irq_claim(sc->sc_dma_intr, &sc->sc_ih) != 0) {
260 aprint_error("%s: couldn't claim IRQ %d\n",
261 self->dv_xname, sc->sc_dma_intr);
262 return;
263 }
264
265 disable_irq(sc->sc_dma_intr);
266
267 beepdev = audio_attach_mi(&vidcaudio_hw_if, sc, self);
268 #if NPCKBD > 0
269 pckbd_hookup_bell(audiobell, beepdev);
270 #endif
271 #if NRPCKBD > 0
272 rpckbd_hookup_bell(audiobell, beepdev);
273 #endif
274 #if NVT > 0
275 vt_hookup_bell(audiobell, beepdev);
276 #endif
277 }
278
279 static int
280 vidcaudio_open(void *addr, int flags)
281 {
282
283 DPRINTF(("DEBUG: vidcaudio_open called\n"));
284 return 0;
285 }
286
287 static void
288 vidcaudio_close(void *addr)
289 {
290 struct vidcaudio_softc *sc = addr;
291
292 DPRINTF(("DEBUG: vidcaudio_close called\n"));
293 /*
294 * We do this here rather than in vidcaudio_halt_output()
295 * because the latter can be called from interrupt context
296 * (audio_pint()->audio_clear()->vidcaudio_halt_output()).
297 */
298 if (sc->sc_ppages != NULL) {
299 free(sc->sc_ppages, M_DEVBUF);
300 sc->sc_ppages = NULL;
301 }
302 }
303
304 /*
305 * Interface to the generic audio driver
306 */
307
308 static int
309 vidcaudio_query_encoding(void *addr, struct audio_encoding *fp)
310 {
311 struct vidcaudio_softc *sc = addr;
312
313 switch (fp->index) {
314 case 0:
315 strcpy(fp->name, AudioEmulaw);
316 fp->encoding = AUDIO_ENCODING_ULAW;
317 fp->precision = 8;
318 fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
319 break;
320
321 case 1:
322 if (sc->sc_is16bit) {
323 strcpy(fp->name, AudioEslinear_le);
324 fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
325 fp->precision = 16;
326 fp->flags = 0;
327 break;
328 }
329 /* FALLTHROUGH */
330 default:
331 return EINVAL;
332 }
333 return 0;
334 }
335
336 #define MULAW_TO_VIDC(m) (~((m) << 1 | (m) >> 7))
337
338 static stream_filter_t *
339 mulaw_to_vidc(struct audio_softc *sc, const audio_params_t *from,
340 const audio_params_t *to)
341 {
342 return auconv_nocontext_filter_factory(mulaw_to_vidc_fetch_to);
343 }
344
345 static int
346 mulaw_to_vidc_fetch_to(stream_fetcher_t *self, audio_stream_t *dst, int max_used)
347 {
348 stream_filter_t *this;
349 int m, err;
350
351 this = (stream_filter_t *)self;
352 if ((err = this->prev->fetch_to(this->prev, this->src, max_used)))
353 return err;
354 m = dst->end - dst->start;
355 m = min(m, max_used);
356 FILTER_LOOP_PROLOGUE(this->src, 1, dst, 1, m) {
357 *d = MULAW_TO_VIDC(*s);
358 } FILTER_LOOP_EPILOGUE(this->src, dst);
359 return 0;
360 }
361
362 static stream_filter_t *
363 mulaw_to_vidc_stereo(struct audio_softc *sc, const audio_params_t *from,
364 const audio_params_t *to)
365 {
366 return auconv_nocontext_filter_factory(mulaw_to_vidc_stereo_fetch_to);
367 }
368
369 static int
370 mulaw_to_vidc_stereo_fetch_to(stream_fetcher_t *self, audio_stream_t *dst,
371 int max_used)
372 {
373 stream_filter_t *this;
374 int m, err;
375
376 this = (stream_filter_t *)self;
377 max_used = (max_used + 1) & ~1;
378 if ((err = this->prev->fetch_to(this->prev, this->src, max_used / 2)))
379 return err;
380 m = (dst->end - dst->start) & ~1;
381 m = min(m, max_used);
382 FILTER_LOOP_PROLOGUE(this->src, 1, dst, 2, m) {
383 d[0] = d[1] = MULAW_TO_VIDC(*s);
384 } FILTER_LOOP_EPILOGUE(this->src, dst);
385 return 0;
386 }
387
388 static int
389 vidcaudio_set_params(void *addr, int setmode, int usemode,
390 audio_params_t *p, audio_params_t *r,
391 stream_filter_list_t *pfil, stream_filter_list_t *rfil)
392 {
393 audio_params_t hw;
394 struct vidcaudio_softc *sc = addr;
395 int sample_period, ch;
396
397 if ((setmode & AUMODE_PLAY) == 0)
398 return 0;
399
400 if (sc->sc_is16bit) {
401 /* ARM7500ish, 16-bit, two-channel */
402 hw = *p;
403 if (p->encoding == AUDIO_ENCODING_ULAW && p->precision == 8) {
404 hw.encoding = AUDIO_ENCODING_SLINEAR_LE;
405 hw.precision = hw.validbits = 16;
406 pfil->append(pfil, mulaw_to_linear16, &hw);
407 } else if (p->encoding != AUDIO_ENCODING_SLINEAR_LE ||
408 p->precision != 16)
409 return EINVAL;
410 sample_period = 705600 / 4 / p->sample_rate;
411 if (sample_period < 3) sample_period = 3;
412 vidcaudio_rate(sample_period - 2);
413 vidcaudio_ctrl(SCR_SERIAL);
414 hw.sample_rate = 705600 / 4 / sample_period;
415 hw.channels = 2;
416 pfil->append(pfil, aurateconv, &hw);
417 } else {
418 /* VIDC20ish, u-law, 8-channel */
419 if (p->encoding != AUDIO_ENCODING_ULAW || p->precision != 8)
420 return EINVAL;
421 /*
422 * We always use two hardware channels, because using
423 * one at 8kHz gives a nasty whining sound from the
424 * speaker. The aurateconv mechanism doesn't support
425 * ulaw, so we do the channel duplication ourselves,
426 * and don't try to do rate conversion.
427 */
428 sample_period = 1000000 / 2 / p->sample_rate;
429 if (sample_period < 3) sample_period = 3;
430 p->sample_rate = 1000000 / 2 / sample_period;
431 hw = *p;
432 hw.encoding = AUDIO_ENCODING_NONE;
433 hw.precision = 8;
434 vidcaudio_rate(sample_period - 2);
435 vidcaudio_ctrl(SCR_SDAC | SCR_CLKSEL);
436 if (p->channels == 1) {
437 pfil->append(pfil, mulaw_to_vidc_stereo, &hw);
438 for (ch = 0; ch < 8; ch++)
439 vidcaudio_stereo(ch, SIR_CENTRE);
440 } else {
441 pfil->append(pfil, mulaw_to_vidc, &hw);
442 for (ch = 0; ch < 8; ch += 2)
443 vidcaudio_stereo(ch, SIR_LEFT_100);
444 for (ch = 1; ch < 8; ch += 2)
445 vidcaudio_stereo(ch, SIR_RIGHT_100);
446 }
447 }
448 return 0;
449 }
450
451 static int
452 vidcaudio_round_blocksize(void *addr, int wantblk)
453 {
454 int blk;
455
456 /*
457 * Find the smallest power of two that's larger than the
458 * requested block size, but don't allow < 32 (DMA burst is 16
459 * bytes, and single bursts are tricky) or > PAGE_SIZE (DMA is
460 * confined to a page).
461 */
462
463 for (blk = 32; blk < PAGE_SIZE; blk <<= 1)
464 if (blk >= wantblk) return blk;
465 return blk;
466 }
467
468 static int
469 vidcaudio_trigger_output(void *addr, void *start, void *end, int blksize,
470 void (*intr)(void *), void *arg, const audio_params_t *params)
471 {
472 struct vidcaudio_softc *sc = addr;
473 size_t npages, i;
474
475 DPRINTF(("vidcaudio_trigger_output %p-%p/0x%x\n",
476 start, end, blksize));
477
478 KASSERT(blksize == vidcaudio_round_blocksize(addr, blksize));
479 KASSERT((vaddr_t)start % blksize == 0);
480
481 sc->sc_pblksize = blksize;
482 sc->sc_pbufsize = (char *)end - (char *)start;
483 npages = sc->sc_pbufsize >> PGSHIFT;
484 if (sc->sc_ppages != NULL)
485 free(sc->sc_ppages, M_DEVBUF);
486 sc->sc_ppages = malloc(npages * sizeof(paddr_t), M_DEVBUF, M_WAITOK);
487 if (sc->sc_ppages == NULL) return ENOMEM;
488 for (i = 0; i < npages; i++)
489 if (!pmap_extract(pmap_kernel(),
490 (vaddr_t)start + i * PAGE_SIZE, &sc->sc_ppages[i]))
491 return EIO;
492 sc->sc_poffset = 0;
493 sc->sc_pintr = intr;
494 sc->sc_parg = arg;
495
496 IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
497 IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_ENABLE | IOMD_DMACR_QUADWORD);
498
499 /*
500 * Queue up the first two blocks, but don't tell audio code
501 * we're finished with them yet.
502 */
503 sc->sc_pcountdown = 2;
504
505 enable_irq(sc->sc_dma_intr);
506
507 return 0;
508 }
509
510 static int
511 vidcaudio_trigger_input(void *addr, void *start, void *end, int blksize,
512 void (*intr)(void *), void *arg, const audio_params_t *params)
513 {
514
515 return ENODEV;
516 }
517
518 static int
519 vidcaudio_halt_output(void *addr)
520 {
521 struct vidcaudio_softc *sc = addr;
522
523 DPRINTF(("vidcaudio_halt_output\n"));
524 disable_irq(sc->sc_dma_intr);
525 IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
526 return 0;
527 }
528
529 static int
530 vidcaudio_halt_input(void *addr)
531 {
532
533 return ENODEV;
534 }
535
536 static int
537 vidcaudio_getdev(void *addr, struct audio_device *retp)
538 {
539
540 *retp = vidcaudio_device;
541 return 0;
542 }
543
544
545 static int
546 vidcaudio_set_port(void *addr, mixer_ctrl_t *cp)
547 {
548
549 return EINVAL;
550 }
551
552 static int
553 vidcaudio_get_port(void *addr, mixer_ctrl_t *cp)
554 {
555
556 return EINVAL;
557 }
558
559 static int
560 vidcaudio_query_devinfo(void *addr, mixer_devinfo_t *dip)
561 {
562
563 return ENXIO;
564 }
565
566 static int
567 vidcaudio_get_props(void *addr)
568 {
569
570 return 0;
571 }
572
573 static void
574 vidcaudio_rate(int rate)
575 {
576
577 WriteWord(vidc_base, VIDC_SFR | rate);
578 }
579
580 static void
581 vidcaudio_ctrl(int ctrl)
582 {
583
584 WriteWord(vidc_base, VIDC_SCR | ctrl);
585 }
586
587 static void
588 vidcaudio_stereo(int channel, int position)
589 {
590
591 channel = channel << 24 | VIDC_SIR0;
592 WriteWord(vidc_base, channel | position);
593 }
594
595 static int
596 vidcaudio_intr(void *arg)
597 {
598 struct vidcaudio_softc *sc = arg;
599 int status;
600 paddr_t pnext, pend;
601
602 status = IOMD_READ_BYTE(IOMD_SD0ST);
603 DPRINTF(("I[%x]", status));
604 if ((status & IOMD_DMAST_INT) == 0)
605 return 0;
606
607 pnext = sc->sc_ppages[sc->sc_poffset >> PGSHIFT] |
608 (sc->sc_poffset & PGOFSET);
609 pend = (pnext + sc->sc_pblksize - 16) & IOMD_DMAEND_OFFSET;
610
611 switch (status &
612 (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB)) {
613
614 case (IOMD_DMAST_INT | IOMD_DMAST_BANKA):
615 case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB):
616 DPRINTF(("B<0x%08lx,0x%03lx>", pnext, pend));
617 IOMD_WRITE_WORD(IOMD_SD0CURB, pnext);
618 IOMD_WRITE_WORD(IOMD_SD0ENDB, pend);
619 break;
620
621 case (IOMD_DMAST_INT | IOMD_DMAST_BANKB):
622 case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKA):
623 DPRINTF(("A<0x%08lx,0x%03lx>", pnext, pend));
624 IOMD_WRITE_WORD(IOMD_SD0CURA, pnext);
625 IOMD_WRITE_WORD(IOMD_SD0ENDA, pend);
626 break;
627 }
628
629 sc->sc_poffset += sc->sc_pblksize;
630 if (sc->sc_poffset >= sc->sc_pbufsize)
631 sc->sc_poffset = 0;
632
633 if (sc->sc_pcountdown > 0)
634 sc->sc_pcountdown--;
635 else
636 (*sc->sc_pintr)(sc->sc_parg);
637
638 return 1;
639 }
640