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