ossaudio.c 23.9 KB
Newer Older
B
bellard 已提交
1
/*
2 3 4 5
 * QEMU OSS audio driver
 *
 * Copyright (c) 2003-2005 Vassili Karpov (malc)
 *
B
bellard 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
24
#include <stdlib.h>
B
bellard 已提交
25 26 27 28
#include <sys/mman.h>
#include <sys/types.h>
#include <sys/ioctl.h>
#include <sys/soundcard.h>
P
pbrook 已提交
29
#include "qemu-common.h"
30 31
#include "qemu/main-loop.h"
#include "qemu/host-utils.h"
P
pbrook 已提交
32
#include "audio.h"
B
bellard 已提交
33

34 35
#define AUDIO_CAP "oss"
#include "audio_int.h"
B
bellard 已提交
36

M
malc 已提交
37 38 39 40
#if defined OSS_GETVERSION && defined SNDCTL_DSP_POLICY
#define USE_DSP_POLICY
#endif

41 42
typedef struct OSSVoiceOut {
    HWVoiceOut hw;
B
bellard 已提交
43 44
    void *pcm_buf;
    int fd;
M
malc 已提交
45
    int wpos;
B
bellard 已提交
46 47 48
    int nfrags;
    int fragsize;
    int mmapped;
M
malc 已提交
49
    int pending;
50
} OSSVoiceOut;
B
bellard 已提交
51

52 53 54 55 56 57 58
typedef struct OSSVoiceIn {
    HWVoiceIn hw;
    void *pcm_buf;
    int fd;
    int nfrags;
    int fragsize;
} OSSVoiceIn;
B
bellard 已提交
59 60 61 62 63

static struct {
    int try_mmap;
    int nfrags;
    int fragsize;
64 65
    const char *devpath_out;
    const char *devpath_in;
66
    int debug;
M
malc 已提交
67 68
    int exclusive;
    int policy;
B
bellard 已提交
69 70 71 72
} conf = {
    .try_mmap = 0,
    .nfrags = 4,
    .fragsize = 4096,
73
    .devpath_out = "/dev/dsp",
74
    .devpath_in = "/dev/dsp",
M
malc 已提交
75 76 77
    .debug = 0,
    .exclusive = 0,
    .policy = 5
B
bellard 已提交
78 79 80 81 82 83 84 85 86 87
};

struct oss_params {
    int freq;
    audfmt_e fmt;
    int nchannels;
    int nfrags;
    int fragsize;
};

88
static void GCC_FMT_ATTR (2, 3) oss_logerr (int err, const char *fmt, ...)
B
bellard 已提交
89
{
90 91
    va_list ap;

B
bellard 已提交
92
    va_start (ap, fmt);
93
    AUD_vlog (AUDIO_CAP, fmt, ap);
B
bellard 已提交
94
    va_end (ap);
95 96

    AUD_log (AUDIO_CAP, "Reason: %s\n", strerror (err));
B
bellard 已提交
97 98
}

99 100 101 102 103 104 105 106 107
static void GCC_FMT_ATTR (3, 4) oss_logerr2 (
    int err,
    const char *typ,
    const char *fmt,
    ...
    )
{
    va_list ap;

B
bellard 已提交
108
    AUD_log (AUDIO_CAP, "Could not initialize %s\n", typ);
109 110 111 112 113 114 115 116 117 118

    va_start (ap, fmt);
    AUD_vlog (AUDIO_CAP, fmt, ap);
    va_end (ap);

    AUD_log (AUDIO_CAP, "Reason: %s\n", strerror (err));
}

static void oss_anal_close (int *fdp)
{
119 120 121 122
    int err;

    qemu_set_fd_handler (*fdp, NULL, NULL, NULL);
    err = close (*fdp);
123 124 125 126 127 128
    if (err) {
        oss_logerr (errno, "Failed to close file(fd=%d)\n", *fdp);
    }
    *fdp = -1;
}

M
malc 已提交
129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
static void oss_helper_poll_out (void *opaque)
{
    (void) opaque;
    audio_run ("oss_poll_out");
}

static void oss_helper_poll_in (void *opaque)
{
    (void) opaque;
    audio_run ("oss_poll_in");
}

static int oss_poll_out (HWVoiceOut *hw)
{
    OSSVoiceOut *oss = (OSSVoiceOut *) hw;

    return qemu_set_fd_handler (oss->fd, NULL, oss_helper_poll_out, NULL);
}

static int oss_poll_in (HWVoiceIn *hw)
{
    OSSVoiceIn *oss = (OSSVoiceIn *) hw;

    return qemu_set_fd_handler (oss->fd, oss_helper_poll_in, NULL, NULL);
}

155 156 157 158 159
static int oss_write (SWVoiceOut *sw, void *buf, int len)
{
    return audio_pcm_sw_write (sw, buf, len);
}

160
static int aud_to_ossfmt (audfmt_e fmt, int endianness)
B
bellard 已提交
161 162
{
    switch (fmt) {
163 164 165 166 167 168 169
    case AUD_FMT_S8:
        return AFMT_S8;

    case AUD_FMT_U8:
        return AFMT_U8;

    case AUD_FMT_S16:
170 171 172 173 174 175
        if (endianness) {
            return AFMT_S16_BE;
        }
        else {
            return AFMT_S16_LE;
        }
176 177

    case AUD_FMT_U16:
178 179 180 181 182 183
        if (endianness) {
            return AFMT_U16_BE;
        }
        else {
            return AFMT_U16_LE;
        }
184

B
bellard 已提交
185
    default:
186 187 188 189 190
        dolog ("Internal logic error: Bad audio format %d\n", fmt);
#ifdef DEBUG_AUDIO
        abort ();
#endif
        return AFMT_U8;
B
bellard 已提交
191 192 193
    }
}

194
static int oss_to_audfmt (int ossfmt, audfmt_e *fmt, int *endianness)
B
bellard 已提交
195
{
196 197
    switch (ossfmt) {
    case AFMT_S8:
198
        *endianness = 0;
199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226
        *fmt = AUD_FMT_S8;
        break;

    case AFMT_U8:
        *endianness = 0;
        *fmt = AUD_FMT_U8;
        break;

    case AFMT_S16_LE:
        *endianness = 0;
        *fmt = AUD_FMT_S16;
        break;

    case AFMT_U16_LE:
        *endianness = 0;
        *fmt = AUD_FMT_U16;
        break;

    case AFMT_S16_BE:
        *endianness = 1;
        *fmt = AUD_FMT_S16;
        break;

    case AFMT_U16_BE:
        *endianness = 1;
        *fmt = AUD_FMT_U16;
        break;

B
bellard 已提交
227
    default:
228 229
        dolog ("Unrecognized audio format %d\n", ossfmt);
        return -1;
B
bellard 已提交
230
    }
231 232

    return 0;
B
bellard 已提交
233 234
}

B
bellard 已提交
235
#if defined DEBUG_MISMATCHES || defined DEBUG
236
static void oss_dump_info (struct oss_params *req, struct oss_params *obt)
B
bellard 已提交
237 238 239
{
    dolog ("parameter | requested value | obtained value\n");
    dolog ("format    |      %10d |     %10d\n", req->fmt, obt->fmt);
240 241
    dolog ("channels  |      %10d |     %10d\n",
           req->nchannels, obt->nchannels);
B
bellard 已提交
242 243
    dolog ("frequency |      %10d |     %10d\n", req->freq, obt->freq);
    dolog ("nfrags    |      %10d |     %10d\n", req->nfrags, obt->nfrags);
244 245
    dolog ("fragsize  |      %10d |     %10d\n",
           req->fragsize, obt->fragsize);
B
bellard 已提交
246 247 248
}
#endif

249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273
#ifdef USE_DSP_POLICY
static int oss_get_version (int fd, int *version, const char *typ)
{
    if (ioctl (fd, OSS_GETVERSION, &version)) {
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
        /*
         * Looks like atm (20100109) FreeBSD knows OSS_GETVERSION
         * since 7.x, but currently only on the mixer device (or in
         * the Linuxolator), and in the native version that part of
         * the code is in fact never reached so the ioctl fails anyway.
         * Until this is fixed, just check the errno and if its what
         * FreeBSD's sound drivers return atm assume they are new enough.
         */
        if (errno == EINVAL) {
            *version = 0x040000;
            return 0;
        }
