FreeBSD/Linux Kernel Cross Reference
sys/dev/sound/pcm/dsp.c
1 /*
2 * Copyright (c) 1999 Cameron Grant <gandalf@vilnya.demon.co.uk>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27 #include <sys/param.h>
28 #include <sys/queue.h>
29
30 #include <dev/sound/pcm/sound.h>
31
32 SND_DECLARE_FILE("$FreeBSD$");
33
34 #define OLDPCM_IOCTL
35
36 static d_open_t dsp_open;
37 static d_close_t dsp_close;
38 static d_read_t dsp_read;
39 static d_write_t dsp_write;
40 static d_ioctl_t dsp_ioctl;
41 static d_poll_t dsp_poll;
42 static d_mmap_t dsp_mmap;
43
44 static struct cdevsw dsp_cdevsw = {
45 /* open */ dsp_open,
46 /* close */ dsp_close,
47 /* read */ dsp_read,
48 /* write */ dsp_write,
49 /* ioctl */ dsp_ioctl,
50 /* poll */ dsp_poll,
51 /* mmap */ dsp_mmap,
52 /* strategy */ nostrategy,
53 /* name */ "dsp",
54 /* maj */ SND_CDEV_MAJOR,
55 /* dump */ nodump,
56 /* psize */ nopsize,
57 /* flags */ 0,
58 };
59
60 #ifdef USING_DEVFS
61 static eventhandler_tag dsp_ehtag;
62 #endif
63
64 static struct snddev_info *
65 dsp_get_info(dev_t dev)
66 {
67 struct snddev_info *d;
68 int unit;
69
70 unit = PCMUNIT(dev);
71 if (unit >= devclass_get_maxunit(pcm_devclass))
72 return NULL;
73 d = devclass_get_softc(pcm_devclass, unit);
74
75 return d;
76 }
77
78 static u_int32_t
79 dsp_get_flags(dev_t dev)
80 {
81 device_t bdev;
82 int unit;
83
84 unit = PCMUNIT(dev);
85 if (unit >= devclass_get_maxunit(pcm_devclass))
86 return 0xffffffff;
87 bdev = devclass_get_device(pcm_devclass, unit);
88
89 return pcm_getflags(bdev);
90 }
91
92 static void
93 dsp_set_flags(dev_t dev, u_int32_t flags)
94 {
95 device_t bdev;
96 int unit;
97
98 unit = PCMUNIT(dev);
99 if (unit >= devclass_get_maxunit(pcm_devclass))
100 return;
101 bdev = devclass_get_device(pcm_devclass, unit);
102
103 pcm_setflags(bdev, flags);
104 }
105
106 /*
107 * return the channels channels associated with an open device instance.
108 * set the priority if the device is simplex and one direction (only) is
109 * specified.
110 * lock channels specified.
111 */
112 static int
113 getchns(dev_t dev, struct pcm_channel **rdch, struct pcm_channel **wrch, u_int32_t prio)
114 {
115 struct snddev_info *d;
116 u_int32_t flags;
117
118 flags = dsp_get_flags(dev);
119 d = dsp_get_info(dev);
120 pcm_lock(d);
121 pcm_inprog(d, 1);
122 KASSERT((flags & SD_F_PRIO_SET) != SD_F_PRIO_SET, \
123 ("getchns: read and write both prioritised"));
124
125 if ((flags & SD_F_PRIO_SET) == 0 && (prio != (SD_F_PRIO_RD | SD_F_PRIO_WR))) {
126 flags |= prio & (SD_F_PRIO_RD | SD_F_PRIO_WR);
127 dsp_set_flags(dev, flags);
128 }
129
130 *rdch = dev->si_drv1;
131 *wrch = dev->si_drv2;
132 if ((flags & SD_F_SIMPLEX) && (flags & SD_F_PRIO_SET)) {
133 if (prio) {
134 if (*rdch && flags & SD_F_PRIO_WR) {
135 dev->si_drv1 = NULL;
136 *rdch = pcm_getfakechan(d);
137 } else if (*wrch && flags & SD_F_PRIO_RD) {
138 dev->si_drv2 = NULL;
139 *wrch = pcm_getfakechan(d);
140 }
141 }
142
143 pcm_getfakechan(d)->flags |= CHN_F_BUSY;
144 }
145 pcm_unlock(d);
146
147 if (*rdch && *rdch != pcm_getfakechan(d) && (prio & SD_F_PRIO_RD))
148 CHN_LOCK(*rdch);
149 if (*wrch && *wrch != pcm_getfakechan(d) && (prio & SD_F_PRIO_WR))
150 CHN_LOCK(*wrch);
151
152 return 0;
153 }
154
155 /* unlock specified channels */
156 static void
157 relchns(dev_t dev, struct pcm_channel *rdch, struct pcm_channel *wrch, u_int32_t prio)
158 {
159 struct snddev_info *d;
160
161 d = dsp_get_info(dev);
162 if (wrch && wrch != pcm_getfakechan(d) && (prio & SD_F_PRIO_WR))
163 CHN_UNLOCK(wrch);
164 if (rdch && rdch != pcm_getfakechan(d) && (prio & SD_F_PRIO_RD))
165 CHN_UNLOCK(rdch);
166 pcm_lock(d);
167 pcm_inprog(d, -1);
168 pcm_unlock(d);
169 }
170
171 static int
172 dsp_open(dev_t i_dev, int flags, int mode, struct proc *p)
173 {
174 struct pcm_channel *rdch, *wrch;
175 struct snddev_info *d;
176 intrmask_t s;
177 u_int32_t fmt;
178 int devtype;
179
180 s = spltty();
181 d = dsp_get_info(i_dev);
182 devtype = PCMDEV(i_dev);
183
184 /* decide default format */
185 switch (devtype) {
186 case SND_DEV_DSP16:
187 fmt = AFMT_S16_LE;
188 break;
189
190 case SND_DEV_DSP:
191 fmt = AFMT_U8;
192 break;
193
194 case SND_DEV_AUDIO:
195 fmt = AFMT_MU_LAW;
196 break;
197
198 case SND_DEV_NORESET:
199 fmt = 0;
200 break;
201
202 case SND_DEV_DSPREC:
203 fmt = AFMT_U8;
204 if (mode & FWRITE) {
205 splx(s);
206 return EINVAL;
207 }
208 break;
209
210 default:
211 panic("impossible devtype %d", devtype);
212 }
213
214 /* lock snddev so nobody else can monkey with it */
215 pcm_lock(d);
216
217 rdch = i_dev->si_drv1;
218 wrch = i_dev->si_drv2;
219
220 if ((dsp_get_flags(i_dev) & SD_F_SIMPLEX) && (rdch || wrch)) {
221 /* simplex device, already open, exit */
222 pcm_unlock(d);
223 splx(s);
224 return EBUSY;
225 }
226
227 if (((flags & FREAD) && rdch) || ((flags & FWRITE) && wrch)) {
228 /* device already open in one or both directions */
229 pcm_unlock(d);
230 splx(s);
231 return EBUSY;
232 }
233
234 /* if we get here, the open request is valid */
235 if (flags & FREAD) {
236 /* open for read */
237 if (devtype == SND_DEV_DSPREC)
238 rdch = pcm_chnalloc(d, PCMDIR_REC, p->p_pid, PCMCHAN(i_dev));
239 else
240 rdch = pcm_chnalloc(d, PCMDIR_REC, p->p_pid, -1);
241 if (!rdch) {
242 /* no channel available, exit */
243 pcm_unlock(d);
244 splx(s);
245 return EBUSY;
246 }
247 /* got a channel, already locked for us */
248 }
249
250 if (flags & FWRITE) {
251 /* open for write */
252 wrch = pcm_chnalloc(d, PCMDIR_PLAY, p->p_pid, -1);
253 if (!wrch) {
254 /* no channel available */
255 if (rdch && (flags & FREAD)) {
256 /* just opened a read channel, release it */
257 pcm_chnrelease(rdch);
258 }
259 /* exit */
260 pcm_unlock(d);
261 splx(s);
262 return EBUSY;
263 }
264 /* got a channel, already locked for us */
265 }
266
267 i_dev->si_drv1 = rdch;
268 i_dev->si_drv2 = wrch;
269 pcm_unlock(d);
270 /* finished with snddev, new channels still locked */
271
272 /* bump refcounts, reset and unlock any channels that we just opened */
273 if (flags & FREAD) {
274 if (chn_reset(rdch, fmt)) {
275 pcm_lock(d);
276 pcm_chnrelease(rdch);
277 if (wrch && (flags & FWRITE))
278 pcm_chnrelease(wrch);
279 pcm_unlock(d);
280 splx(s);
281 return ENODEV;
282 }
283 if (flags & O_NONBLOCK)
284 rdch->flags |= CHN_F_NBIO;
285 pcm_chnref(rdch, 1);
286 CHN_UNLOCK(rdch);
287 }
288 if (flags & FWRITE) {
289 if (chn_reset(wrch, fmt)) {
290 pcm_lock(d);
291 pcm_chnrelease(wrch);
292 if (flags & FREAD) {
293 CHN_LOCK(rdch);
294 pcm_chnref(rdch, -1);
295 pcm_chnrelease(rdch);
296 CHN_UNLOCK(rdch);
297 }
298 pcm_unlock(d);
299 splx(s);
300 return ENODEV;
301 }
302 if (flags & O_NONBLOCK)
303 wrch->flags |= CHN_F_NBIO;
304 pcm_chnref(wrch, 1);
305 CHN_UNLOCK(wrch);
306 }
307 splx(s);
308 return 0;
309 }
310
311 static int
312 dsp_close(dev_t i_dev, int flags, int mode, struct proc *p)
313 {
314 struct pcm_channel *rdch, *wrch;
315 struct snddev_info *d;
316 intrmask_t s;
317 int exit;
318
319 s = spltty();
320 d = dsp_get_info(i_dev);
321 pcm_lock(d);
322 rdch = i_dev->si_drv1;
323 wrch = i_dev->si_drv2;
324
325 exit = 0;
326
327 /* decrement refcount for each channel, exit if nonzero */
328 if (rdch) {
329 CHN_LOCK(rdch);
330 if (pcm_chnref(rdch, -1) > 0) {
331 CHN_UNLOCK(rdch);
332 exit = 1;
333 }
334 }
335 if (wrch) {
336 CHN_LOCK(wrch);
337 if (pcm_chnref(wrch, -1) > 0) {
338 CHN_UNLOCK(wrch);
339 exit = 1;
340 }
341 }
342 if (exit) {
343 pcm_unlock(d);
344 splx(s);
345 return 0;
346 }
347
348 /* both refcounts are zero, abort and release */
349
350 if (pcm_getfakechan(d))
351 pcm_getfakechan(d)->flags = 0;
352
353 i_dev->si_drv1 = NULL;
354 i_dev->si_drv2 = NULL;
355
356 dsp_set_flags(i_dev, dsp_get_flags(i_dev) & ~SD_F_TRANSIENT);
357 pcm_unlock(d);
358
359 if (rdch) {
360 chn_abort(rdch); /* won't sleep */
361 rdch->flags &= ~(CHN_F_RUNNING | CHN_F_MAPPED | CHN_F_DEAD);
362 chn_reset(rdch, 0);
363 pcm_chnrelease(rdch);
364 }
365 if (wrch) {
366 chn_flush(wrch); /* may sleep */
367 wrch->flags &= ~(CHN_F_RUNNING | CHN_F_MAPPED | CHN_F_DEAD);
368 chn_reset(wrch, 0);
369 pcm_chnrelease(wrch);
370 }
371
372 splx(s);
373 return 0;
374 }
375
376 static int
377 dsp_read(dev_t i_dev, struct uio *buf, int flag)
378 {
379 struct pcm_channel *rdch, *wrch;
380 intrmask_t s;
381 int ret;
382
383 s = spltty();
384 getchns(i_dev, &rdch, &wrch, SD_F_PRIO_RD);
385
386 KASSERT(rdch, ("dsp_read: nonexistant channel"));
387 KASSERT(rdch->flags & CHN_F_BUSY, ("dsp_read: nonbusy channel"));
388
389 if (rdch->flags & (CHN_F_MAPPED | CHN_F_DEAD)) {
390 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD);
391 splx(s);
392 return EINVAL;
393 }
394 if (!(rdch->flags & CHN_F_RUNNING))
395 rdch->flags |= CHN_F_RUNNING;
396 ret = chn_read(rdch, buf);
397 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD);
398
399 splx(s);
400 return ret;
401 }
402
403 static int
404 dsp_write(dev_t i_dev, struct uio *buf, int flag)
405 {
406 struct pcm_channel *rdch, *wrch;
407 intrmask_t s;
408 int ret;
409
410 s = spltty();
411 getchns(i_dev, &rdch, &wrch, SD_F_PRIO_WR);
412
413 KASSERT(wrch, ("dsp_write: nonexistant channel"));
414 KASSERT(wrch->flags & CHN_F_BUSY, ("dsp_write: nonbusy channel"));
415
416 if (wrch->flags & (CHN_F_MAPPED | CHN_F_DEAD)) {
417 relchns(i_dev, rdch, wrch, SD_F_PRIO_WR);
418 splx(s);
419 return EINVAL;
420 }
421 if (!(wrch->flags & CHN_F_RUNNING))
422 wrch->flags |= CHN_F_RUNNING;
423 ret = chn_write(wrch, buf);
424 relchns(i_dev, rdch, wrch, SD_F_PRIO_WR);
425
426 splx(s);
427 return ret;
428 }
429
430 static int
431 dsp_ioctl(dev_t i_dev, u_long cmd, caddr_t arg, int mode, struct proc *p)
432 {
433 struct pcm_channel *wrch, *rdch;
434 struct snddev_info *d;
435 intrmask_t s;
436 int kill;
437 int ret = 0, *arg_i = (int *)arg, tmp;
438
439 /*
440 * this is an evil hack to allow broken apps to perform mixer ioctls
441 * on dsp devices.
442 */
443
444 if (IOCGROUP(cmd) == 'M') {
445 dev_t pdev;
446
447 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(PCMUNIT(i_dev), SND_DEV_CTL, 0));
448 return mixer_ioctl(pdev, cmd, arg, mode, p);
449 }
450
451 s = spltty();
452 d = dsp_get_info(i_dev);
453 getchns(i_dev, &rdch, &wrch, 0);
454
455 kill = 0;
456 if (wrch && (wrch->flags & CHN_F_DEAD))
457 kill |= 1;
458 if (rdch && (rdch->flags & CHN_F_DEAD))
459 kill |= 2;
460 if (kill == 3) {
461 relchns(i_dev, rdch, wrch, 0);
462 splx(s);
463 return EINVAL;
464 }
465 if (kill & 1)
466 wrch = NULL;
467 if (kill & 2)
468 rdch = NULL;
469
470 switch(cmd) {
471 #ifdef OLDPCM_IOCTL
472 /*
473 * we start with the new ioctl interface.
474 */
475 case AIONWRITE: /* how many bytes can write ? */
476 /*
477 if (wrch && wrch->bufhard.dl)
478 while (chn_wrfeed(wrch) == 0);
479 */
480 *arg_i = wrch? sndbuf_getfree(wrch->bufsoft) : 0;
481 break;
482
483 case AIOSSIZE: /* set the current blocksize */
484 {
485 struct snd_size *p = (struct snd_size *)arg;
486
487 p->play_size = 0;
488 p->rec_size = 0;
489 if (wrch) {
490 CHN_LOCK(wrch);
491 chn_setblocksize(wrch, 2, p->play_size);
492 p->play_size = sndbuf_getblksz(wrch->bufsoft);
493 CHN_UNLOCK(wrch);
494 }
495 if (rdch) {
496 CHN_LOCK(rdch);
497 chn_setblocksize(rdch, 2, p->rec_size);
498 p->rec_size = sndbuf_getblksz(rdch->bufsoft);
499 CHN_UNLOCK(rdch);
500 }
501 }
502 break;
503 case AIOGSIZE: /* get the current blocksize */
504 {
505 struct snd_size *p = (struct snd_size *)arg;
506
507 if (wrch)
508 p->play_size = sndbuf_getblksz(wrch->bufsoft);
509 if (rdch)
510 p->rec_size = sndbuf_getblksz(rdch->bufsoft);
511 }
512 break;
513
514 case AIOSFMT:
515 {
516 snd_chan_param *p = (snd_chan_param *)arg;
517
518 if (wrch) {
519 CHN_LOCK(wrch);
520 chn_setformat(wrch, p->play_format);
521 chn_setspeed(wrch, p->play_rate);
522 CHN_UNLOCK(wrch);
523 }
524 if (rdch) {
525 CHN_LOCK(rdch);
526 chn_setformat(rdch, p->rec_format);
527 chn_setspeed(rdch, p->rec_rate);
528 CHN_UNLOCK(rdch);
529 }
530 }
531 /* FALLTHROUGH */
532
533 case AIOGFMT:
534 {
535 snd_chan_param *p = (snd_chan_param *)arg;
536
537 p->play_rate = wrch? wrch->speed : 0;
538 p->rec_rate = rdch? rdch->speed : 0;
539 p->play_format = wrch? wrch->format : 0;
540 p->rec_format = rdch? rdch->format : 0;
541 }
542 break;
543
544 case AIOGCAP: /* get capabilities */
545 {
546 snd_capabilities *p = (snd_capabilities *)arg;
547 struct pcmchan_caps *pcaps = NULL, *rcaps = NULL;
548 dev_t pdev;
549
550 if (rdch) {
551 CHN_LOCK(rdch);
552 rcaps = chn_getcaps(rdch);
553 }
554 if (wrch) {
555 CHN_LOCK(wrch);
556 pcaps = chn_getcaps(wrch);
557 }
558 p->rate_min = max(rcaps? rcaps->minspeed : 0,
559 pcaps? pcaps->minspeed : 0);
560 p->rate_max = min(rcaps? rcaps->maxspeed : 1000000,
561 pcaps? pcaps->maxspeed : 1000000);
562 p->bufsize = min(rdch? sndbuf_getsize(rdch->bufsoft) : 1000000,
563 wrch? sndbuf_getsize(wrch->bufsoft) : 1000000);
564 /* XXX bad on sb16 */
565 p->formats = (rdch? chn_getformats(rdch) : 0xffffffff) &
566 (wrch? chn_getformats(wrch) : 0xffffffff);
567 if (rdch && wrch)
568 p->formats |= (dsp_get_flags(i_dev) & SD_F_SIMPLEX)? 0 : AFMT_FULLDUPLEX;
569 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(PCMUNIT(i_dev), SND_DEV_CTL, 0));
570 p->mixers = 1; /* default: one mixer */
571 p->inputs = pdev->si_drv1? mix_getdevs(pdev->si_drv1) : 0;
572 p->left = p->right = 100;
573 if (wrch)
574 CHN_UNLOCK(wrch);
575 if (rdch)
576 CHN_UNLOCK(rdch);
577 }
578 break;
579
580 case AIOSTOP:
581 if (*arg_i == AIOSYNC_PLAY && wrch)
582 *arg_i = chn_abort(wrch);
583 else if (*arg_i == AIOSYNC_CAPTURE && rdch)
584 *arg_i = chn_abort(rdch);
585 else {
586 printf("AIOSTOP: bad channel 0x%x\n", *arg_i);
587 *arg_i = 0;
588 }
589 break;
590
591 case AIOSYNC:
592 printf("AIOSYNC chan 0x%03lx pos %lu unimplemented\n",
593 ((snd_sync_parm *)arg)->chan, ((snd_sync_parm *)arg)->pos);
594 break;
595 #endif
596 /*
597 * here follow the standard ioctls (filio.h etc.)
598 */
599 case FIONREAD: /* get # bytes to read */
600 /* if (rdch && rdch->bufhard.dl)
601 while (chn_rdfeed(rdch) == 0);
602 */ *arg_i = rdch? sndbuf_getready(rdch->bufsoft) : 0;
603 break;
604
605 case FIOASYNC: /*set/clear async i/o */
606 DEB( printf("FIOASYNC\n") ; )
607 break;
608
609 case SNDCTL_DSP_NONBLOCK:
610 case FIONBIO: /* set/clear non-blocking i/o */
611 if (rdch)
612 rdch->flags &= ~CHN_F_NBIO;
613 if (wrch)
614 wrch->flags &= ~CHN_F_NBIO;
615 if (*arg_i) {
616 if (rdch)
617 rdch->flags |= CHN_F_NBIO;
618 if (wrch)
619 wrch->flags |= CHN_F_NBIO;
620 }
621 break;
622
623 /*
624 * Finally, here is the linux-compatible ioctl interface
625 */
626 #define THE_REAL_SNDCTL_DSP_GETBLKSIZE _IOWR('P', 4, int)
627 case THE_REAL_SNDCTL_DSP_GETBLKSIZE:
628 case SNDCTL_DSP_GETBLKSIZE:
629 if (wrch)
630 *arg_i = sndbuf_getblksz(wrch->bufsoft);
631 else if (rdch)
632 *arg_i = sndbuf_getblksz(rdch->bufsoft);
633 else
634 *arg_i = 0;
635 break ;
636
637 case SNDCTL_DSP_SETBLKSIZE:
638 RANGE(*arg_i, 16, 65536);
639 if (wrch) {
640 CHN_LOCK(wrch);
641 chn_setblocksize(wrch, 2, *arg_i);
642 CHN_UNLOCK(wrch);
643 }
644 if (rdch) {
645 CHN_LOCK(rdch);
646 chn_setblocksize(rdch, 2, *arg_i);
647 CHN_UNLOCK(rdch);
648 }
649 break;
650
651 case SNDCTL_DSP_RESET:
652 DEB(printf("dsp reset\n"));
653 if (wrch)
654 chn_abort(wrch);
655 if (rdch)
656 chn_abort(rdch);
657 break;
658
659 case SNDCTL_DSP_SYNC:
660 DEB(printf("dsp sync\n"));
661 /* chn_sync may sleep */
662 if (wrch) {
663 CHN_LOCK(wrch);
664 chn_sync(wrch, sndbuf_getsize(wrch->bufsoft) - 4);
665 CHN_UNLOCK(wrch);
666 }
667 break;
668
669 case SNDCTL_DSP_SPEED:
670 /* chn_setspeed may sleep */
671 tmp = 0;
672 if (wrch) {
673 CHN_LOCK(wrch);
674 ret = chn_setspeed(wrch, *arg_i);
675 tmp = wrch->speed;
676 CHN_UNLOCK(wrch);
677 }
678 if (rdch && ret == 0) {
679 CHN_LOCK(rdch);
680 ret = chn_setspeed(rdch, *arg_i);
681 if (tmp == 0)
682 tmp = rdch->speed;
683 CHN_UNLOCK(rdch);
684 }
685 *arg_i = tmp;
686 break;
687
688 case SOUND_PCM_READ_RATE:
689 *arg_i = wrch? wrch->speed : rdch->speed;
690 break;
691
692 case SNDCTL_DSP_STEREO:
693 tmp = -1;
694 *arg_i = (*arg_i)? AFMT_STEREO : 0;
695 if (wrch) {
696 CHN_LOCK(wrch);
697 ret = chn_setformat(wrch, (wrch->format & ~AFMT_STEREO) | *arg_i);
698 tmp = (wrch->format & AFMT_STEREO)? 1 : 0;
699 CHN_UNLOCK(wrch);
700 }
701 if (rdch && ret == 0) {
702 CHN_LOCK(rdch);
703 ret = chn_setformat(rdch, (rdch->format & ~AFMT_STEREO) | *arg_i);
704 if (tmp == -1)
705 tmp = (rdch->format & AFMT_STEREO)? 1 : 0;
706 CHN_UNLOCK(rdch);
707 }
708 *arg_i = tmp;
709 break;
710
711 case SOUND_PCM_WRITE_CHANNELS:
712 /* case SNDCTL_DSP_CHANNELS: ( == SOUND_PCM_WRITE_CHANNELS) */
713 if (*arg_i != 0) {
714 tmp = 0;
715 *arg_i = (*arg_i != 1)? AFMT_STEREO : 0;
716 if (wrch) {
717 CHN_LOCK(wrch);
718 ret = chn_setformat(wrch, (wrch->format & ~AFMT_STEREO) | *arg_i);
719 tmp = (wrch->format & AFMT_STEREO)? 2 : 1;
720 CHN_UNLOCK(wrch);
721 }
722 if (rdch && ret == 0) {
723 CHN_LOCK(rdch);
724 ret = chn_setformat(rdch, (rdch->format & ~AFMT_STEREO) | *arg_i);
725 if (tmp == 0)
726 tmp = (rdch->format & AFMT_STEREO)? 2 : 1;
727 CHN_UNLOCK(rdch);
728 }
729 *arg_i = tmp;
730 } else {
731 *arg_i = ((wrch? wrch->format : rdch->format) & AFMT_STEREO)? 2 : 1;
732 }
733 break;
734
735 case SOUND_PCM_READ_CHANNELS:
736 *arg_i = ((wrch? wrch->format : rdch->format) & AFMT_STEREO)? 2 : 1;
737 break;
738
739 case SNDCTL_DSP_GETFMTS: /* returns a mask of supported fmts */
740 *arg_i = wrch? chn_getformats(wrch) : chn_getformats(rdch);
741 break ;
742
743 case SNDCTL_DSP_SETFMT: /* sets _one_ format */
744 /* XXX locking */
745 if ((*arg_i != AFMT_QUERY)) {
746 tmp = 0;
747 if (wrch) {
748 CHN_LOCK(wrch);
749 ret = chn_setformat(wrch, (*arg_i) | (wrch->format & AFMT_STEREO));
750 tmp = wrch->format & ~AFMT_STEREO;
751 CHN_UNLOCK(wrch);
752 }
753 if (rdch && ret == 0) {
754 CHN_LOCK(rdch);
755 ret = chn_setformat(rdch, (*arg_i) | (rdch->format & AFMT_STEREO));
756 if (tmp == 0)
757 tmp = rdch->format & ~AFMT_STEREO;
758 CHN_UNLOCK(rdch);
759 }
760 *arg_i = tmp;
761 } else
762 *arg_i = (wrch? wrch->format : rdch->format) & ~AFMT_STEREO;
763 break;
764
765 case SNDCTL_DSP_SETFRAGMENT:
766 /* XXX locking */
767 DEB(printf("SNDCTL_DSP_SETFRAGMENT 0x%08x\n", *(int *)arg));
768 {
769 u_int32_t fragln = (*arg_i) & 0x0000ffff;
770 u_int32_t maxfrags = ((*arg_i) & 0xffff0000) >> 16;
771 u_int32_t fragsz;
772
773 RANGE(fragln, 4, 16);
774 fragsz = 1 << fragln;
775
776 if (maxfrags == 0)
777 maxfrags = CHN_2NDBUFMAXSIZE / fragsz;
778 if (maxfrags < 2) {
779 ret = EINVAL;
780 break;
781 }
782 if (maxfrags * fragsz > CHN_2NDBUFMAXSIZE)
783 maxfrags = CHN_2NDBUFMAXSIZE / fragsz;
784
785 DEB(printf("SNDCTL_DSP_SETFRAGMENT %d frags, %d sz\n", maxfrags, fragsz));
786 if (rdch) {
787 CHN_LOCK(rdch);
788 ret = chn_setblocksize(rdch, maxfrags, fragsz);
789 maxfrags = sndbuf_getblkcnt(rdch->bufsoft);
790 fragsz = sndbuf_getblksz(rdch->bufsoft);
791 CHN_UNLOCK(rdch);
792 }
793 if (wrch && ret == 0) {
794 CHN_LOCK(wrch);
795 ret = chn_setblocksize(wrch, maxfrags, fragsz);
796 maxfrags = sndbuf_getblkcnt(wrch->bufsoft);
797 fragsz = sndbuf_getblksz(wrch->bufsoft);
798 CHN_UNLOCK(wrch);
799 }
800
801 fragln = 0;
802 while (fragsz > 1) {
803 fragln++;
804 fragsz >>= 1;
805 }
806 *arg_i = (maxfrags << 16) | fragln;
807 }
808 break;
809
810 case SNDCTL_DSP_GETISPACE:
811 /* return the size of data available in the input queue */
812 {
813 audio_buf_info *a = (audio_buf_info *)arg;
814 if (rdch) {
815 struct snd_dbuf *bs = rdch->bufsoft;
816
817 CHN_LOCK(rdch);
818 a->bytes = sndbuf_getready(bs);
819 a->fragments = a->bytes / sndbuf_getblksz(bs);
820 a->fragstotal = sndbuf_getblkcnt(bs);
821 a->fragsize = sndbuf_getblksz(bs);
822 CHN_UNLOCK(rdch);
823 }
824 }
825 break;
826
827 case SNDCTL_DSP_GETOSPACE:
828 /* return space available in the output queue */
829 {
830 audio_buf_info *a = (audio_buf_info *)arg;
831 if (wrch) {
832 struct snd_dbuf *bs = wrch->bufsoft;
833
834 CHN_LOCK(wrch);
835 chn_wrupdate(wrch);
836 a->bytes = sndbuf_getfree(bs);
837 a->fragments = a->bytes / sndbuf_getblksz(bs);
838 a->fragstotal = sndbuf_getblkcnt(bs);
839 a->fragsize = sndbuf_getblksz(bs);
840 CHN_UNLOCK(wrch);
841 }
842 }
843 break;
844
845 case SNDCTL_DSP_GETIPTR:
846 {
847 count_info *a = (count_info *)arg;
848 if (rdch) {
849 struct snd_dbuf *bs = rdch->bufsoft;
850
851 CHN_LOCK(rdch);
852 chn_rdupdate(rdch);
853 a->bytes = sndbuf_gettotal(bs);
854 a->blocks = sndbuf_getblocks(bs) - rdch->blocks;
855 a->ptr = sndbuf_getreadyptr(bs);
856 rdch->blocks = sndbuf_getblocks(bs);
857 CHN_UNLOCK(rdch);
858 } else
859 ret = EINVAL;
860 }
861 break;
862
863 case SNDCTL_DSP_GETOPTR:
864 {
865 count_info *a = (count_info *)arg;
866 if (wrch) {
867 struct snd_dbuf *bs = wrch->bufsoft;
868
869 CHN_LOCK(wrch);
870 chn_wrupdate(wrch);
871 a->bytes = sndbuf_gettotal(bs);
872 a->blocks = sndbuf_getblocks(bs) - wrch->blocks;
873 a->ptr = sndbuf_getreadyptr(bs);
874 wrch->blocks = sndbuf_getblocks(bs);
875 CHN_UNLOCK(wrch);
876 } else
877 ret = EINVAL;
878 }
879 break;
880
881 case SNDCTL_DSP_GETCAPS:
882 *arg_i = DSP_CAP_REALTIME | DSP_CAP_MMAP | DSP_CAP_TRIGGER;
883 if (rdch && wrch && !(dsp_get_flags(i_dev) & SD_F_SIMPLEX))
884 *arg_i |= DSP_CAP_DUPLEX;
885 break;
886
887 case SOUND_PCM_READ_BITS:
888 *arg_i = ((wrch? wrch->format : rdch->format) & AFMT_16BIT)? 16 : 8;
889 break;
890
891 case SNDCTL_DSP_SETTRIGGER:
892 if (rdch) {
893 CHN_LOCK(rdch);
894 rdch->flags &= ~(CHN_F_TRIGGERED | CHN_F_NOTRIGGER);
895 if (*arg_i & PCM_ENABLE_INPUT)
896 chn_start(rdch, 1);
897 else
898 rdch->flags |= CHN_F_NOTRIGGER;
899 CHN_UNLOCK(rdch);
900 }
901 if (wrch) {
902 CHN_LOCK(wrch);
903 wrch->flags &= ~(CHN_F_TRIGGERED | CHN_F_NOTRIGGER);
904 if (*arg_i & PCM_ENABLE_OUTPUT)
905 chn_start(wrch, 1);
906 else
907 wrch->flags |= CHN_F_NOTRIGGER;
908 CHN_UNLOCK(wrch);
909 }
910 break;
911
912 case SNDCTL_DSP_GETTRIGGER:
913 *arg_i = 0;
914 if (wrch && wrch->flags & CHN_F_TRIGGERED)
915 *arg_i |= PCM_ENABLE_OUTPUT;
916 if (rdch && rdch->flags & CHN_F_TRIGGERED)
917 *arg_i |= PCM_ENABLE_INPUT;
918 break;
919
920 case SNDCTL_DSP_GETODELAY:
921 if (wrch) {
922 struct snd_dbuf *b = wrch->bufhard;
923 struct snd_dbuf *bs = wrch->bufsoft;
924
925 CHN_LOCK(wrch);
926 chn_wrupdate(wrch);
927 *arg_i = sndbuf_getready(b) + sndbuf_getready(bs);
928 CHN_UNLOCK(wrch);
929 } else
930 ret = EINVAL;
931 break;
932
933 case SNDCTL_DSP_POST:
934 if (wrch) {
935 CHN_LOCK(wrch);
936 wrch->flags &= ~CHN_F_NOTRIGGER;
937 chn_start(wrch, 1);
938 CHN_UNLOCK(wrch);
939 }
940 break;
941
942 case SNDCTL_DSP_SETDUPLEX:
943 /*
944 * switch to full-duplex mode if card is in half-duplex
945 * mode and is able to work in full-duplex mode
946 */
947 if (rdch && wrch && (dsp_get_flags(i_dev) & SD_F_SIMPLEX))
948 dsp_set_flags(i_dev, dsp_get_flags(i_dev)^SD_F_SIMPLEX);
949 break;
950
951 case SNDCTL_DSP_MAPINBUF:
952 case SNDCTL_DSP_MAPOUTBUF:
953 case SNDCTL_DSP_SETSYNCRO:
954 /* undocumented */
955
956 case SNDCTL_DSP_SUBDIVIDE:
957 case SOUND_PCM_WRITE_FILTER:
958 case SOUND_PCM_READ_FILTER:
959 /* dunno what these do, don't sound important */
960
961 default:
962 DEB(printf("default ioctl fn 0x%08lx fail\n", cmd));
963 ret = EINVAL;
964 break;
965 }
966 relchns(i_dev, rdch, wrch, 0);
967 splx(s);
968 return ret;
969 }
970
971 static int
972 dsp_poll(dev_t i_dev, int events, struct proc *p)
973 {
974 struct pcm_channel *wrch = NULL, *rdch = NULL;
975 intrmask_t s;
976 int ret, e;
977
978 s = spltty();
979 ret = 0;
980 getchns(i_dev, &rdch, &wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
981
982 if (wrch) {
983 e = (events & (POLLOUT | POLLWRNORM));
984 if (e)
985 ret |= chn_poll(wrch, e, p);
986 }
987 if (rdch) {
988 e = (events & (POLLIN | POLLRDNORM));
989 if (e)
990 ret |= chn_poll(rdch, e, p);
991 }
992 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
993
994 splx(s);
995 return ret;
996 }
997
998 static int
999 dsp_mmap(dev_t i_dev, vm_offset_t offset, int nprot)
1000 {
1001 struct pcm_channel *wrch = NULL, *rdch = NULL, *c;
1002 intrmask_t s;
1003 int ret;
1004
1005 if (nprot & PROT_EXEC)
1006 return -1;
1007
1008 s = spltty();
1009 getchns(i_dev, &rdch, &wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1010 #if 0
1011 /*
1012 * XXX the linux api uses the nprot to select read/write buffer
1013 * our vm system doesn't allow this, so force write buffer
1014 */
1015
1016 if (wrch && (nprot & PROT_WRITE)) {
1017 c = wrch;
1018 } else if (rdch && (nprot & PROT_READ)) {
1019 c = rdch;
1020 } else {
1021 splx(s);
1022 return -1;
1023 }
1024 #else
1025 c = wrch;
1026 #endif
1027
1028 if (c == NULL) {
1029 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1030 splx(s);
1031 return -1;
1032 }
1033
1034 if (offset >= sndbuf_getsize(c->bufsoft)) {
1035 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1036 splx(s);
1037 return -1;
1038 }
1039
1040 if (!(c->flags & CHN_F_MAPPED))
1041 c->flags |= CHN_F_MAPPED;
1042
1043 ret = atop(vtophys(sndbuf_getbufofs(c->bufsoft, offset)));
1044 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1045
1046 splx(s);
1047 return ret;
1048 }
1049
1050 int
1051 dsp_register(int unit, int channel)
1052 {
1053 make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_DSP, channel),
1054 UID_ROOT, GID_WHEEL, 0666, "dsp%d.%d", unit, channel);
1055 make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_DSP16, channel),
1056 UID_ROOT, GID_WHEEL, 0666, "dspW%d.%d", unit, channel);
1057 make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_AUDIO, channel),
1058 UID_ROOT, GID_WHEEL, 0666, "audio%d.%d", unit, channel);
1059
1060 return 0;
1061 }
1062
1063 int
1064 dsp_registerrec(int unit, int channel)
1065 {
1066 make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_DSPREC, channel),
1067 UID_ROOT, GID_WHEEL, 0666, "dspr%d.%d", unit, channel);
1068
1069 return 0;
1070 }
1071
1072 int
1073 dsp_unregister(int unit, int channel)
1074 {
1075 dev_t pdev;
1076
1077 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_DSP, channel));
1078 destroy_dev(pdev);
1079 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_DSP16, channel));
1080 destroy_dev(pdev);
1081 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_AUDIO, channel));
1082 destroy_dev(pdev);
1083
1084 return 0;
1085 }
1086
1087 int
1088 dsp_unregisterrec(int unit, int channel)
1089 {
1090 dev_t pdev;
1091
1092 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_DSPREC, channel));
1093 destroy_dev(pdev);
1094
1095 return 0;
1096 }
1097
1098 #ifdef USING_DEVFS
1099 static void
1100 dsp_clone(void *arg, char *name, int namelen, dev_t *dev)
1101 {
1102 dev_t pdev;
1103 int i, cont, unit, devtype;
1104 int devtypes[3] = {SND_DEV_DSP, SND_DEV_DSP16, SND_DEV_AUDIO};
1105 char *devnames[3] = {"dsp", "dspW", "audio"};
1106
1107 if (*dev != NODEV)
1108 return;
1109 if (pcm_devclass == NULL)
1110 return;
1111
1112 devtype = 0;
1113 unit = -1;
1114 for (i = 0; (i < 3) && (unit == -1); i++) {
1115 devtype = devtypes[i];
1116 if (strcmp(name, devnames[i]) == 0) {
1117 unit = snd_unit;
1118 } else {
1119 if (dev_stdclone(name, NULL, devnames[i], &unit) != 1)
1120 unit = -1;
1121 }
1122 }
1123 if (unit == -1 || unit >= devclass_get_maxunit(pcm_devclass))
1124 return;
1125
1126 cont = 1;
1127 for (i = 0; cont; i++) {
1128 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, devtype, i));
1129 if (pdev->si_flags & SI_NAMED) {
1130 if ((pdev->si_drv1 == NULL) && (pdev->si_drv2 == NULL)) {
1131 *dev = pdev;
1132 return;
1133 }
1134 } else {
1135 cont = 0;
1136 }
1137 }
1138 }
1139
1140 static void
1141 dsp_sysinit(void *p)
1142 {
1143 dsp_ehtag = EVENTHANDLER_REGISTER(dev_clone, dsp_clone, 0, 1000);
1144 }
1145
1146 static void
1147 dsp_sysuninit(void *p)
1148 {
1149 if (dsp_ehtag != NULL)
1150 EVENTHANDLER_DEREGISTER(dev_clone, dsp_ehtag);
1151 }
1152
1153 SYSINIT(dsp_sysinit, SI_SUB_DRIVERS, SI_ORDER_MIDDLE, dsp_sysinit, NULL);
1154 SYSUNINIT(dsp_sysuninit, SI_SUB_DRIVERS, SI_ORDER_MIDDLE, dsp_sysuninit, NULL);
1155 #endif
1156
1157
Cache object: 5539e8b26315b0c6f52d76cb9d44004d
|