7520462bc1
Signed-off-by: Kővágó, Zoltán <DirtY.iCE.hu@gmail.com> Message-id: c5193e687fc6cc0f60cb3e90fe69ddf2027d0df1.1566168923.git.DirtY.iCE.hu@gmail.com Signed-off-by: Gerd Hoffmann <kraxel@redhat.com>
875 lines
23 KiB
C
875 lines
23 KiB
C
/*
|
|
* QEMU OSS audio driver
|
|
*
|
|
* Copyright (c) 2003-2005 Vassili Karpov (malc)
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include <sys/ioctl.h>
|
|
#include <sys/soundcard.h>
|
|
#include "qemu/main-loop.h"
|
|
#include "qemu/module.h"
|
|
#include "qemu/host-utils.h"
|
|
#include "audio.h"
|
|
#include "trace.h"
|
|
|
|
#define AUDIO_CAP "oss"
|
|
#include "audio_int.h"
|
|
|
|
#if defined OSS_GETVERSION && defined SNDCTL_DSP_POLICY
|
|
#define USE_DSP_POLICY
|
|
#endif
|
|
|
|
typedef struct OSSVoiceOut {
|
|
HWVoiceOut hw;
|
|
void *pcm_buf;
|
|
int fd;
|
|
int wpos;
|
|
int nfrags;
|
|
int fragsize;
|
|
int mmapped;
|
|
int pending;
|
|
Audiodev *dev;
|
|
} OSSVoiceOut;
|
|
|
|
typedef struct OSSVoiceIn {
|
|
HWVoiceIn hw;
|
|
void *pcm_buf;
|
|
int fd;
|
|
int nfrags;
|
|
int fragsize;
|
|
Audiodev *dev;
|
|
} OSSVoiceIn;
|
|
|
|
struct oss_params {
|
|
int freq;
|
|
int fmt;
|
|
int nchannels;
|
|
int nfrags;
|
|
int fragsize;
|
|
};
|
|
|
|
static void GCC_FMT_ATTR (2, 3) oss_logerr (int err, const char *fmt, ...)
|
|
{
|
|
va_list ap;
|
|
|
|
va_start (ap, fmt);
|
|
AUD_vlog (AUDIO_CAP, fmt, ap);
|
|
va_end (ap);
|
|
|
|
AUD_log (AUDIO_CAP, "Reason: %s\n", strerror (err));
|
|
}
|
|
|
|
static void GCC_FMT_ATTR (3, 4) oss_logerr2 (
|
|
int err,
|
|
const char *typ,
|
|
const char *fmt,
|
|
...
|
|
)
|
|
{
|
|
va_list ap;
|
|
|
|
AUD_log (AUDIO_CAP, "Could not initialize %s\n", typ);
|
|
|
|
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)
|
|
{
|
|
int err;
|
|
|
|
qemu_set_fd_handler (*fdp, NULL, NULL, NULL);
|
|
err = close (*fdp);
|
|
if (err) {
|
|
oss_logerr (errno, "Failed to close file(fd=%d)\n", *fdp);
|
|
}
|
|
*fdp = -1;
|
|
}
|
|
|
|
static void oss_helper_poll_out (void *opaque)
|
|
{
|
|
AudioState *s = opaque;
|
|
audio_run(s, "oss_poll_out");
|
|
}
|
|
|
|
static void oss_helper_poll_in (void *opaque)
|
|
{
|
|
AudioState *s = opaque;
|
|
audio_run(s, "oss_poll_in");
|
|
}
|
|
|
|
static void oss_poll_out (HWVoiceOut *hw)
|
|
{
|
|
OSSVoiceOut *oss = (OSSVoiceOut *) hw;
|
|
|
|
qemu_set_fd_handler(oss->fd, NULL, oss_helper_poll_out, hw->s);
|
|
}
|
|
|
|
static void oss_poll_in (HWVoiceIn *hw)
|
|
{
|
|
OSSVoiceIn *oss = (OSSVoiceIn *) hw;
|
|
|
|
qemu_set_fd_handler(oss->fd, oss_helper_poll_in, NULL, hw->s);
|
|
}
|
|
|
|
static int aud_to_ossfmt (AudioFormat fmt, int endianness)
|
|
{
|
|
switch (fmt) {
|
|
case AUDIO_FORMAT_S8:
|
|
return AFMT_S8;
|
|
|
|
case AUDIO_FORMAT_U8:
|
|
return AFMT_U8;
|
|
|
|
case AUDIO_FORMAT_S16:
|
|
if (endianness) {
|
|
return AFMT_S16_BE;
|
|
}
|
|
else {
|
|
return AFMT_S16_LE;
|
|
}
|
|
|
|
case AUDIO_FORMAT_U16:
|
|
if (endianness) {
|
|
return AFMT_U16_BE;
|
|
}
|
|
else {
|
|
return AFMT_U16_LE;
|
|
}
|
|
|
|
default:
|
|
dolog ("Internal logic error: Bad audio format %d\n", fmt);
|
|
#ifdef DEBUG_AUDIO
|
|
abort ();
|
|
#endif
|
|
return AFMT_U8;
|
|
}
|
|
}
|
|
|
|
static int oss_to_audfmt (int ossfmt, AudioFormat *fmt, int *endianness)
|
|
{
|
|
switch (ossfmt) {
|
|
case AFMT_S8:
|
|
*endianness = 0;
|
|
*fmt = AUDIO_FORMAT_S8;
|
|
break;
|
|
|
|
case AFMT_U8:
|
|
*endianness = 0;
|
|
*fmt = AUDIO_FORMAT_U8;
|
|
break;
|
|
|
|
case AFMT_S16_LE:
|
|
*endianness = 0;
|
|
*fmt = AUDIO_FORMAT_S16;
|
|
break;
|
|
|
|
case AFMT_U16_LE:
|
|
*endianness = 0;
|
|
*fmt = AUDIO_FORMAT_U16;
|
|
break;
|
|
|
|
case AFMT_S16_BE:
|
|
*endianness = 1;
|
|
*fmt = AUDIO_FORMAT_S16;
|
|
break;
|
|
|
|
case AFMT_U16_BE:
|
|
*endianness = 1;
|
|
*fmt = AUDIO_FORMAT_U16;
|
|
break;
|
|
|
|
default:
|
|
dolog ("Unrecognized audio format %d\n", ossfmt);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if defined DEBUG_MISMATCHES || defined DEBUG
|
|
static void oss_dump_info (struct oss_params *req, struct oss_params *obt)
|
|
{
|
|
dolog ("parameter | requested value | obtained value\n");
|
|
dolog ("format | %10d | %10d\n", req->fmt, obt->fmt);
|
|
dolog ("channels | %10d | %10d\n",
|
|
req->nchannels, obt->nchannels);
|
|
dolog ("frequency | %10d | %10d\n", req->freq, obt->freq);
|
|
dolog ("nfrags | %10d | %10d\n", req->nfrags, obt->nfrags);
|
|
dolog ("fragsize | %10d | %10d\n",
|
|
req->fragsize, obt->fragsize);
|
|
}
|
|
#endif
|
|
|
|
#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
|
|
|
|
static int oss_open(int in, struct oss_params *req, audsettings *as,
|
|
struct oss_params *obt, int *pfd, Audiodev *dev)
|
|
{
|
|
AudiodevOssOptions *oopts = &dev->u.oss;
|
|
AudiodevOssPerDirectionOptions *opdo = in ? oopts->in : oopts->out;
|
|
int fd;
|
|
int oflags = (oopts->has_exclusive && oopts->exclusive) ? O_EXCL : 0;
|
|
audio_buf_info abinfo;
|
|
int fmt, freq, nchannels;
|
|
int setfragment = 1;
|
|
const char *dspname = opdo->has_dev ? opdo->dev : "/dev/dsp";
|
|
const char *typ = in ? "ADC" : "DAC";
|
|
#ifdef USE_DSP_POLICY
|
|
int policy = oopts->has_dsp_policy ? oopts->dsp_policy : 5;
|
|
#endif
|
|
|
|
/* Kludge needed to have working mmap on Linux */
|
|
oflags |= (oopts->has_try_mmap && oopts->try_mmap) ?
|
|
O_RDWR : (in ? O_RDONLY : O_WRONLY);
|
|
|
|
fd = open (dspname, oflags | O_NONBLOCK);
|
|
if (-1 == fd) {
|
|
oss_logerr2 (errno, typ, "Failed to open `%s'\n", dspname);
|
|
return -1;
|
|
}
|
|
|
|
freq = req->freq;
|
|
nchannels = req->nchannels;
|
|
fmt = req->fmt;
|
|
req->nfrags = opdo->has_buffer_count ? opdo->buffer_count : 4;
|
|
req->fragsize = audio_buffer_bytes(
|
|
qapi_AudiodevOssPerDirectionOptions_base(opdo), as, 23220);
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_SAMPLESIZE, &fmt)) {
|
|
oss_logerr2 (errno, typ, "Failed to set sample size %d\n", req->fmt);
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_CHANNELS, &nchannels)) {
|
|
oss_logerr2 (errno, typ, "Failed to set number of channels %d\n",
|
|
req->nchannels);
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_SPEED, &freq)) {
|
|
oss_logerr2 (errno, typ, "Failed to set frequency %d\n", req->freq);
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_NONBLOCK, NULL)) {
|
|
oss_logerr2 (errno, typ, "Failed to set non-blocking mode\n");
|
|
goto err;
|
|
}
|
|
|
|
#ifdef USE_DSP_POLICY
|
|
if (policy >= 0) {
|
|
int version;
|
|
|
|
if (!oss_get_version (fd, &version, typ)) {
|
|
trace_oss_version(version);
|
|
|
|
if (version >= 0x040000) {
|
|
int policy2 = policy;
|
|
if (ioctl(fd, SNDCTL_DSP_POLICY, &policy2)) {
|
|
oss_logerr2 (errno, typ,
|
|
"Failed to set timing policy to %d\n",
|
|
policy);
|
|
goto err;
|
|
}
|
|
setfragment = 0;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
if (setfragment) {
|
|
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;
|
|
}
|
|
}
|
|
|
|
if (ioctl (fd, in ? SNDCTL_DSP_GETISPACE : SNDCTL_DSP_GETOSPACE, &abinfo)) {
|
|
oss_logerr2 (errno, typ, "Failed to get buffer length\n");
|
|
goto err;
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
obt->fmt = fmt;
|
|
obt->nchannels = nchannels;
|
|
obt->freq = freq;
|
|
obt->nfrags = abinfo.fragstotal;
|
|
obt->fragsize = abinfo.fragsize;
|
|
*pfd = fd;
|
|
|
|
#ifdef DEBUG_MISMATCHES
|
|
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");
|
|
oss_dump_info (req, obt);
|
|
}
|
|
#endif
|
|
|
|
#ifdef DEBUG
|
|
oss_dump_info (req, obt);
|
|
#endif
|
|
return 0;
|
|
|
|
err:
|
|
oss_anal_close (&fd);
|
|
return -1;
|
|
}
|
|
|
|
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 = 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;
|
|
}
|
|
}
|
|
}
|
|
|
|
static size_t oss_run_out(HWVoiceOut *hw, size_t live)
|
|
{
|
|
OSSVoiceOut *oss = (OSSVoiceOut *) hw;
|
|
int err;
|
|
size_t decr;
|
|
struct audio_buf_info abinfo;
|
|
struct count_info cntinfo;
|
|
size_t bufsize;
|
|
|
|
bufsize = hw->samples << hw->info.shift;
|
|
|
|
if (oss->mmapped) {
|
|
int bytes, pos;
|
|
|
|
err = ioctl (oss->fd, SNDCTL_DSP_GETOPTR, &cntinfo);
|
|
if (err < 0) {
|
|
oss_logerr (errno, "SNDCTL_DSP_GETOPTR failed\n");
|
|
return 0;
|
|
}
|
|
|
|
pos = hw->rpos << hw->info.shift;
|
|
bytes = audio_ring_dist (cntinfo.ptr, pos, bufsize);
|
|
decr = MIN (bytes >> hw->info.shift, live);
|
|
}
|
|
else {
|
|
err = ioctl (oss->fd, SNDCTL_DSP_GETOSPACE, &abinfo);
|
|
if (err < 0) {
|
|
oss_logerr (errno, "SNDCTL_DSP_GETOPTR failed\n");
|
|
return 0;
|
|
}
|
|
|
|
if (abinfo.bytes > bufsize) {
|
|
trace_oss_invalid_available_size(abinfo.bytes, bufsize);
|
|
abinfo.bytes = bufsize;
|
|
}
|
|
|
|
if (abinfo.bytes < 0) {
|
|
trace_oss_invalid_available_size(abinfo.bytes, bufsize);
|
|
return 0;
|
|
}
|
|
|
|
decr = MIN (abinfo.bytes >> hw->info.shift, live);
|
|
if (!decr) {
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
decr = audio_pcm_hw_clip_out (hw, oss->pcm_buf, decr, oss->pending);
|
|
oss->pending += decr;
|
|
oss_write_pending (oss);
|
|
|
|
return decr;
|
|
}
|
|
|
|
static void oss_fini_out (HWVoiceOut *hw)
|
|
{
|
|
int err;
|
|
OSSVoiceOut *oss = (OSSVoiceOut *) hw;
|
|
|
|
ldebug ("oss_fini\n");
|
|
oss_anal_close (&oss->fd);
|
|
|
|
if (oss->pcm_buf) {
|
|
if (oss->mmapped) {
|
|
err = munmap (oss->pcm_buf, hw->samples << hw->info.shift);
|
|
if (err) {
|
|
oss_logerr(errno, "Failed to unmap buffer %p, size %zu\n",
|
|
oss->pcm_buf, hw->samples << hw->info.shift);
|
|
}
|
|
}
|
|
else {
|
|
g_free (oss->pcm_buf);
|
|
}
|
|
oss->pcm_buf = NULL;
|
|
}
|
|
}
|
|
|
|
static int oss_init_out(HWVoiceOut *hw, struct audsettings *as,
|
|
void *drv_opaque)
|
|
{
|
|
OSSVoiceOut *oss = (OSSVoiceOut *) hw;
|
|
struct oss_params req, obt;
|
|
int endianness;
|
|
int err;
|
|
int fd;
|
|
AudioFormat effective_fmt;
|
|
struct audsettings obt_as;
|
|
Audiodev *dev = drv_opaque;
|
|
AudiodevOssOptions *oopts = &dev->u.oss;
|
|
|
|
oss->fd = -1;
|
|
|
|
req.fmt = aud_to_ossfmt (as->fmt, as->endianness);
|
|
req.freq = as->freq;
|
|
req.nchannels = as->nchannels;
|
|
|
|
if (oss_open(0, &req, as, &obt, &fd, dev)) {
|
|
return -1;
|
|
}
|
|
|
|
err = oss_to_audfmt (obt.fmt, &effective_fmt, &endianness);
|
|
if (err) {
|
|
oss_anal_close (&fd);
|
|
return -1;
|
|
}
|
|
|
|
obt_as.freq = obt.freq;
|
|
obt_as.nchannels = obt.nchannels;
|
|
obt_as.fmt = effective_fmt;
|
|
obt_as.endianness = endianness;
|
|
|
|
audio_pcm_init_info (&hw->info, &obt_as);
|
|
oss->nfrags = obt.nfrags;
|
|
oss->fragsize = obt.fragsize;
|
|
|
|
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;
|
|
|
|
oss->mmapped = 0;
|
|
if (oopts->has_try_mmap && oopts->try_mmap) {
|
|
oss->pcm_buf = mmap (
|
|
NULL,
|
|
hw->samples << hw->info.shift,
|
|
PROT_READ | PROT_WRITE,
|
|
MAP_SHARED,
|
|
fd,
|
|
0
|
|
);
|
|
if (oss->pcm_buf == MAP_FAILED) {
|
|
oss_logerr(errno, "Failed to map %zu bytes of DAC\n",
|
|
hw->samples << hw->info.shift);
|
|
}
|
|
else {
|
|
int err;
|
|
int trig = 0;
|
|
if (ioctl (fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
oss_logerr (errno, "SNDCTL_DSP_SETTRIGGER 0 failed\n");
|
|
}
|
|
else {
|
|
trig = PCM_ENABLE_OUTPUT;
|
|
if (ioctl (fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
oss_logerr (
|
|
errno,
|
|
"SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
|
|
);
|
|
}
|
|
else {
|
|
oss->mmapped = 1;
|
|
}
|
|
}
|
|
|
|
if (!oss->mmapped) {
|
|
err = munmap (oss->pcm_buf, hw->samples << hw->info.shift);
|
|
if (err) {
|
|
oss_logerr(errno, "Failed to unmap buffer %p size %zu\n",
|
|
oss->pcm_buf, hw->samples << hw->info.shift);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (!oss->mmapped) {
|
|
oss->pcm_buf = audio_calloc(__func__,
|
|
hw->samples,
|
|
1 << hw->info.shift);
|
|
if (!oss->pcm_buf) {
|
|
dolog (
|
|
"Could not allocate DAC buffer (%zu samples, each %d bytes)\n",
|
|
hw->samples,
|
|
1 << hw->info.shift
|
|
);
|
|
oss_anal_close (&fd);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
oss->fd = fd;
|
|
oss->dev = dev;
|
|
return 0;
|
|
}
|
|
|
|
static int oss_ctl_out (HWVoiceOut *hw, int cmd, ...)
|
|
{
|
|
int trig;
|
|
OSSVoiceOut *oss = (OSSVoiceOut *) hw;
|
|
AudiodevOssPerDirectionOptions *opdo = oss->dev->u.oss.out;
|
|
|
|
switch (cmd) {
|
|
case VOICE_ENABLE:
|
|
{
|
|
bool poll_mode = opdo->try_poll;
|
|
|
|
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;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case VOICE_DISABLE:
|
|
if (hw->poll_mode) {
|
|
qemu_set_fd_handler (oss->fd, NULL, NULL, NULL);
|
|
hw->poll_mode = 0;
|
|
}
|
|
|
|
if (!oss->mmapped) {
|
|
return 0;
|
|
}
|
|
|
|
ldebug ("disabling voice\n");
|
|
trig = 0;
|
|
if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
oss_logerr (errno, "SNDCTL_DSP_SETTRIGGER 0 failed\n");
|
|
return -1;
|
|
}
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int oss_init_in(HWVoiceIn *hw, struct audsettings *as, void *drv_opaque)
|
|
{
|
|
OSSVoiceIn *oss = (OSSVoiceIn *) hw;
|
|
struct oss_params req, obt;
|
|
int endianness;
|
|
int err;
|
|
int fd;
|
|
AudioFormat effective_fmt;
|
|
struct audsettings obt_as;
|
|
Audiodev *dev = drv_opaque;
|
|
|
|
oss->fd = -1;
|
|
|
|
req.fmt = aud_to_ossfmt (as->fmt, as->endianness);
|
|
req.freq = as->freq;
|
|
req.nchannels = as->nchannels;
|
|
if (oss_open(1, &req, as, &obt, &fd, dev)) {
|
|
return -1;
|
|
}
|
|
|
|
err = oss_to_audfmt (obt.fmt, &effective_fmt, &endianness);
|
|
if (err) {
|
|
oss_anal_close (&fd);
|
|
return -1;
|
|
}
|
|
|
|
obt_as.freq = obt.freq;
|
|
obt_as.nchannels = obt.nchannels;
|
|
obt_as.fmt = effective_fmt;
|
|
obt_as.endianness = endianness;
|
|
|
|
audio_pcm_init_info (&hw->info, &obt_as);
|
|
oss->nfrags = obt.nfrags;
|
|
oss->fragsize = obt.fragsize;
|
|
|
|
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(__func__, hw->samples, 1 << hw->info.shift);
|
|
if (!oss->pcm_buf) {
|
|
dolog("Could not allocate ADC buffer (%zu samples, each %d bytes)\n",
|
|
hw->samples, 1 << hw->info.shift);
|
|
oss_anal_close (&fd);
|
|
return -1;
|
|
}
|
|
|
|
oss->fd = fd;
|
|
oss->dev = dev;
|
|
return 0;
|
|
}
|
|
|
|
static void oss_fini_in (HWVoiceIn *hw)
|
|
{
|
|
OSSVoiceIn *oss = (OSSVoiceIn *) hw;
|
|
|
|
oss_anal_close (&oss->fd);
|
|
|
|
g_free(oss->pcm_buf);
|
|
oss->pcm_buf = NULL;
|
|
}
|
|
|
|
static size_t oss_run_in(HWVoiceIn *hw)
|
|
{
|
|
OSSVoiceIn *oss = (OSSVoiceIn *) hw;
|
|
int hwshift = hw->info.shift;
|
|
int i;
|
|
size_t live = audio_pcm_hw_get_live_in (hw);
|
|
size_t dead = hw->samples - live;
|
|
size_t read_samples = 0;
|
|
struct {
|
|
size_t add;
|
|
size_t len;
|
|
} bufs[2] = {
|
|
{ .add = hw->wpos, .len = 0 },
|
|
{ .add = 0, .len = 0 }
|
|
};
|
|
|
|
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) {
|
|
dolog("warning: Misaligned read %zd (requested %zu), "
|
|
"alignment %d\n", nread, bufs[i].add << hwshift,
|
|
hw->info.align + 1);
|
|
}
|
|
read_samples += nread >> hwshift;
|
|
hw->conv (hw->conv_buf + bufs[i].add, p, nread >> hwshift);
|
|
}
|
|
|
|
if (bufs[i].len - nread) {
|
|
if (nread == -1) {
|
|
switch (errno) {
|
|
case EINTR:
|
|
case EAGAIN:
|
|
break;
|
|
default:
|
|
oss_logerr(
|
|
errno,
|
|
"Failed to read %zu 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_ctl_in (HWVoiceIn *hw, int cmd, ...)
|
|
{
|
|
OSSVoiceIn *oss = (OSSVoiceIn *) hw;
|
|
AudiodevOssPerDirectionOptions *opdo = oss->dev->u.oss.out;
|
|
|
|
switch (cmd) {
|
|
case VOICE_ENABLE:
|
|
{
|
|
bool poll_mode = opdo->try_poll;
|
|
|
|
if (poll_mode) {
|
|
oss_poll_in (hw);
|
|
poll_mode = 0;
|
|
}
|
|
hw->poll_mode = poll_mode;
|
|
}
|
|
break;
|
|
|
|
case VOICE_DISABLE:
|
|
if (hw->poll_mode) {
|
|
hw->poll_mode = 0;
|
|
qemu_set_fd_handler (oss->fd, NULL, NULL, NULL);
|
|
}
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void oss_init_per_direction(AudiodevOssPerDirectionOptions *opdo)
|
|
{
|
|
if (!opdo->has_try_poll) {
|
|
opdo->try_poll = true;
|
|
opdo->has_try_poll = true;
|
|
}
|
|
}
|
|
|
|
static void *oss_audio_init(Audiodev *dev)
|
|
{
|
|
AudiodevOssOptions *oopts;
|
|
assert(dev->driver == AUDIODEV_DRIVER_OSS);
|
|
|
|
oopts = &dev->u.oss;
|
|
oss_init_per_direction(oopts->in);
|
|
oss_init_per_direction(oopts->out);
|
|
|
|
if (access(oopts->in->has_dev ? oopts->in->dev : "/dev/dsp",
|
|
R_OK | W_OK) < 0 ||
|
|
access(oopts->out->has_dev ? oopts->out->dev : "/dev/dsp",
|
|
R_OK | W_OK) < 0) {
|
|
return NULL;
|
|
}
|
|
return dev;
|
|
}
|
|
|
|
static void oss_audio_fini (void *opaque)
|
|
{
|
|
}
|
|
|
|
static struct audio_pcm_ops oss_pcm_ops = {
|
|
.init_out = oss_init_out,
|
|
.fini_out = oss_fini_out,
|
|
.run_out = oss_run_out,
|
|
.ctl_out = oss_ctl_out,
|
|
|
|
.init_in = oss_init_in,
|
|
.fini_in = oss_fini_in,
|
|
.run_in = oss_run_in,
|
|
.ctl_in = oss_ctl_in
|
|
};
|
|
|
|
static struct audio_driver oss_audio_driver = {
|
|
.name = "oss",
|
|
.descr = "OSS http://www.opensound.com",
|
|
.init = oss_audio_init,
|
|
.fini = oss_audio_fini,
|
|
.pcm_ops = &oss_pcm_ops,
|
|
.can_be_default = 1,
|
|
.max_voices_out = INT_MAX,
|
|
.max_voices_in = INT_MAX,
|
|
.voice_size_out = sizeof (OSSVoiceOut),
|
|
.voice_size_in = sizeof (OSSVoiceIn)
|
|
};
|
|
|
|
static void register_audio_oss(void)
|
|
{
|
|
audio_driver_register(&oss_audio_driver);
|
|
}
|
|
type_init(register_audio_oss);
|