#endif
        oss_logerr2 (errno, typ, "Failed to get OSS version\n");
        return -1;
    }
    return 0;
}
#endif

274 275
static int oss_open (int in, struct oss_params *req,
                     struct oss_params *obt, int *pfd)
B
bellard 已提交
276 277
{
    int fd;
M
malc 已提交
278
    int oflags = conf.exclusive ? O_EXCL : 0;
B
bellard 已提交
279 280
    audio_buf_info abinfo;
    int fmt, freq, nchannels;
M
malc 已提交
281
    int setfragment = 1;
282 283
    const char *dspname = in ? conf.devpath_in : conf.devpath_out;
    const char *typ = in ? "ADC" : "DAC";
B
bellard 已提交
284

285
    /* Kludge needed to have working mmap on Linux */
M
malc 已提交
286 287
    oflags |= conf.try_mmap ? O_RDWR : (in ? O_RDONLY : O_WRONLY);

288
    fd = open (dspname, oflags | O_NONBLOCK);
B
bellard 已提交
289
    if (-1 == fd) {
290
        oss_logerr2 (errno, typ, "Failed to open `%s'\n", dspname);
B
bellard 已提交
291 292 293 294 295 296 297 298
        return -1;
    }

    freq = req->freq;
    nchannels = req->nchannels;
    fmt = req->fmt;

    if (ioctl (fd, SNDCTL_DSP_SAMPLESIZE, &fmt)) {
299
        oss_logerr2 (errno, typ, "Failed to set sample size %d\n", req->fmt);
B
bellard 已提交
300 301 302 303
        goto err;
    }

    if (ioctl (fd, SNDCTL_DSP_CHANNELS, &nchannels)) {
304 305
        oss_logerr2 (errno, typ, "Failed to set number of channels %d\n",
                     req->nchannels);
B
bellard 已提交
306 307 308 309
        goto err;
    }

    if (ioctl (fd, SNDCTL_DSP_SPEED, &freq)) {
310
        oss_logerr2 (errno, typ, "Failed to set frequency %d\n", req->freq);
B
bellard 已提交
311 312 313
        goto err;
    }

314
    if (ioctl (fd, SNDCTL_DSP_NONBLOCK, NULL)) {
315
        oss_logerr2 (errno, typ, "Failed to set non-blocking mode\n");
B
bellard 已提交
316 317 318
        goto err;
    }

M
malc 已提交
319
#ifdef USE_DSP_POLICY
320 321
    if (conf.policy >= 0) {
        int version;
M
malc 已提交
322

323
        if (!oss_get_version (fd, &version, typ)) {
M
malc 已提交
324 325 326
            if (conf.debug) {
                dolog ("OSS version = %#x\n", version);
            }
327

M
malc 已提交
328 329 330 331 332 333 334 335 336
            if (version >= 0x040000) {
                int policy = conf.policy;
                if (ioctl (fd, SNDCTL_DSP_POLICY, &policy)) {
                    oss_logerr2 (errno, typ,
                                 "Failed to set timing policy to %d\n",
                                 conf.policy);
                    goto err;
                }
                setfragment = 0;
337
            }
M
malc 已提交
338 339 340
        }
    }
#endif
M
malc 已提交
341 342

    if (setfragment) {
M
malc 已提交
343 344 345 346 347 348
        int mmmmssss = (req->nfrags << 16) | ctz32 (req->fragsize);
        if (ioctl (fd, SNDCTL_DSP_SETFRAGMENT, &mmmmssss)) {
            oss_logerr2 (errno, typ, "Failed to set buffer length (%d, %d)\n",
                         req->nfrags, req->fragsize);
            goto err;
        }
B
bellard 已提交
349 350
    }

351 352
    if (ioctl (fd, in ? SNDCTL_DSP_GETISPACE : SNDCTL_DSP_GETOSPACE, &abinfo)) {
        oss_logerr2 (errno, typ, "Failed to get buffer length\n");
B
bellard 已提交
353 354 355
        goto err;
    }

M
malc 已提交
356 357 358 359 360 361
    if (!abinfo.fragstotal || !abinfo.fragsize) {
        AUD_log (AUDIO_CAP, "Returned bogus buffer information(%d, %d) for %s\n",
                 abinfo.fragstotal, abinfo.fragsize, typ);
        goto err;
    }

B
bellard 已提交
362 363 364 365 366 367 368
    obt->fmt = fmt;
    obt->nchannels = nchannels;
    obt->freq = freq;
    obt->nfrags = abinfo.fragstotal;
    obt->fragsize = abinfo.fragsize;
    *pfd = fd;

B
bellard 已提交
369
#ifdef DEBUG_MISMATCHES
B
bellard 已提交
370 371 372 373 374 375
    if ((req->fmt != obt->fmt) ||
        (req->nchannels != obt->nchannels) ||
        (req->freq != obt->freq) ||
        (req->fragsize != obt->fragsize) ||
        (req->nfrags != obt->nfrags)) {
        dolog ("Audio parameters mismatch\n");
376
        oss_dump_info (req, obt);
B
bellard 已提交
377
    }
B
bellard 已提交
378
#endif
B
bellard 已提交
379

380 381
#ifdef DEBUG
    oss_dump_info (req, obt);
B
bellard 已提交
382 383 384
#endif
    return 0;

385 386
 err:
    oss_anal_close (&fd);
B
bellard 已提交
387 388 389
    return -1;
}

