audio/ossaudio.c

   1 /*
   2  * QEMU OSS audio driver
   3  *
   4  * Copyright (c) 2003-2005 Vassili Karpov (malc)
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a copy
   7  * of this software and associated documentation files (the "Software"), to deal
   8  * in the Software without restriction, including without limitation the rights
   9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10  * copies of the Software, and to permit persons to whom the Software is
  11  * furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22  * THE SOFTWARE.
  23  */
  24 #include "qemu/osdep.h"
  25 #include <sys/ioctl.h>
  26 #include <sys/soundcard.h>
  27 #include "qemu-common.h"
  28 #include "qemu/main-loop.h"
  29 #include "qemu/host-utils.h"
  30 #include "audio.h"
  31 #include "trace.h"
  32
  33 #define AUDIO_CAP "oss"
  34 #include "audio_int.h"
  35
  36 #if defined OSS_GETVERSION && defined SNDCTL_DSP_POLICY
  37 #define USE_DSP_POLICY
  38 #endif
  39
  40 typedef struct OSSConf {
  41     int try_mmap;
  42     int nfrags;
  43     int fragsize;
  44     const char *devpath_out;
  45     const char *devpath_in;
  46     int exclusive;
  47     int policy;
  48 } OSSConf;
  49
  50 typedef struct OSSVoiceOut {
  51     HWVoiceOut hw;
  52     void *pcm_buf;
  53     int fd;
  54     int wpos;
  55     int nfrags;
  56     int fragsize;
  57     int mmapped;
  58     int pending;
  59     OSSConf *conf;
  60 } OSSVoiceOut;
  61
  62 typedef struct OSSVoiceIn {
  63     HWVoiceIn hw;
  64     void *pcm_buf;
  65     int fd;
  66     int nfrags;
  67     int fragsize;
  68     OSSConf *conf;
  69 } OSSVoiceIn;
  70
  71 struct oss_params {
  72     int freq;
  73     audfmt_e fmt;
  74     int nchannels;
  75     int nfrags;
  76     int fragsize;
  77 };
  78
  79 static void GCC_FMT_ATTR (2, 3) oss_logerr (int err, const char *fmt, ...)
  80 {
  81     va_list ap;
  82
  83     va_start (ap, fmt);
  84     AUD_vlog (AUDIO_CAP, fmt, ap);
  85     va_end (ap);
  86
  87     AUD_log (AUDIO_CAP, "Reason: %s\n", strerror (err));
  88 }
  89
  90 static void GCC_FMT_ATTR (3, 4) oss_logerr2 (
  91     int err,
  92     const char *typ,
  93     const char *fmt,
  94     ...
  95     )
  96 {
  97     va_list ap;
  98
  99     AUD_log (AUDIO_CAP, "Could not initialize %s\n", typ);
 100
 101     va_start (ap, fmt);
 102     AUD_vlog (AUDIO_CAP, fmt, ap);
 103     va_end (ap);
 104
 105     AUD_log (AUDIO_CAP, "Reason: %s\n", strerror (err));
 106 }
 107
 108 static void oss_anal_close (int *fdp)
 109 {
 110     int err;
 111
 112     qemu_set_fd_handler (*fdp, NULL, NULL, NULL);
 113     err = close (*fdp);
 114     if (err) {
 115         oss_logerr (errno, "Failed to close file(fd=%d)\n", *fdp);
 116     }
 117     *fdp = -1;
 118 }
 119
 120 static void oss_helper_poll_out (void *opaque)
 121 {
 122     (void) opaque;
 123     audio_run ("oss_poll_out");
 124 }
 125
 126 static void oss_helper_poll_in (void *opaque)
 127 {
 128     (void) opaque;
 129     audio_run ("oss_poll_in");
 130 }
 131
 132 static void oss_poll_out (HWVoiceOut *hw)
 133 {
 134     OSSVoiceOut *oss = (OSSVoiceOut *) hw;
 135
 136     qemu_set_fd_handler (oss->fd, NULL, oss_helper_poll_out, NULL);
 137 }
 138
 139 static void oss_poll_in (HWVoiceIn *hw)
 140 {
 141     OSSVoiceIn *oss = (OSSVoiceIn *) hw;
 142
 143     qemu_set_fd_handler (oss->fd, oss_helper_poll_in, NULL, NULL);
 144 }
 145
 146 static int oss_write (SWVoiceOut *sw, void *buf, int len)
 147 {
 148     return audio_pcm_sw_write (sw, buf, len);
 149 }
 150
 151 static int aud_to_ossfmt (audfmt_e fmt, int endianness)
 152 {
 153     switch (fmt) {
 154     case AUD_FMT_S8:
 155         return AFMT_S8;
 156
 157     case AUD_FMT_U8:
 158         return AFMT_U8;
 159
 160     case AUD_FMT_S16:
 161         if (endianness) {
 162             return AFMT_S16_BE;
 163         }
 164         else {
 165             return AFMT_S16_LE;
 166         }
 167
 168     case AUD_FMT_U16:
 169         if (endianness) {
 170             return AFMT_U16_BE;
 171         }
 172         else {
 173             return AFMT_U16_LE;
 174         }
 175
 176     default:
 177         dolog ("Internal logic error: Bad audio format %d\n", fmt);
 178 #ifdef DEBUG_AUDIO
 179         abort ();
 180 #endif
 181         return AFMT_U8;
 182     }
 183 }
 184
 185 static int oss_to_audfmt (int ossfmt, audfmt_e *fmt, int *endianness)
 186 {
 187     switch (ossfmt) {
 188     case AFMT_S8:
 189         *endianness = 0;
 190         *fmt = AUD_FMT_S8;
 191         break;
 192
 193     case AFMT_U8:
 194         *endianness = 0;
 195         *fmt = AUD_FMT_U8;
 196         break;
 197
 198     case AFMT_S16_LE:
 199         *endianness = 0;
 200         *fmt = AUD_FMT_S16;
 201         break;
 202
 203     case AFMT_U16_LE:
 204         *endianness = 0;
 205         *fmt = AUD_FMT_U16;
 206         break;
 207
 208     case AFMT_S16_BE:
 209         *endianness = 1;
 210         *fmt = AUD_FMT_S16;
 211         break;
 212
 213     case AFMT_U16_BE:
 214         *endianness = 1;
 215         *fmt = AUD_FMT_U16;
 216         break;
 217
 218     default:
 219         dolog ("Unrecognized audio format %d\n", ossfmt);
 220         return -1;
 221     }
 222
 223     return 0;
 224 }
 225
 226 #if defined DEBUG_MISMATCHES || defined DEBUG
 227 static void oss_dump_info (struct oss_params *req, struct oss_params *obt)
 228 {
 229     dolog ("parameter | requested value | obtained value\n");
 230     dolog ("format    |      %10d |     %10d\n", req->fmt, obt->fmt);
 231     dolog ("channels  |      %10d |     %10d\n",
 232            req->nchannels, obt->nchannels);
 233     dolog ("frequency |      %10d |     %10d\n", req->freq, obt->freq);
 234     dolog ("nfrags    |      %10d |     %10d\n", req->nfrags, obt->nfrags);
 235     dolog ("fragsize  |      %10d |     %10d\n",
 236            req->fragsize, obt->fragsize);
 237 }
 238 #endif
 239
 240 #ifdef USE_DSP_POLICY
 241 static int oss_get_version (int fd, int *version, const char *typ)
 242 {
 243     if (ioctl (fd, OSS_GETVERSION, &version)) {
 244 #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
 245         /*
 246          * Looks like atm (20100109) FreeBSD knows OSS_GETVERSION
 247          * since 7.x, but currently only on the mixer device (or in
 248          * the Linuxolator), and in the native version that part of
 249          * the code is in fact never reached so the ioctl fails anyway.
 250          * Until this is fixed, just check the errno and if its what
 251          * FreeBSD's sound drivers return atm assume they are new enough.
 252          */
 253         if (errno == EINVAL) {
 254             *version = 0x040000;
 255             return 0;
 256         }
 257 #endif
 258         oss_logerr2 (errno, typ, "Failed to get OSS version\n");
 259         return -1;
 260     }
 261     return 0;
 262 }
 263 #endif
 264
 265 static int oss_open (int in, struct oss_params *req,
 266                      struct oss_params *obt, int *pfd, OSSConf* conf)
 267 {
 268     int fd;
 269     int oflags = conf->exclusive ? O_EXCL : 0;
 270     audio_buf_info abinfo;
 271     int fmt, freq, nchannels;
 272     int setfragment = 1;
 273     const char *dspname = in ? conf->devpath_in : conf->devpath_out;
 274     const char *typ = in ? "ADC" : "DAC";
 275
 276     /* Kludge needed to have working mmap on Linux */
 277     oflags |= conf->try_mmap ? O_RDWR : (in ? O_RDONLY : O_WRONLY);
 278
 279     fd = open (dspname, oflags | O_NONBLOCK);
 280     if (-1 == fd) {
 281         oss_logerr2 (errno, typ, "Failed to open `%s'\n", dspname);
 282         return -1;
 283     }
 284
 285     freq = req->freq;
 286     nchannels = req->nchannels;
 287     fmt = req->fmt;
 288
 289     if (ioctl (fd, SNDCTL_DSP_SAMPLESIZE, &fmt)) {
 290         oss_logerr2 (errno, typ, "Failed to set sample size %d\n", req->fmt);
 291         goto err;
 292     }
 293
 294     if (ioctl (fd, SNDCTL_DSP_CHANNELS, &nchannels)) {
 295         oss_logerr2 (errno, typ, "Failed to set number of channels %d\n",
 296                      req->nchannels);
 297         goto err;
 298     }
 299
 300     if (ioctl (fd, SNDCTL_DSP_SPEED, &freq)) {
 301         oss_logerr2 (errno, typ, "Failed to set frequency %d\n", req->freq);
 302         goto err;
 303     }
 304
 305     if (ioctl (fd, SNDCTL_DSP_NONBLOCK, NULL)) {
 306         oss_logerr2 (errno, typ, "Failed to set non-blocking mode\n");
 307         goto err;
 308     }
 309
 310 #ifdef USE_DSP_POLICY
 311     if (conf->policy >= 0) {
 312         int version;
 313
 314         if (!oss_get_version (fd, &version, typ)) {
 315             trace_oss_version(version);
 316
 317             if (version >= 0x040000) {
 318                 int policy = conf->policy;
 319                 if (ioctl (fd, SNDCTL_DSP_POLICY, &policy)) {
 320                     oss_logerr2 (errno, typ,
 321                                  "Failed to set timing policy to %d\n",
 322                                  conf->policy);
 323                     goto err;
 324                 }
 325                 setfragment = 0;
 326             }
 327         }
 328     }
 329 #endif
 330
 331     if (setfragment) {
 332         int mmmmssss = (req->nfrags << 16) | ctz32 (req->fragsize);
 333         if (ioctl (fd, SNDCTL_DSP_SETFRAGMENT, &mmmmssss)) {
 334             oss_logerr2 (errno, typ, "Failed to set buffer length (%d, %d)\n",
 335                          req->nfrags, req->fragsize);
 336             goto err;
 337         }
 338     }
 339
 340     if (ioctl (fd, in ? SNDCTL_DSP_GETISPACE : SNDCTL_DSP_GETOSPACE, &abinfo)) {
 341         oss_logerr2 (errno, typ, "Failed to get buffer length\n");
 342         goto err;
 343     }
 344
 345     if (!abinfo.fragstotal || !abinfo.fragsize) {
 346         AUD_log (AUDIO_CAP, "Returned bogus buffer information(%d, %d) for %s\n",
 347                  abinfo.fragstotal, abinfo.fragsize, typ);
 348         goto err;
 349     }
 350
 351     obt->fmt = fmt;
 352     obt->nchannels = nchannels;
 353     obt->freq = freq;
 354     obt->nfrags = abinfo.fragstotal;
 355     obt->fragsize = abinfo.fragsize;
 356     *pfd = fd;
 357
 358 #ifdef DEBUG_MISMATCHES
 359     if ((req->fmt != obt->fmt) ||
 360         (req->nchannels != obt->nchannels) ||
 361         (req->freq != obt->freq) ||
 362         (req->fragsize != obt->fragsize) ||
 363         (req->nfrags != obt->nfrags)) {
 364         dolog ("Audio parameters mismatch\n");
 365         oss_dump_info (req, obt);
 366     }
 367 #endif
 368
 369 #ifdef DEBUG
 370     oss_dump_info (req, obt);
 371 #endif
 372     return 0;
 373
 374  err:
 375     oss_anal_close (&fd);
 376     return -1;
 377 }
 378
 379 static void oss_write_pending (OSSVoiceOut *oss)
 380 {
 381     HWVoiceOut *hw = &oss->hw;
 382
 383     if (oss->mmapped) {
 384         return;
 385     }
 386
 387     while (oss->pending) {
 388         int samples_written;
 389         ssize_t bytes_written;
 390         int samples_till_end = hw->samples - oss->wpos;
 391         int samples_to_write = audio_MIN (oss->pending, samples_till_end);
 392         int bytes_to_write = samples_to_write << hw->info.shift;
 393         void *pcm = advance (oss->pcm_buf, oss->wpos << hw->info.shift);
 394
 395         bytes_written = write (oss->fd, pcm, bytes_to_write);
 396         if (bytes_written < 0) {
 397             if (errno != EAGAIN) {
 398                 oss_logerr (errno, "failed to write %d bytes\n",
 399                             bytes_to_write);
 400             }
 401             break;
 402         }
 403
 404         if (bytes_written & hw->info.align) {
 405             dolog ("misaligned write asked for %d, but got %zd\n",
 406                    bytes_to_write, bytes_written);
 407             return;
 408         }
 409
 410         samples_written = bytes_written >> hw->info.shift;
 411         oss->pending -= samples_written;
 412         oss->wpos = (oss->wpos + samples_written) % hw->samples;
 413         if (bytes_written - bytes_to_write) {
 414             break;
 415         }
 416     }
 417 }
 418
 419 static int oss_run_out (HWVoiceOut *hw, int live)
 420 {
 421     OSSVoiceOut *oss = (OSSVoiceOut *) hw;
 422     int err, decr;
 423     struct audio_buf_info abinfo;
 424     struct count_info cntinfo;
 425     int bufsize;
 426
 427     bufsize = hw->samples << hw->info.shift;
 428
 429     if (oss->mmapped) {
 430         int bytes, pos;
 431
 432         err = ioctl (oss->fd, SNDCTL_DSP_GETOPTR, &cntinfo);
 433         if (err < 0) {
 434             oss_logerr (errno, "SNDCTL_DSP_GETOPTR failed\n");
 435             return 0;
 436         }
 437
 438         pos = hw->rpos << hw->info.shift;
 439         bytes = audio_ring_dist (cntinfo.ptr, pos, bufsize);
 440         decr = audio_MIN (bytes >> hw->info.shift, live);
 441     }
 442     else {
 443         err = ioctl (oss->fd, SNDCTL_DSP_GETOSPACE, &abinfo);
 444         if (err < 0) {
 445             oss_logerr (errno, "SNDCTL_DSP_GETOPTR failed\n");
 446             return 0;
 447         }
 448
 449         if (abinfo.bytes > bufsize) {
 450             trace_oss_invalid_available_size(abinfo.bytes, bufsize);
 451             abinfo.bytes = bufsize;
 452         }
 453
 454         if (abinfo.bytes < 0) {
 455             trace_oss_invalid_available_size(abinfo.bytes, bufsize);
 456             return 0;
 457         }
 458
 459         decr = audio_MIN (abinfo.bytes >> hw->info.shift, live);
 460         if (!decr) {
 461             return 0;
 462         }
 463     }
 464
 465     decr = audio_pcm_hw_clip_out (hw, oss->pcm_buf, decr, oss->pending);
 466     oss->pending += decr;
 467     oss_write_pending (oss);
 468
 469     return decr;
 470 }
 471
 472 static void oss_fini_out (HWVoiceOut *hw)
 473 {
 474     int err;
 475     OSSVoiceOut *oss = (OSSVoiceOut *) hw;
 476
 477     ldebug ("oss_fini\n");
 478     oss_anal_close (&oss->fd);
 479
 480     if (oss->pcm_buf) {
 481         if (oss->mmapped) {
 482             err = munmap (oss->pcm_buf, hw->samples << hw->info.shift);
 483             if (err) {
 484                 oss_logerr (errno, "Failed to unmap buffer %p, size %d\n",
 485                             oss->pcm_buf, hw->samples << hw->info.shift);
 486             }
 487         }
 488         else {
 489             g_free (oss->pcm_buf);
 490         }
 491         oss->pcm_buf = NULL;
 492     }
 493 }
 494
 495 static int oss_init_out(HWVoiceOut *hw, struct audsettings *as,
 496                         void *drv_opaque)
 497 {
 498     OSSVoiceOut *oss = (OSSVoiceOut *) hw;
 499     struct oss_params req, obt;
 500     int endianness;
 501     int err;
 502     int fd;
 503     audfmt_e effective_fmt;
 504     struct audsettings obt_as;
 505     OSSConf *conf = drv_opaque;
 506
 507     oss->fd = -1;
 508
 509     req.fmt = aud_to_ossfmt (as->fmt, as->endianness);
 510     req.freq = as->freq;
 511     req.nchannels = as->nchannels;
 512     req.fragsize = conf->fragsize;
 513     req.nfrags = conf->nfrags;
 514
 515     if (oss_open (0, &req, &obt, &fd, conf)) {
 516         return -1;
 517     }
 518
 519     err = oss_to_audfmt (obt.fmt, &effective_fmt, &endianness);
 520     if (err) {
 521         oss_anal_close (&fd);
 522         return -1;
 523     }
 524
 525     obt_as.freq = obt.freq;
 526     obt_as.nchannels = obt.nchannels;
 527     obt_as.fmt = effective_fmt;
 528     obt_as.endianness = endianness;
 529
 530     audio_pcm_init_info (&hw->info, &obt_as);
 531     oss->nfrags = obt.nfrags;
 532     oss->fragsize = obt.fragsize;
 533
 534     if (obt.nfrags * obt.fragsize & hw->info.align) {
 535         dolog ("warning: Misaligned DAC buffer, size %d, alignment %d\n",
 536                obt.nfrags * obt.fragsize, hw->info.align + 1);
 537     }
 538
 539     hw->samples = (obt.nfrags * obt.fragsize) >> hw->info.shift;
 540
 541     oss->mmapped = 0;
 542     if (conf->try_mmap) {
 543         oss->pcm_buf = mmap (
 544             NULL,
 545             hw->samples << hw->info.shift,
 546             PROT_READ | PROT_WRITE,
 547             MAP_SHARED,
 548             fd,
 549             0
 550             );
 551         if (oss->pcm_buf == MAP_FAILED) {
 552             oss_logerr (errno, "Failed to map %d bytes of DAC\n",
 553                         hw->samples << hw->info.shift);
 554         }
 555         else {
 556             int err;
 557             int trig = 0;
 558             if (ioctl (fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
 559                 oss_logerr (errno, "SNDCTL_DSP_SETTRIGGER 0 failed\n");
 560             }
 561             else {
 562                 trig = PCM_ENABLE_OUTPUT;
 563                 if (ioctl (fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
 564                     oss_logerr (
 565                         errno,
 566                         "SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
 567                         );
 568                 }
 569                 else {
 570                     oss->mmapped = 1;
 571                 }
 572             }
 573
 574             if (!oss->mmapped) {
 575                 err = munmap (oss->pcm_buf, hw->samples << hw->info.shift);
 576                 if (err) {
 577                     oss_logerr (errno, "Failed to unmap buffer %p size %d\n",
 578                                 oss->pcm_buf, hw->samples << hw->info.shift);
 579                 }
 580             }
 581         }
 582     }
 583
 584     if (!oss->mmapped) {
 585         oss->pcm_buf = audio_calloc(__func__,
 586                                     hw->samples,
 587                                     1 << hw->info.shift);
 588         if (!oss->pcm_buf) {
 589             dolog (
 590                 "Could not allocate DAC buffer (%d samples, each %d bytes)\n",
 591                 hw->samples,
 592                 1 << hw->info.shift
 593                 );
 594             oss_anal_close (&fd);
 595             return -1;
 596         }
 597     }
 598
 599     oss->fd = fd;
 600     oss->conf = conf;
 601     return 0;
 602 }
 603
 604 static int oss_ctl_out (HWVoiceOut *hw, int cmd, ...)
 605 {
 606     int trig;
 607     OSSVoiceOut *oss = (OSSVoiceOut *) hw;
 608
 609     switch (cmd) {
 610     case VOICE_ENABLE:
 611         {
 612             va_list ap;
 613             int poll_mode;
 614
 615             va_start (ap, cmd);
 616             poll_mode = va_arg (ap, int);
 617             va_end (ap);
 618
 619             ldebug ("enabling voice\n");
 620             if (poll_mode) {
 621                 oss_poll_out (hw);
 622                 poll_mode = 0;
 623             }
 624             hw->poll_mode = poll_mode;
 625
 626             if (!oss->mmapped) {
 627                 return 0;
 628             }
 629
 630             audio_pcm_info_clear_buf (&hw->info, oss->pcm_buf, hw->samples);
 631             trig = PCM_ENABLE_OUTPUT;
 632             if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
 633                 oss_logerr (
 634                     errno,
 635                     "SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
 636                     );
 637                 return -1;
 638             }
 639         }
 640         break;
 641
 642     case VOICE_DISABLE:
 643         if (hw->poll_mode) {
 644             qemu_set_fd_handler (oss->fd, NULL, NULL, NULL);
 645             hw->poll_mode = 0;
 646         }
 647
 648         if (!oss->mmapped) {
 649             return 0;
 650         }
 651
 652         ldebug ("disabling voice\n");
 653         trig = 0;
 654         if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
 655             oss_logerr (errno, "SNDCTL_DSP_SETTRIGGER 0 failed\n");
 656             return -1;
 657         }
 658         break;
 659     }
 660     return 0;
 661 }
 662
 663 static int oss_init_in(HWVoiceIn *hw, struct audsettings *as, void *drv_opaque)
 664 {
 665     OSSVoiceIn *oss = (OSSVoiceIn *) hw;
 666     struct oss_params req, obt;
 667     int endianness;
 668     int err;
 669     int fd;
 670     audfmt_e effective_fmt;
 671     struct audsettings obt_as;
 672     OSSConf *conf = drv_opaque;
 673
 674     oss->fd = -1;
 675
 676     req.fmt = aud_to_ossfmt (as->fmt, as->endianness);
 677     req.freq = as->freq;
 678     req.nchannels = as->nchannels;
 679     req.fragsize = conf->fragsize;
 680     req.nfrags = conf->nfrags;
 681     if (oss_open (1, &req, &obt, &fd, conf)) {
 682         return -1;
 683     }
 684
 685     err = oss_to_audfmt (obt.fmt, &effective_fmt, &endianness);
 686     if (err) {
 687         oss_anal_close (&fd);
 688         return -1;
 689     }
 690
 691     obt_as.freq = obt.freq;
 692     obt_as.nchannels = obt.nchannels;
 693     obt_as.fmt = effective_fmt;
 694     obt_as.endianness = endianness;
 695
 696     audio_pcm_init_info (&hw->info, &obt_as);
 697     oss->nfrags = obt.nfrags;
 698     oss->fragsize = obt.fragsize;
 699
 700     if (obt.nfrags * obt.fragsize & hw->info.align) {
 701         dolog ("warning: Misaligned ADC buffer, size %d, alignment %d\n",
 702                obt.nfrags * obt.fragsize, hw->info.align + 1);
 703     }
 704
 705     hw->samples = (obt.nfrags * obt.fragsize) >> hw->info.shift;
 706     oss->pcm_buf = audio_calloc(__func__, hw->samples, 1 << hw->info.shift);
 707     if (!oss->pcm_buf) {
 708         dolog ("Could not allocate ADC buffer (%d samples, each %d bytes)\n",
 709                hw->samples, 1 << hw->info.shift);
 710         oss_anal_close (&fd);
 711         return -1;
 712     }
 713
 714     oss->fd = fd;
 715     oss->conf = conf;
 716     return 0;
 717 }
 718
 719 static void oss_fini_in (HWVoiceIn *hw)
 720 {
 721     OSSVoiceIn *oss = (OSSVoiceIn *) hw;
 722
 723     oss_anal_close (&oss->fd);
 724
 725     g_free(oss->pcm_buf);
 726     oss->pcm_buf = NULL;
 727 }
 728
 729 static int oss_run_in (HWVoiceIn *hw)
 730 {
 731     OSSVoiceIn *oss = (OSSVoiceIn *) hw;
 732     int hwshift = hw->info.shift;
 733     int i;
 734     int live = audio_pcm_hw_get_live_in (hw);
 735     int dead = hw->samples - live;
 736     size_t read_samples = 0;
 737     struct {
 738         int add;
 739         int len;
 740     } bufs[2] = {
 741         { .add = hw->wpos, .len = 0 },
 742         { .add = 0,        .len = 0 }
 743     };
 744
 745     if (!dead) {
 746         return 0;
 747     }
 748
 749     if (hw->wpos + dead > hw->samples) {
 750         bufs[0].len = (hw->samples - hw->wpos) << hwshift;
 751         bufs[1].len = (dead - (hw->samples - hw->wpos)) << hwshift;
 752     }
 753     else {
 754         bufs[0].len = dead << hwshift;
 755     }
 756
 757     for (i = 0; i < 2; ++i) {
 758         ssize_t nread;
 759
 760         if (bufs[i].len) {
 761             void *p = advance (oss->pcm_buf, bufs[i].add << hwshift);
 762             nread = read (oss->fd, p, bufs[i].len);
 763
 764             if (nread > 0) {
 765                 if (nread & hw->info.align) {
 766                     dolog ("warning: Misaligned read %zd (requested %d), "
 767                            "alignment %d\n", nread, bufs[i].add << hwshift,
 768                            hw->info.align + 1);
 769                 }
 770                 read_samples += nread >> hwshift;
 771                 hw->conv (hw->conv_buf + bufs[i].add, p, nread >> hwshift);
 772             }
 773
 774             if (bufs[i].len - nread) {
 775                 if (nread == -1) {
 776                     switch (errno) {
 777                     case EINTR:
 778                     case EAGAIN:
 779                         break;
 780                     default:
 781                         oss_logerr (
 782                             errno,
 783                             "Failed to read %d bytes of audio (to %p)\n",
 784                             bufs[i].len, p
 785                             );
 786                         break;
 787                     }
 788                 }
 789                 break;
 790             }
 791         }
 792     }
 793
 794     hw->wpos = (hw->wpos + read_samples) % hw->samples;
 795     return read_samples;
 796 }
 797
 798 static int oss_read (SWVoiceIn *sw, void *buf, int size)
 799 {
 800     return audio_pcm_sw_read (sw, buf, size);
 801 }
 802
 803 static int oss_ctl_in (HWVoiceIn *hw, int cmd, ...)
 804 {
 805     OSSVoiceIn *oss = (OSSVoiceIn *) hw;
 806
 807     switch (cmd) {
 808     case VOICE_ENABLE:
 809         {
 810             va_list ap;
 811             int poll_mode;
 812
 813             va_start (ap, cmd);
 814             poll_mode = va_arg (ap, int);
 815             va_end (ap);
 816
 817             if (poll_mode) {
 818                 oss_poll_in (hw);
 819                 poll_mode = 0;
 820             }
 821             hw->poll_mode = poll_mode;
 822         }
 823         break;
 824
 825     case VOICE_DISABLE:
 826         if (hw->poll_mode) {
 827             hw->poll_mode = 0;
 828             qemu_set_fd_handler (oss->fd, NULL, NULL, NULL);
 829         }
 830         break;
 831     }
 832     return 0;
 833 }
 834
 835 static OSSConf glob_conf = {
 836     .try_mmap = 0,
 837     .nfrags = 4,
 838     .fragsize = 4096,
 839     .devpath_out = "/dev/dsp",
 840     .devpath_in = "/dev/dsp",
 841     .exclusive = 0,
 842     .policy = 5
 843 };
 844
 845 static void *oss_audio_init (void)
 846 {
 847     OSSConf *conf = g_malloc(sizeof(OSSConf));
 848     *conf = glob_conf;
 849
 850     if (access(conf->devpath_in, R_OK | W_OK) < 0 ||
 851         access(conf->devpath_out, R_OK | W_OK) < 0) {
 852         g_free(conf);
 853         return NULL;
 854     }
 855     return conf;
 856 }
 857
 858 static void oss_audio_fini (void *opaque)
 859 {
 860     g_free(opaque);
 861 }
 862
 863 static struct audio_option oss_options[] = {
 864     {
 865         .name  = "FRAGSIZE",
 866         .tag   = AUD_OPT_INT,
 867         .valp  = &glob_conf.fragsize,
 868         .descr = "Fragment size in bytes"
 869     },
 870     {
 871         .name  = "NFRAGS",
 872         .tag   = AUD_OPT_INT,
 873         .valp  = &glob_conf.nfrags,
 874         .descr = "Number of fragments"
 875     },
 876     {
 877         .name  = "MMAP",
 878         .tag   = AUD_OPT_BOOL,
 879         .valp  = &glob_conf.try_mmap,
 880         .descr = "Try using memory mapped access"
 881     },
 882     {
 883         .name  = "DAC_DEV",
 884         .tag   = AUD_OPT_STR,
 885         .valp  = &glob_conf.devpath_out,
 886         .descr = "Path to DAC device"
 887     },
 888     {
 889         .name  = "ADC_DEV",
 890         .tag   = AUD_OPT_STR,
 891         .valp  = &glob_conf.devpath_in,
 892         .descr = "Path to ADC device"
 893     },
 894     {
 895         .name  = "EXCLUSIVE",
 896         .tag   = AUD_OPT_BOOL,
 897         .valp  = &glob_conf.exclusive,
 898         .descr = "Open device in exclusive mode (vmix won't work)"
 899     },
 900 #ifdef USE_DSP_POLICY
 901     {
 902         .name  = "POLICY",
 903         .tag   = AUD_OPT_INT,
 904         .valp  = &glob_conf.policy,
 905         .descr = "Set the timing policy of the device, -1 to use fragment mode",
 906     },
 907 #endif
 908     { /* End of list */ }
 909 };
 910
 911 static struct audio_pcm_ops oss_pcm_ops = {
 912     .init_out = oss_init_out,
 913     .fini_out = oss_fini_out,
 914     .run_out  = oss_run_out,
 915     .write    = oss_write,
 916     .ctl_out  = oss_ctl_out,
 917
 918     .init_in  = oss_init_in,
 919     .fini_in  = oss_fini_in,
 920     .run_in   = oss_run_in,
 921     .read     = oss_read,
 922     .ctl_in   = oss_ctl_in
 923 };
 924
 925 struct audio_driver oss_audio_driver = {
 926     .name           = "oss",
 927     .descr          = "OSS http://www.opensound.com",
 928     .options        = oss_options,
 929     .init           = oss_audio_init,
 930     .fini           = oss_audio_fini,
 931     .pcm_ops        = &oss_pcm_ops,
 932     .can_be_default = 1,
 933     .max_voices_out = INT_MAX,
 934     .max_voices_in  = INT_MAX,
 935     .voice_size_out = sizeof (OSSVoiceOut),
 936     .voice_size_in  = sizeof (OSSVoiceIn)
 937 };