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: src/sys/dev/sound/pcm/dsp.c,v 1.15.2.13 2002/08/30 13:53:03 orion Exp $");
  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_MAPINBUF:
 943         case SNDCTL_DSP_MAPOUTBUF:
 944         case SNDCTL_DSP_SETSYNCRO:
 945                 /* undocumented */
 946
 947         case SNDCTL_DSP_SUBDIVIDE:
 948         case SOUND_PCM_WRITE_FILTER:
 949         case SOUND_PCM_READ_FILTER:
 950                 /* dunno what these do, don't sound important */
 951         default:
 952                 DEB(printf("default ioctl fn 0x%08lx fail\n", cmd));
 953                 ret = EINVAL;
 954                 break;
 955         }
 956         relchns(i_dev, rdch, wrch, 0);
 957         splx(s);
 958         return ret;
 959 }
 960
 961 static int
 962 dsp_poll(dev_t i_dev, int events, struct proc *p)
 963 {
 964         struct pcm_channel *wrch = NULL, *rdch = NULL;
 965         intrmask_t s;
 966         int ret, e;
 967
 968         s = spltty();
 969         ret = 0;
 970         getchns(i_dev, &rdch, &wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
 971
 972         if (wrch) {
 973                 e = (events & (POLLOUT | POLLWRNORM));
 974                 if (e)
 975                         ret |= chn_poll(wrch, e, p);
 976         }
 977         if (rdch) {
 978                 e = (events & (POLLIN | POLLRDNORM));
 979                 if (e)
 980                         ret |= chn_poll(rdch, e, p);
 981         }
 982         relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
 983
 984         splx(s);
 985         return ret;
 986 }
 987
 988 static int
 989 dsp_mmap(dev_t i_dev, vm_offset_t offset, int nprot)
 990 {
 991         struct pcm_channel *wrch = NULL, *rdch = NULL, *c;
 992         intrmask_t s;
 993         int ret;
 994
 995         if (nprot & PROT_EXEC)
 996                 return -1;
 997
 998         s = spltty();
 999         getchns(i_dev, &rdch, &wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1000 #if 0
1001         /*
1002          * XXX the linux api uses the nprot to select read/write buffer
1003          * our vm system doesn't allow this, so force write buffer
1004          */
1005
1006         if (wrch && (nprot & PROT_WRITE)) {
1007                 c = wrch;
1008         } else if (rdch && (nprot & PROT_READ)) {
1009                 c = rdch;
1010         } else {
1011                 splx(s);
1012                 return -1;
1013         }
1014 #else
1015         c = wrch;
1016 #endif
1017
1018         if (c == NULL) {
1019                 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1020                 splx(s);
1021                 return -1;
1022         }
1023
1024         if (offset >= sndbuf_getsize(c->bufsoft)) {
1025                 relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1026                 splx(s);
1027                 return -1;
1028         }
1029
1030         if (!(c->flags & CHN_F_MAPPED))
1031                 c->flags |= CHN_F_MAPPED;
1032
1033         ret = atop(vtophys(sndbuf_getbufofs(c->bufsoft, offset)));
1034         relchns(i_dev, rdch, wrch, SD_F_PRIO_RD | SD_F_PRIO_WR);
1035
1036         splx(s);
1037         return ret;
1038 }
1039
1040 int
1041 dsp_register(int unit, int channel)
1042 {
1043         make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_DSP, channel),
1044                  UID_ROOT, GID_WHEEL, 0666, "dsp%d.%d", unit, channel);
1045         make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_DSP16, channel),
1046                  UID_ROOT, GID_WHEEL, 0666, "dspW%d.%d", unit, channel);
1047         make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_AUDIO, channel),
1048                  UID_ROOT, GID_WHEEL, 0666, "audio%d.%d", unit, channel);
1049
1050         return 0;
1051 }
1052
1053 int
1054 dsp_registerrec(int unit, int channel)
1055 {
1056         make_dev(&dsp_cdevsw, PCMMKMINOR(unit, SND_DEV_DSPREC, channel),
1057                  UID_ROOT, GID_WHEEL, 0666, "dspr%d.%d", unit, channel);
1058
1059         return 0;
1060 }
1061
1062 int
1063 dsp_unregister(int unit, int channel)
1064 {
1065         dev_t pdev;
1066
1067         pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_DSP, channel));
1068         destroy_dev(pdev);
1069         pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_DSP16, channel));
1070         destroy_dev(pdev);
1071         pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_AUDIO, channel));
1072         destroy_dev(pdev);
1073
1074         return 0;
1075 }
1076
1077 int
1078 dsp_unregisterrec(int unit, int channel)
1079 {
1080         dev_t pdev;
1081
1082         pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, SND_DEV_DSPREC, channel));
1083         destroy_dev(pdev);
1084
1085         return 0;
1086 }
1087
1088 #ifdef USING_DEVFS
1089 static void
1090 dsp_clone(void *arg, char *name, int namelen, dev_t *dev)
1091 {
1092         dev_t pdev;
1093         int i, cont, unit, devtype;
1094         int devtypes[3] = {SND_DEV_DSP, SND_DEV_DSP16, SND_DEV_AUDIO};
1095         char *devnames[3] = {"dsp", "dspW", "audio"};
1096
1097         if (*dev != NODEV)
1098                 return;
1099         if (pcm_devclass == NULL)
1100                 return;
1101
1102         devtype = 0;
1103         unit = -1;
1104         for (i = 0; (i < 3) && (unit == -1); i++) {
1105                 devtype = devtypes[i];
1106                 if (strcmp(name, devnames[i]) == 0) {
1107                         unit = snd_unit;
1108                 } else {
1109                         if (dev_stdclone(name, NULL, devnames[i], &unit) != 1)
1110                                 unit = -1;
1111                 }
1112         }
1113         if (unit == -1 || unit >= devclass_get_maxunit(pcm_devclass))
1114                 return;
1115
1116         cont = 1;
1117         for (i = 0; cont; i++) {
1118                 pdev = makedev(SND_CDEV_MAJOR, PCMMKMINOR(unit, devtype, i));
1119                 if (pdev->si_flags & SI_NAMED) {
1120                         if ((pdev->si_drv1 == NULL) && (pdev->si_drv2 == NULL)) {
1121                                 *dev = pdev;
1122                                 return;
1123                         }
1124                 } else {
1125                         cont = 0;
1126                 }
1127         }
1128 }
1129
1130 static void
1131 dsp_sysinit(void *p)
1132 {
1133         dsp_ehtag = EVENTHANDLER_REGISTER(dev_clone, dsp_clone, 0, 1000);
1134 }
1135
1136 static void
1137 dsp_sysuninit(void *p)
1138 {
1139         if (dsp_ehtag != NULL)
1140                 EVENTHANDLER_DEREGISTER(dev_clone, dsp_ehtag);
1141 }
1142
1143 SYSINIT(dsp_sysinit, SI_SUB_DRIVERS, SI_ORDER_MIDDLE, dsp_sysinit, NULL);
1144 SYSUNINIT(dsp_sysuninit, SI_SUB_DRIVERS, SI_ORDER_MIDDLE, dsp_sysuninit, NULL);
1145 #endif
1146
1147