M
malc 已提交
390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429
static void oss_write_pending (OSSVoiceOut *oss)
{
    HWVoiceOut *hw = &oss->hw;

    if (oss->mmapped) {
        return;
    }

    while (oss->pending) {
        int samples_written;
        ssize_t bytes_written;
        int samples_till_end = hw->samples - oss->wpos;
        int samples_to_write = audio_MIN (oss->pending, samples_till_end);
        int bytes_to_write = samples_to_write << hw->info.shift;
        void *pcm = advance (oss->pcm_buf, oss->wpos << hw->info.shift);

        bytes_written = write (oss->fd, pcm, bytes_to_write);
        if (bytes_written < 0) {
            if (errno != EAGAIN) {
                oss_logerr (errno, "failed to write %d bytes\n",
                            bytes_to_write);
            }
            break;
        }

        if (bytes_written & hw->info.align) {
            dolog ("misaligned write asked for %d, but got %zd\n",
                   bytes_to_write, bytes_written);
            return;
        }

        samples_written = bytes_written >> hw->info.shift;
        oss->pending -= samples_written;
        oss->wpos = (oss->wpos + samples_written) % hw->samples;
        if (bytes_written - bytes_to_write) {
            break;
        }
    }
}

M
malc 已提交
430
static int oss_run_out (HWVoiceOut *hw, int live)
B
bellard 已提交
431
{
432
    OSSVoiceOut *oss = (OSSVoiceOut *) hw;
M
malc 已提交
433
    int err, decr;
B
bellard 已提交
434 435
    struct audio_buf_info abinfo;
    struct count_info cntinfo;
B
bellard 已提交
436
    int bufsize;
B
bellard 已提交
437

B
bellard 已提交
438 439
    bufsize = hw->samples << hw->info.shift;

B
bellard 已提交
440
    if (oss->mmapped) {
M
malc 已提交
441
        int bytes, pos;
B
bellard 已提交
442 443 444

        err = ioctl (oss->fd, SNDCTL_DSP_GETOPTR, &cntinfo);
        if (err < 0) {
445 446
            oss_logerr (errno, "SNDCTL_DSP_GETOPTR failed\n");
            return 0;
B
bellard 已提交
447 448
        }

M
malc 已提交
449 450
        pos = hw->rpos << hw->info.shift;
        bytes = audio_ring_dist (cntinfo.ptr, pos, bufsize);
451
        decr = audio_MIN (bytes >> hw->info.shift, live);
B
bellard 已提交
452 453 454 455
    }
    else {
        err = ioctl (oss->fd, SNDCTL_DSP_GETOSPACE, &abinfo);
        if (err < 0) {
456 457 458 459
            oss_logerr (errno, "SNDCTL_DSP_GETOPTR failed\n");
            return 0;
        }

460 461 462
        if (abinfo.bytes > bufsize) {
            if (conf.debug) {
                dolog ("warning: Invalid available size, size=%d bufsize=%d\n"
M
malc 已提交
463
                       "please report your OS/audio hw to av1474@comtv.ru\n",
464 465 466 467 468 469 470 471 472 473
                       abinfo.bytes, bufsize);
            }
            abinfo.bytes = bufsize;
        }

        if (abinfo.bytes < 0) {
            if (conf.debug) {
                dolog ("warning: Invalid available size, size=%d bufsize=%d\n",
                       abinfo.bytes, bufsize);
            }
474
            return 0;
B
bellard 已提交
475 476
        }

477 478 479 480
        decr = audio_MIN (abinfo.bytes >> hw->info.shift, live);
        if (!decr) {
            return 0;
        }
B
bellard 已提交
481 482
    }

M
malc 已提交
483 484 485
    decr = audio_pcm_hw_clip_out (hw, oss->pcm_buf, decr, oss->pending);
    oss->pending += decr;
    oss_write_pending (oss);
B
bellard 已提交
486

487
    return decr;
B
bellard 已提交
488 489
}

