vidcaudio.c revision 1.46.40.1 1 /* $NetBSD: vidcaudio.c,v 1.46.40.1 2011/11/20 12:58:45 mrg 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.46.40.1 2011/11/20 12:58:45 mrg 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 extern int *vidc_base;
101
102 #ifdef VIDCAUDIO_DEBUG
103 #define DPRINTF(x) printf x
104 #else
105 #define DPRINTF(x)
106 #endif
107
108 struct vidcaudio_softc {
109 struct device sc_dev;
110
111 irqhandler_t sc_ih;
112 int sc_dma_intr;
113
114 int sc_is16bit;
115
116 size_t sc_pblksize;
117 vm_offset_t sc_poffset;
118 vm_offset_t sc_pbufsize;
119 paddr_t *sc_ppages;
120 void (*sc_pintr)(void *);
121 void *sc_parg;
122 int sc_pcountdown;
123
124 kmutex_t sc_lock;
125 kmutex_t sc_intr_lock;
126 };
127
128 static int vidcaudio_probe(struct device *, struct cfdata *, void *);
129 static void vidcaudio_attach(struct device *, struct device *, void *);
130 static void vidcaudio_close(void *);
131
132 static int vidcaudio_intr(void *);
133 static void vidcaudio_rate(int);
134 static void vidcaudio_ctrl(int);
135 static void vidcaudio_stereo(int, int);
136 static stream_filter_factory_t mulaw_to_vidc;
137 static stream_filter_factory_t mulaw_to_vidc_stereo;
138 static int mulaw_to_vidc_fetch_to(struct audio_softc *, stream_fetcher_t *,
139 audio_stream_t *, int);
140 static int mulaw_to_vidc_stereo_fetch_to(struct audio_softc *, stream_fetcher_t *,
141 audio_stream_t *, int);
142
143 CFATTACH_DECL(vidcaudio, sizeof(struct vidcaudio_softc),
144 vidcaudio_probe, vidcaudio_attach, NULL, NULL);
145
146 static int vidcaudio_query_encoding(void *, struct audio_encoding *);
147 static int vidcaudio_set_params(void *, int, int, audio_params_t *,
148 audio_params_t *, stream_filter_list_t *, stream_filter_list_t *);
149 static int vidcaudio_round_blocksize(void *, int, int, const audio_params_t *);
150 static int vidcaudio_trigger_output(void *, void *, void *, int,
151 void (*)(void *), void *, const audio_params_t *);
152 static int vidcaudio_trigger_input(void *, void *, void *, int,
153 void (*)(void *), void *, const audio_params_t *);
154 static int vidcaudio_halt_output(void *);
155 static int vidcaudio_halt_input(void *);
156 static int vidcaudio_getdev(void *, struct audio_device *);
157 static int vidcaudio_set_port(void *, mixer_ctrl_t *);
158 static int vidcaudio_get_port(void *, mixer_ctrl_t *);
159 static int vidcaudio_query_devinfo(void *, mixer_devinfo_t *);
160 static int vidcaudio_get_props(void *);
161 static void vidcaudio_get_locks(void *, kmutex_t **, kmutex_t **);
162
163 static struct audio_device vidcaudio_device = {
164 "ARM VIDC",
165 "",
166 "vidcaudio"
167 };
168
169 static const struct audio_hw_if vidcaudio_hw_if = {
170 NULL, /* open */
171 vidcaudio_close,
172 NULL,
173 vidcaudio_query_encoding,
174 vidcaudio_set_params,
175 vidcaudio_round_blocksize,
176 NULL,
177 NULL,
178 NULL,
179 NULL,
180 NULL,
181 vidcaudio_halt_output,
182 vidcaudio_halt_input,
183 NULL,
184 vidcaudio_getdev,
185 NULL,
186 vidcaudio_set_port,
187 vidcaudio_get_port,
188 vidcaudio_query_devinfo,
189 NULL,
190 NULL,
191 NULL,
192 NULL,
193 vidcaudio_get_props,
194 vidcaudio_trigger_output,
195 vidcaudio_trigger_input,
196 NULL,
197 NULL,
198 vidcaudio_get_locks,
199 };
200
201 static int
202 vidcaudio_probe(struct device *parent, struct cfdata *cf, void *aux)
203 {
204 int id;
205
206 id = IOMD_ID;
207
208 /* So far I only know about this IOMD */
209 switch (id) {
210 case RPC600_IOMD_ID:
211 case ARM7500_IOC_ID:
212 case ARM7500FE_IOC_ID:
213 return 1;
214 default:
215 aprint_error("vidcaudio: Unknown IOMD id=%04x", id);
216 return 0;
217 }
218 }
219
220
221 static void
222 vidcaudio_attach(struct device *parent, struct device *self, void *aux)
223 {
224 struct vidcaudio_softc *sc;
225 struct device *beepdev;
226
227 sc = (void *)self;
228 switch (IOMD_ID) {
229 #ifndef EB7500ATX
230 case RPC600_IOMD_ID:
231 sc->sc_is16bit = (cmos_read(0xc4) >> 5) & 1;
232 sc->sc_dma_intr = IRQ_DMASCH0;
233 break;
234 #endif
235 case ARM7500_IOC_ID:
236 case ARM7500FE_IOC_ID:
237 sc->sc_is16bit = true;
238 sc->sc_dma_intr = IRQ_SDMA;
239 break;
240 default:
241 aprint_error(": strange IOMD\n");
242 return;
243 }
244
245 if (sc->sc_is16bit)
246 aprint_normal(": 16-bit external DAC\n");
247 else
248 aprint_normal(": 8-bit internal DAC\n");
249
250 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
251 mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED);
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_SCHED;
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 }
272
273 static void
274 vidcaudio_close(void *addr)
275 {
276 struct vidcaudio_softc *sc;
277
278 DPRINTF(("DEBUG: vidcaudio_close called\n"));
279 sc = addr;
280 /*
281 * We do this here rather than in vidcaudio_halt_output()
282 * because the latter can be called from interrupt context
283 * (audio_pint()->audio_clear()->vidcaudio_halt_output()).
284 */
285 if (sc->sc_ppages != NULL) {
286 free(sc->sc_ppages, M_DEVBUF);
287 sc->sc_ppages = NULL;
288 }
289 }
290
291 /*
292 * Interface to the generic audio driver
293 */
294
295 static int
296 vidcaudio_query_encoding(void *addr, struct audio_encoding *fp)
297 {
298 struct vidcaudio_softc *sc;
299
300 sc = addr;
301 switch (fp->index) {
302 case 0:
303 strcpy(fp->name, AudioEmulaw);
304 fp->encoding = AUDIO_ENCODING_ULAW;
305 fp->precision = 8;
306 fp->flags = AUDIO_ENCODINGFLAG_EMULATED;
307 break;
308
309 case 1:
310 if (sc->sc_is16bit) {
311 strcpy(fp->name, AudioEslinear_le);
312 fp->encoding = AUDIO_ENCODING_SLINEAR_LE;
313 fp->precision = 16;
314 fp->flags = 0;
315 break;
316 }
317 /* FALLTHROUGH */
318 default:
319 return EINVAL;
320 }
321 return 0;
322 }
323
324 #define MULAW_TO_VIDC(m) (~((m) << 1 | (m) >> 7))
325
326 static stream_filter_t *
327 mulaw_to_vidc(struct audio_softc *sc, const audio_params_t *from,
328 const audio_params_t *to)
329 {
330
331 return auconv_nocontext_filter_factory(mulaw_to_vidc_fetch_to);
332 }
333
334 static int
335 mulaw_to_vidc_fetch_to(struct audio_softc *sc, stream_fetcher_t *self,
336 audio_stream_t *dst, int max_used)
337 {
338 stream_filter_t *this;
339 int m, err;
340
341 this = (stream_filter_t *)self;
342 if ((err = this->prev->fetch_to(sc, this->prev, this->src, max_used)))
343 return err;
344 m = dst->end - dst->start;
345 m = min(m, max_used);
346 FILTER_LOOP_PROLOGUE(this->src, 1, dst, 1, m) {
347 *d = MULAW_TO_VIDC(*s);
348 } FILTER_LOOP_EPILOGUE(this->src, dst);
349 return 0;
350 }
351
352 static stream_filter_t *
353 mulaw_to_vidc_stereo(struct audio_softc *sc, const audio_params_t *from,
354 const audio_params_t *to)
355 {
356
357 return auconv_nocontext_filter_factory(mulaw_to_vidc_stereo_fetch_to);
358 }
359
360 static int
361 mulaw_to_vidc_stereo_fetch_to(struct audio_softc *sc, stream_fetcher_t *self,
362 audio_stream_t *dst, int max_used)
363 {
364 stream_filter_t *this;
365 int m, err;
366
367 this = (stream_filter_t *)self;
368 max_used = (max_used + 1) & ~1;
369 if ((err = this->prev->fetch_to(sc, this->prev, this->src, max_used / 2)))
370 return err;
371 m = (dst->end - dst->start) & ~1;
372 m = min(m, max_used);
373 FILTER_LOOP_PROLOGUE(this->src, 1, dst, 2, m) {
374 d[0] = d[1] = MULAW_TO_VIDC(*s);
375 } FILTER_LOOP_EPILOGUE(this->src, dst);
376 return 0;
377 }
378
379 static int
380 vidcaudio_set_params(void *addr, int setmode, int usemode,
381 audio_params_t *p, audio_params_t *r,
382 stream_filter_list_t *pfil, stream_filter_list_t *rfil)
383 {
384 audio_params_t hw;
385 struct vidcaudio_softc *sc;
386 int sample_period, ch;
387
388 if ((setmode & AUMODE_PLAY) == 0)
389 return 0;
390
391 sc = addr;
392 if (sc->sc_is16bit) {
393 /* ARM7500ish, 16-bit, two-channel */
394 hw = *p;
395 if (p->encoding == AUDIO_ENCODING_ULAW && p->precision == 8) {
396 hw.encoding = AUDIO_ENCODING_SLINEAR_LE;
397 hw.precision = hw.validbits = 16;
398 pfil->append(pfil, mulaw_to_linear16, &hw);
399 } else if (p->encoding != AUDIO_ENCODING_SLINEAR_LE ||
400 p->precision != 16)
401 return EINVAL;
402 sample_period = 705600 / 4 / p->sample_rate;
403 if (sample_period < 3) sample_period = 3;
404 vidcaudio_rate(sample_period - 2);
405 vidcaudio_ctrl(SCR_SERIAL);
406 hw.sample_rate = 705600 / 4 / sample_period;
407 hw.channels = 2;
408 pfil->prepend(pfil, aurateconv, &hw);
409 } else {
410 /* VIDC20ish, u-law, 8-channel */
411 if (p->encoding != AUDIO_ENCODING_ULAW || p->precision != 8)
412 return EINVAL;
413 /*
414 * We always use two hardware channels, because using
415 * one at 8kHz gives a nasty whining sound from the
416 * speaker. The aurateconv mechanism doesn't support
417 * ulaw, so we do the channel duplication ourselves,
418 * and don't try to do rate conversion.
419 */
420 sample_period = 1000000 / 2 / p->sample_rate;
421 if (sample_period < 3) sample_period = 3;
422 p->sample_rate = 1000000 / 2 / sample_period;
423 hw = *p;
424 hw.encoding = AUDIO_ENCODING_NONE;
425 hw.precision = 8;
426 vidcaudio_rate(sample_period - 2);
427 vidcaudio_ctrl(SCR_SDAC | SCR_CLKSEL);
428 if (p->channels == 1) {
429 pfil->append(pfil, mulaw_to_vidc_stereo, &hw);
430 for (ch = 0; ch < 8; ch++)
431 vidcaudio_stereo(ch, SIR_CENTRE);
432 } else {
433 pfil->append(pfil, mulaw_to_vidc, &hw);
434 for (ch = 0; ch < 8; ch += 2)
435 vidcaudio_stereo(ch, SIR_LEFT_100);
436 for (ch = 1; ch < 8; ch += 2)
437 vidcaudio_stereo(ch, SIR_RIGHT_100);
438 }
439 }
440 return 0;
441 }
442
443 static int
444 vidcaudio_round_blocksize(void *addr, int wantblk,
445 int mode, const audio_params_t *param)
446 {
447 int blk;
448
449 /*
450 * Find the smallest power of two that's larger than the
451 * requested block size, but don't allow < 32 (DMA burst is 16
452 * bytes, and single bursts are tricky) or > PAGE_SIZE (DMA is
453 * confined to a page).
454 */
455
456 for (blk = 32; blk < PAGE_SIZE; blk <<= 1)
457 if (blk >= wantblk)
458 return blk;
459 return blk;
460 }
461
462 static int
463 vidcaudio_trigger_output(void *addr, void *start, void *end, int blksize,
464 void (*intr)(void *), void *arg, const audio_params_t *params)
465 {
466 struct vidcaudio_softc *sc;
467 size_t npages, i;
468
469 DPRINTF(("vidcaudio_trigger_output %p-%p/0x%x\n",
470 start, end, blksize));
471
472 sc = addr;
473 KASSERT(blksize == vidcaudio_round_blocksize(addr, blksize, 0, NULL));
474 KASSERT((vaddr_t)start % blksize == 0);
475
476 sc->sc_pblksize = blksize;
477 sc->sc_pbufsize = (char *)end - (char *)start;
478 npages = sc->sc_pbufsize >> PGSHIFT;
479 if (sc->sc_ppages != NULL)
480 free(sc->sc_ppages, M_DEVBUF);
481 sc->sc_ppages = malloc(npages * sizeof(paddr_t), M_DEVBUF, M_WAITOK);
482 if (sc->sc_ppages == NULL) return ENOMEM;
483 for (i = 0; i < npages; i++)
484 if (!pmap_extract(pmap_kernel(),
485 (vaddr_t)start + i * PAGE_SIZE, &sc->sc_ppages[i]))
486 return EIO;
487 sc->sc_poffset = 0;
488 sc->sc_pintr = intr;
489 sc->sc_parg = arg;
490
491 IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
492 IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_ENABLE | IOMD_DMACR_QUADWORD);
493
494 /*
495 * Queue up the first two blocks, but don't tell audio code
496 * we're finished with them yet.
497 */
498 sc->sc_pcountdown = 2;
499
500 enable_irq(sc->sc_dma_intr);
501
502 return 0;
503 }
504
505 static int
506 vidcaudio_trigger_input(void *addr, void *start, void *end, int blksize,
507 void (*intr)(void *), void *arg, const audio_params_t *params)
508 {
509
510 return ENODEV;
511 }
512
513 static int
514 vidcaudio_halt_output(void *addr)
515 {
516 struct vidcaudio_softc *sc;
517
518 DPRINTF(("vidcaudio_halt_output\n"));
519 sc = addr;
520 disable_irq(sc->sc_dma_intr);
521 IOMD_WRITE_WORD(IOMD_SD0CR, IOMD_DMACR_CLEAR | IOMD_DMACR_QUADWORD);
522 return 0;
523 }
524
525 static int
526 vidcaudio_halt_input(void *addr)
527 {
528
529 return ENODEV;
530 }
531
532 static int
533 vidcaudio_getdev(void *addr, struct audio_device *retp)
534 {
535
536 *retp = vidcaudio_device;
537 return 0;
538 }
539
540
541 static int
542 vidcaudio_set_port(void *addr, mixer_ctrl_t *cp)
543 {
544
545 return EINVAL;
546 }
547
548 static int
549 vidcaudio_get_port(void *addr, mixer_ctrl_t *cp)
550 {
551
552 return EINVAL;
553 }
554
555 static int
556 vidcaudio_query_devinfo(void *addr, mixer_devinfo_t *dip)
557 {
558
559 return ENXIO;
560 }
561
562 static int
563 vidcaudio_get_props(void *addr)
564 {
565
566 return 0;
567 }
568
569 static void
570 vidcaudio_get_locks(void *opaque, kmutex_t **intr, kmutex_t **thread)
571 {
572 struct vidcaudio_softc *sc = opaque;
573
574 *intr = &sc->sc_intr_lock;
575 *thread = &sc->sc_lock;
576 }
577
578 static void
579 vidcaudio_rate(int rate)
580 {
581
582 WriteWord(vidc_base, VIDC_SFR | rate);
583 }
584
585 static void
586 vidcaudio_ctrl(int ctrl)
587 {
588
589 WriteWord(vidc_base, VIDC_SCR | ctrl);
590 }
591
592 static void
593 vidcaudio_stereo(int channel, int position)
594 {
595
596 channel = channel << 24 | VIDC_SIR0;
597 WriteWord(vidc_base, channel | position);
598 }
599
600 static int
601 vidcaudio_intr(void *arg)
602 {
603 struct vidcaudio_softc *sc;
604 int status;
605 paddr_t pnext, pend;
606
607 sc = arg;
608 mutex_spin_enter(&sc->sc_intr_lock);
609
610 status = IOMD_READ_BYTE(IOMD_SD0ST);
611 DPRINTF(("I[%x]", status));
612 if ((status & IOMD_DMAST_INT) == 0) {
613 mutex_spin_exit(&sc->sc_intr_lock);
614 return 0;
615 }
616
617 pnext = sc->sc_ppages[sc->sc_poffset >> PGSHIFT] |
618 (sc->sc_poffset & PGOFSET);
619 pend = (pnext + sc->sc_pblksize - 16) & IOMD_DMAEND_OFFSET;
620
621 switch (status &
622 (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB)) {
623
624 case (IOMD_DMAST_INT | IOMD_DMAST_BANKA):
625 case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKB):
626 DPRINTF(("B<0x%08lx,0x%03lx>", pnext, pend));
627 IOMD_WRITE_WORD(IOMD_SD0CURB, pnext);
628 IOMD_WRITE_WORD(IOMD_SD0ENDB, pend);
629 break;
630
631 case (IOMD_DMAST_INT | IOMD_DMAST_BANKB):
632 case (IOMD_DMAST_OVERRUN | IOMD_DMAST_INT | IOMD_DMAST_BANKA):
633 DPRINTF(("A<0x%08lx,0x%03lx>", pnext, pend));
634 IOMD_WRITE_WORD(IOMD_SD0CURA, pnext);
635 IOMD_WRITE_WORD(IOMD_SD0ENDA, pend);
636 break;
637 }
638
639 sc->sc_poffset += sc->sc_pblksize;
640 if (sc->sc_poffset >= sc->sc_pbufsize)
641 sc->sc_poffset = 0;
642
643 if (sc->sc_pcountdown > 0)
644 sc->sc_pcountdown--;
645 else
646 (*sc->sc_pintr)(sc->sc_parg);
647
648 mutex_spin_exit(&sc->sc_intr_lock);
649 return 1;
650 }
651