490
static void oss_fini_out (HWVoiceOut *hw)
B
bellard 已提交
491 492
{
    int err;
493
    OSSVoiceOut *oss = (OSSVoiceOut *) hw;
B
bellard 已提交
494

495 496
    ldebug ("oss_fini\n");
    oss_anal_close (&oss->fd);
B
bellard 已提交
497 498 499

    if (oss->pcm_buf) {
        if (oss->mmapped) {
B
bellard 已提交
500
            err = munmap (oss->pcm_buf, hw->samples << hw->info.shift);
B
bellard 已提交
501
            if (err) {
502
                oss_logerr (errno, "Failed to unmap buffer %p, size %d\n",
B
bellard 已提交
503
                            oss->pcm_buf, hw->samples << hw->info.shift);
B
bellard 已提交
504 505 506
            }
        }
        else {
507
            g_free (oss->pcm_buf);
B
bellard 已提交
508 509 510 511 512
        }
        oss->pcm_buf = NULL;
    }
}

M
malc 已提交
513
static int oss_init_out (HWVoiceOut *hw, struct audsettings *as)
B
bellard 已提交
514
{
515
    OSSVoiceOut *oss = (OSSVoiceOut *) hw;
B
bellard 已提交
516
    struct oss_params req, obt;
517 518 519 520
    int endianness;
    int err;
    int fd;
    audfmt_e effective_fmt;
M
malc 已提交
521
    struct audsettings obt_as;
B
bellard 已提交
522

B
bellard 已提交
523 524
    oss->fd = -1;

525
    req.fmt = aud_to_ossfmt (as->fmt, as->endianness);
B
bellard 已提交
526 527
    req.freq = as->freq;
    req.nchannels = as->nchannels;
B
bellard 已提交
528 529 530
    req.fragsize = conf.fragsize;
    req.nfrags = conf.nfrags;

531
    if (oss_open (0, &req, &obt, &fd)) {
B
bellard 已提交
532
        return -1;
533
    }
B
bellard 已提交
534

535 536 537 538 539
    err = oss_to_audfmt (obt.fmt, &effective_fmt, &endianness);
    if (err) {
        oss_anal_close (&fd);
        return -1;
    }
B
bellard 已提交
540

B
bellard 已提交
541 542 543
    obt_as.freq = obt.freq;
    obt_as.nchannels = obt.nchannels;
    obt_as.fmt = effective_fmt;
B
bellard 已提交
544
    obt_as.endianness = endianness;
B
bellard 已提交
545

B
bellard 已提交
546
    audio_pcm_init_info (&hw->info, &obt_as);
B
bellard 已提交
547 548
    oss->nfrags = obt.nfrags;
    oss->fragsize = obt.fragsize;
B
bellard 已提交
549 550 551 552 553 554 555

    if (obt.nfrags * obt.fragsize & hw->info.align) {
        dolog ("warning: Misaligned DAC buffer, size %d, alignment %d\n",
               obt.nfrags * obt.fragsize, hw->info.align + 1);
    }

    hw->samples = (obt.nfrags * obt.fragsize) >> hw->info.shift;
B
bellard 已提交
556 557 558

    oss->mmapped = 0;
    if (conf.try_mmap) {
B
bellard 已提交
559
        oss->pcm_buf = mmap (
560
            NULL,
B
bellard 已提交
561 562 563 564 565 566
            hw->samples << hw->info.shift,
            PROT_READ | PROT_WRITE,
            MAP_SHARED,
            fd,
            0
            );
B
bellard 已提交
567
        if (oss->pcm_buf == MAP_FAILED) {
568
            oss_logerr (errno, "Failed to map %d bytes of DAC\n",
B
bellard 已提交
569
                        hw->samples << hw->info.shift);
M
malc 已提交
570 571
        }
        else {
B
bellard 已提交
572 573
            int err;
            int trig = 0;
574 575
            if (ioctl (fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
                oss_logerr (errno, "SNDCTL_DSP_SETTRIGGER 0 failed\n");
B
bellard 已提交
576
            }
B
bellard 已提交
577 578
            else {
                trig = PCM_ENABLE_OUTPUT;
579 580 581 582 583
                if (ioctl (fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
                    oss_logerr (
                        errno,
                        "SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
                        );
B
bellard 已提交
584 585 586 587
                }
                else {
                    oss->mmapped = 1;
                }
B
bellard 已提交
588 589
            }

B
bellard 已提交
590
            if (!oss->mmapped) {
B
bellard 已提交
591
                err = munmap (oss->pcm_buf, hw->samples << hw->info.shift);
B
bellard 已提交
592
                if (err) {
593
                    oss_logerr (errno, "Failed to unmap buffer %p size %d\n",
B
bellard 已提交
594
                                oss->pcm_buf, hw->samples << hw->info.shift);
B
bellard 已提交
595
                }
B
bellard 已提交
596 597 598 599 600
            }
        }
    }

    if (!oss->mmapped) {
B
bellard 已提交
601 602 603 604 605
        oss->pcm_buf = audio_calloc (
            AUDIO_FUNC,
            hw->samples,
            1 << hw->info.shift
            );
B
bellard 已提交
606
        if (!oss->pcm_buf) {
B
bellard 已提交
607 608 609 610 611
            dolog (
                "Could not allocate DAC buffer (%d samples, each %d bytes)\n",
                hw->samples,
                1 << hw->info.shift
                );
612
            oss_anal_close (&fd);
B
bellard 已提交
613 614 615 616
            return -1;
        }
    }

617
    oss->fd = fd;
B
bellard 已提交
618 619 620
    return 0;
}

621
static int oss_ctl_out (HWVoiceOut *hw, int cmd, ...)
B
bellard 已提交
622 623
{
    int trig;
624
    OSSVoiceOut *oss = (OSSVoiceOut *) hw;
B
bellard 已提交
625 626 627

    switch (cmd) {
    case VOICE_ENABLE:
628 629 630
        {
            va_list ap;
            int poll_mode;
M
malc 已提交
631

632 633 634
            va_start (ap, cmd);
            poll_mode = va_arg (ap, int);
            va_end (ap);
M
malc 已提交
635

636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654
            ldebug ("enabling voice\n");
            if (poll_mode && oss_poll_out (hw)) {
                poll_mode = 0;
            }
            hw->poll_mode = poll_mode;

            if (!oss->mmapped) {
                return 0;
            }

            audio_pcm_info_clear_buf (&hw->info, oss->pcm_buf, hw->samples);
            trig = PCM_ENABLE_OUTPUT;
            if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
                oss_logerr (
                    errno,
                    "SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
                    );
                return -1;
            }
B
bellard 已提交
655 656 657 658
        }
        break;

    case VOICE_DISABLE:
M
malc 已提交
659 660 661 662 663 664 665 666 667
        if (hw->poll_mode) {
            qemu_set_fd_handler (oss->fd, NULL, NULL, NULL);
            hw->poll_mode = 0;
        }

        if (!oss->mmapped) {
            return 0;
        }

B
bellard 已提交
668 669 670
        ldebug ("disabling voice\n");
        trig = 0;
        if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
671
            oss_logerr (errno, "SNDCTL_DSP_SETTRIGGER 0 failed\n");
B
bellard 已提交
672 673 674 675 676 677 678
            return -1;
        }
        break;
    }
    return 0;
}

M
malc 已提交
679
static int oss_init_in (HWVoiceIn *hw, struct audsettings *as)
680 681 682 683 684 685 686
{
    OSSVoiceIn *oss = (OSSVoiceIn *) hw;
    struct oss_params req, obt;
    int endianness;
    int err;
    int fd;
    audfmt_e effective_fmt;
M
malc 已提交
687
    struct audsettings obt_as;
688

B
bellard 已提交
689 690
    oss->fd = -1;

691
    req.fmt = aud_to_ossfmt (as->fmt, as->endianness);
B
bellard 已提交
692 693
    req.freq = as->freq;
    req.nchannels = as->nchannels;
694 695 696 697 698 699 700 701 702 703 704 705
    req.fragsize = conf.fragsize;
    req.nfrags = conf.nfrags;
    if (oss_open (1, &req, &obt, &fd)) {
        return -1;
    }

    err = oss_to_audfmt (obt.fmt, &effective_fmt, &endianness);
    if (err) {
        oss_anal_close (&fd);
        return -1;
    }

B
bellard 已提交
706 707 708
    obt_as.freq = obt.freq;
    obt_as.nchannels = obt.nchannels;
    obt_as.fmt = effective_fmt;
B
bellard 已提交
709
    obt_as.endianness = endianness;
B
bellard 已提交
710

B
bellard 已提交
711
    audio_pcm_init_info (&hw->info, &obt_as);
712 713
    oss->nfrags = obt.nfrags;
    oss->fragsize = obt.fragsize;
B
bellard 已提交
714 715 716 717 718 719 720 721

    if (obt.nfrags * obt.fragsize & hw->info.align) {
        dolog ("warning: Misaligned ADC buffer, size %d, alignment %d\n",
               obt.nfrags * obt.fragsize, hw->info.align + 1);
    }

    hw->samples = (obt.nfrags * obt.fragsize) >> hw->info.shift;
    oss->pcm_buf = audio_calloc (AUDIO_FUNC, hw->samples, 1 << hw->info.shift);
722
    if (!oss->pcm_buf) {
B
bellard 已提交
723 724
        dolog ("Could not allocate ADC buffer (%d samples, each %d bytes)\n",
               hw->samples, 1 << hw->info.shift);
725 726 727 728 729 730 731 732 733 734 735 736 737 738
        oss_anal_close (&fd);
        return -1;
    }

    oss->fd = fd;
    return 0;
}

static void oss_fini_in (HWVoiceIn *hw)
{
    OSSVoiceIn *oss = (OSSVoiceIn *) hw;

    oss_anal_close (&oss->fd);

739 740
    g_free(oss->pcm_buf);
    oss->pcm_buf = NULL;
741 742 743 744 745 746 747 748 749 750 751 752 753 754
}

static int oss_run_in (HWVoiceIn *hw)
{
    OSSVoiceIn *oss = (OSSVoiceIn *) hw;
    int hwshift = hw->info.shift;
    int i;
    int live = audio_pcm_hw_get_live_in (hw);
    int dead = hw->samples - live;
    size_t read_samples = 0;
    struct {
        int add;
        int len;
    } bufs[2] = {
M
malc 已提交
755 756
        { .add = hw->wpos, .len = 0 },
        { .add = 0,        .len = 0 }
757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779
    };

    if (!dead) {
        return 0;
    }

    if (hw->wpos + dead > hw->samples) {
        bufs[0].len = (hw->samples - hw->wpos) << hwshift;
        bufs[1].len = (dead - (hw->samples - hw->wpos)) << hwshift;
    }
    else {
        bufs[0].len = dead << hwshift;
    }

    for (i = 0; i < 2; ++i) {
        ssize_t nread;

        if (bufs[i].len) {
            void *p = advance (oss->pcm_buf, bufs[i].add << hwshift);
            nread = read (oss->fd, p, bufs[i].len);

            if (nread > 0) {
                if (nread & hw->info.align) {
B
bellard 已提交
780
                    dolog ("warning: Misaligned read %zd (requested %d), "
781 782 783 784
                           "alignment %d\n", nread, bufs[i].add << hwshift,
                           hw->info.align + 1);
                }
                read_samples += nread >> hwshift;
785
                hw->conv (hw->conv_buf + bufs[i].add, p, nread >> hwshift);
786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818
            }

            if (bufs[i].len - nread) {
                if (nread == -1) {
                    switch (errno) {
                    case EINTR:
                    case EAGAIN:
                        break;
                    default:
                        oss_logerr (
                            errno,
                            "Failed to read %d bytes of audio (to %p)\n",
                            bufs[i].len, p
                            );
                        break;
                    }
                }
                break;
            }
        }
    }

    hw->wpos = (hw->wpos + read_samples) % hw->samples;
    return read_samples;
}

static int oss_read (SWVoiceIn *sw, void *buf, int size)
{
    return audio_pcm_sw_read (sw, buf, size);
}

static int oss_ctl_in (HWVoiceIn *hw, int cmd, ...)
{
M
malc 已提交
819 820 821 822
    OSSVoiceIn *oss = (OSSVoiceIn *) hw;

    switch (cmd) {
    case VOICE_ENABLE:
823 824 825 826 827 828 829 830 831 832 833 834
        {
            va_list ap;
            int poll_mode;

            va_start (ap, cmd);
            poll_mode = va_arg (ap, int);
            va_end (ap);

            if (poll_mode && oss_poll_in (hw)) {
                poll_mode = 0;
            }
            hw->poll_mode = poll_mode;
M
malc 已提交
835 836 837 838 839 840 841 842 843 844
        }
        break;

    case VOICE_DISABLE:
        if (hw->poll_mode) {
            hw->poll_mode = 0;
            qemu_set_fd_handler (oss->fd, NULL, NULL, NULL);
        }
        break;
    }
845 846 847
    return 0;
}

B
bellard 已提交
848 849
static void *oss_audio_init (void)
{
850 851 852 853
    if (access(conf.devpath_in, R_OK | W_OK) < 0 ||
        access(conf.devpath_out, R_OK | W_OK) < 0) {
        return NULL;
    }
B
bellard 已提交
854 855 856 857 858
    return &conf;
}

static void oss_audio_fini (void *opaque)
{
859
    (void) opaque;
B
bellard 已提交
860 861
}

862
static struct audio_option oss_options[] = {
M
malc 已提交
863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892
    {
        .name  = "FRAGSIZE",
        .tag   = AUD_OPT_INT,
        .valp  = &conf.fragsize,
        .descr = "Fragment size in bytes"
    },
    {
        .name  = "NFRAGS",
        .tag   = AUD_OPT_INT,
        .valp  = &conf.nfrags,
        .descr = "Number of fragments"
    },
    {
        .name  = "MMAP",
        .tag   = AUD_OPT_BOOL,
        .valp  = &conf.try_mmap,
        .descr = "Try using memory mapped access"
    },
    {
        .name  = "DAC_DEV",
        .tag   = AUD_OPT_STR,
        .valp  = &conf.devpath_out,
        .descr = "Path to DAC device"
    },
    {
        .name  = "ADC_DEV",
        .tag   = AUD_OPT_STR,
        .valp  = &conf.devpath_in,
        .descr = "Path to ADC device"
    },
M
malc 已提交
893 894 895 896 897 898
    {
        .name  = "EXCLUSIVE",
        .tag   = AUD_OPT_BOOL,
        .valp  = &conf.exclusive,
        .descr = "Open device in exclusive mode (vmix wont work)"
    },
M
malc 已提交
899
#ifdef USE_DSP_POLICY
M
malc 已提交
900 901 902 903 904 905 906
    {
        .name  = "POLICY",
        .tag   = AUD_OPT_INT,
        .valp  = &conf.policy,
        .descr = "Set the timing policy of the device, -1 to use fragment mode",
    },
#endif
M
malc 已提交
907 908 909 910 911 912
    {
        .name  = "DEBUG",
        .tag   = AUD_OPT_BOOL,
        .valp  = &conf.debug,
        .descr = "Turn on some debugging messages"
    },
913
    { /* End of list */ }
914 915
};

916
static struct audio_pcm_ops oss_pcm_ops = {
917 918 919 920 921 922 923 924 925 926 927
    .init_out = oss_init_out,
    .fini_out = oss_fini_out,
    .run_out  = oss_run_out,
    .write    = oss_write,
    .ctl_out  = oss_ctl_out,

    .init_in  = oss_init_in,
    .fini_in  = oss_fini_in,
    .run_in   = oss_run_in,
    .read     = oss_read,
    .ctl_in   = oss_ctl_in
B
bellard 已提交
928 929
};

930
struct audio_driver oss_audio_driver = {
931 932 933 934 935 936
    .name           = "oss",
    .descr          = "OSS http://www.opensound.com",
    .options        = oss_options,
    .init           = oss_audio_init,
    .fini           = oss_audio_fini,
    .pcm_ops        = &oss_pcm_ops,
937
    .can_be_default = 1,
938 939 940 941
    .max_voices_out = INT_MAX,
    .max_voices_in  = INT_MAX,
    .voice_size_out = sizeof (OSSVoiceOut),
    .voice_size_in  = sizeof (OSSVoiceIn)
B
bellard 已提交
942
};