mirror of https://gitee.com/openkylin/qemu.git
476 lines
13 KiB
C
476 lines
13 KiB
C
/*
|
|
* QEMU OSS audio output driver
|
|
*
|
|
* Copyright (c) 2003-2004 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 <sys/mman.h>
|
|
#include <sys/types.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/soundcard.h>
|
|
#include <assert.h>
|
|
#include "vl.h"
|
|
|
|
#include "audio/audio_int.h"
|
|
|
|
typedef struct OSSVoice {
|
|
HWVoice hw;
|
|
void *pcm_buf;
|
|
int fd;
|
|
int nfrags;
|
|
int fragsize;
|
|
int mmapped;
|
|
int old_optr;
|
|
} OSSVoice;
|
|
|
|
#define dolog(...) AUD_log ("oss", __VA_ARGS__)
|
|
#ifdef DEBUG
|
|
#define ldebug(...) dolog (__VA_ARGS__)
|
|
#else
|
|
#define ldebug(...)
|
|
#endif
|
|
|
|
#define QC_OSS_FRAGSIZE "QEMU_OSS_FRAGSIZE"
|
|
#define QC_OSS_NFRAGS "QEMU_OSS_NFRAGS"
|
|
#define QC_OSS_MMAP "QEMU_OSS_MMAP"
|
|
#define QC_OSS_DEV "QEMU_OSS_DEV"
|
|
|
|
#define errstr() strerror (errno)
|
|
|
|
static struct {
|
|
int try_mmap;
|
|
int nfrags;
|
|
int fragsize;
|
|
const char *dspname;
|
|
} conf = {
|
|
.try_mmap = 0,
|
|
.nfrags = 4,
|
|
.fragsize = 4096,
|
|
.dspname = "/dev/dsp"
|
|
};
|
|
|
|
struct oss_params {
|
|
int freq;
|
|
audfmt_e fmt;
|
|
int nchannels;
|
|
int nfrags;
|
|
int fragsize;
|
|
};
|
|
|
|
static int oss_hw_write (SWVoice *sw, void *buf, int len)
|
|
{
|
|
return pcm_hw_write (sw, buf, len);
|
|
}
|
|
|
|
static int AUD_to_ossfmt (audfmt_e fmt)
|
|
{
|
|
switch (fmt) {
|
|
case AUD_FMT_S8: return AFMT_S8;
|
|
case AUD_FMT_U8: return AFMT_U8;
|
|
case AUD_FMT_S16: return AFMT_S16_LE;
|
|
case AUD_FMT_U16: return AFMT_U16_LE;
|
|
default:
|
|
dolog ("Internal logic error: Bad audio format %d\nAborting\n", fmt);
|
|
exit (EXIT_FAILURE);
|
|
}
|
|
}
|
|
|
|
static int oss_to_audfmt (int fmt)
|
|
{
|
|
switch (fmt) {
|
|
case AFMT_S8: return AUD_FMT_S8;
|
|
case AFMT_U8: return AUD_FMT_U8;
|
|
case AFMT_S16_LE: return AUD_FMT_S16;
|
|
case AFMT_U16_LE: return AUD_FMT_U16;
|
|
default:
|
|
dolog ("Internal logic error: Unrecognized OSS audio format %d\n"
|
|
"Aborting\n",
|
|
fmt);
|
|
exit (EXIT_FAILURE);
|
|
}
|
|
}
|
|
|
|
#ifdef DEBUG_PCM
|
|
static void oss_dump_pcm_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
|
|
|
|
static int oss_open (struct oss_params *req, struct oss_params *obt, int *pfd)
|
|
{
|
|
int fd;
|
|
int mmmmssss;
|
|
audio_buf_info abinfo;
|
|
int fmt, freq, nchannels;
|
|
const char *dspname = conf.dspname;
|
|
|
|
fd = open (dspname, O_RDWR | O_NONBLOCK);
|
|
if (-1 == fd) {
|
|
dolog ("Could not initialize audio hardware. Failed to open `%s':\n"
|
|
"Reason:%s\n",
|
|
dspname,
|
|
errstr ());
|
|
return -1;
|
|
}
|
|
|
|
freq = req->freq;
|
|
nchannels = req->nchannels;
|
|
fmt = req->fmt;
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_SAMPLESIZE, &fmt)) {
|
|
dolog ("Could not initialize audio hardware\n"
|
|
"Failed to set sample size\n"
|
|
"Reason: %s\n",
|
|
errstr ());
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_CHANNELS, &nchannels)) {
|
|
dolog ("Could not initialize audio hardware\n"
|
|
"Failed to set number of channels\n"
|
|
"Reason: %s\n",
|
|
errstr ());
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_SPEED, &freq)) {
|
|
dolog ("Could not initialize audio hardware\n"
|
|
"Failed to set frequency\n"
|
|
"Reason: %s\n",
|
|
errstr ());
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_NONBLOCK)) {
|
|
dolog ("Could not initialize audio hardware\n"
|
|
"Failed to set non-blocking mode\n"
|
|
"Reason: %s\n",
|
|
errstr ());
|
|
goto err;
|
|
}
|
|
|
|
mmmmssss = (req->nfrags << 16) | lsbindex (req->fragsize);
|
|
if (ioctl (fd, SNDCTL_DSP_SETFRAGMENT, &mmmmssss)) {
|
|
dolog ("Could not initialize audio hardware\n"
|
|
"Failed to set buffer length (%d, %d)\n"
|
|
"Reason:%s\n",
|
|
conf.nfrags, conf.fragsize,
|
|
errstr ());
|
|
goto err;
|
|
}
|
|
|
|
if (ioctl (fd, SNDCTL_DSP_GETOSPACE, &abinfo)) {
|
|
dolog ("Could not initialize audio hardware\n"
|
|
"Failed to get buffer length\n"
|
|
"Reason:%s\n",
|
|
errstr ());
|
|
goto err;
|
|
}
|
|
|
|
obt->fmt = fmt;
|
|
obt->nchannels = nchannels;
|
|
obt->freq = freq;
|
|
obt->nfrags = abinfo.fragstotal;
|
|
obt->fragsize = abinfo.fragsize;
|
|
*pfd = fd;
|
|
|
|
if ((req->fmt != obt->fmt) ||
|
|
(req->nchannels != obt->nchannels) ||
|
|
(req->freq != obt->freq) ||
|
|
(req->fragsize != obt->fragsize) ||
|
|
(req->nfrags != obt->nfrags)) {
|
|
#ifdef DEBUG_PCM
|
|
dolog ("Audio parameters mismatch\n");
|
|
oss_dump_pcm_info (req, obt);
|
|
#endif
|
|
}
|
|
|
|
#ifdef DEBUG_PCM
|
|
oss_dump_pcm_info (req, obt);
|
|
#endif
|
|
return 0;
|
|
|
|
err:
|
|
close (fd);
|
|
return -1;
|
|
}
|
|
|
|
static void oss_hw_run (HWVoice *hw)
|
|
{
|
|
OSSVoice *oss = (OSSVoice *) hw;
|
|
int err, rpos, live, decr;
|
|
int samples;
|
|
uint8_t *dst;
|
|
st_sample_t *src;
|
|
struct audio_buf_info abinfo;
|
|
struct count_info cntinfo;
|
|
|
|
live = pcm_hw_get_live (hw);
|
|
if (live <= 0)
|
|
return;
|
|
|
|
if (oss->mmapped) {
|
|
int bytes;
|
|
|
|
err = ioctl (oss->fd, SNDCTL_DSP_GETOPTR, &cntinfo);
|
|
if (err < 0) {
|
|
dolog ("SNDCTL_DSP_GETOPTR failed\nReason: %s\n", errstr ());
|
|
return;
|
|
}
|
|
|
|
if (cntinfo.ptr == oss->old_optr) {
|
|
if (abs (hw->samples - live) < 64)
|
|
dolog ("overrun\n");
|
|
return;
|
|
}
|
|
|
|
if (cntinfo.ptr > oss->old_optr) {
|
|
bytes = cntinfo.ptr - oss->old_optr;
|
|
}
|
|
else {
|
|
bytes = hw->bufsize + cntinfo.ptr - oss->old_optr;
|
|
}
|
|
|
|
decr = audio_MIN (bytes >> hw->shift, live);
|
|
}
|
|
else {
|
|
err = ioctl (oss->fd, SNDCTL_DSP_GETOSPACE, &abinfo);
|
|
if (err < 0) {
|
|
dolog ("SNDCTL_DSP_GETOSPACE failed\nReason: %s\n", errstr ());
|
|
return;
|
|
}
|
|
|
|
decr = audio_MIN (abinfo.bytes >> hw->shift, live);
|
|
if (decr <= 0)
|
|
return;
|
|
}
|
|
|
|
samples = decr;
|
|
rpos = hw->rpos;
|
|
while (samples) {
|
|
int left_till_end_samples = hw->samples - rpos;
|
|
int convert_samples = audio_MIN (samples, left_till_end_samples);
|
|
|
|
src = advance (hw->mix_buf, rpos * sizeof (st_sample_t));
|
|
dst = advance (oss->pcm_buf, rpos << hw->shift);
|
|
|
|
hw->clip (dst, src, convert_samples);
|
|
if (!oss->mmapped) {
|
|
int written;
|
|
|
|
written = write (oss->fd, dst, convert_samples << hw->shift);
|
|
/* XXX: follow errno recommendations ? */
|
|
if (written == -1) {
|
|
dolog ("Failed to write audio\nReason: %s\n", errstr ());
|
|
continue;
|
|
}
|
|
|
|
if (written != convert_samples << hw->shift) {
|
|
int wsamples = written >> hw->shift;
|
|
int wbytes = wsamples << hw->shift;
|
|
if (wbytes != written) {
|
|
dolog ("Unaligned write %d, %d\n", wbytes, written);
|
|
}
|
|
memset (src, 0, wbytes);
|
|
decr -= samples;
|
|
rpos = (rpos + wsamples) % hw->samples;
|
|
break;
|
|
}
|
|
}
|
|
memset (src, 0, convert_samples * sizeof (st_sample_t));
|
|
|
|
rpos = (rpos + convert_samples) % hw->samples;
|
|
samples -= convert_samples;
|
|
}
|
|
if (oss->mmapped) {
|
|
oss->old_optr = cntinfo.ptr;
|
|
}
|
|
|
|
pcm_hw_dec_live (hw, decr);
|
|
hw->rpos = rpos;
|
|
}
|
|
|
|
static void oss_hw_fini (HWVoice *hw)
|
|
{
|
|
int err;
|
|
OSSVoice *oss = (OSSVoice *) hw;
|
|
|
|
ldebug ("oss_hw_fini\n");
|
|
err = close (oss->fd);
|
|
if (err) {
|
|
dolog ("Failed to close OSS descriptor\nReason: %s\n", errstr ());
|
|
}
|
|
oss->fd = -1;
|
|
|
|
if (oss->pcm_buf) {
|
|
if (oss->mmapped) {
|
|
err = munmap (oss->pcm_buf, hw->bufsize);
|
|
if (err) {
|
|
dolog ("Failed to unmap OSS buffer\nReason: %s\n",
|
|
errstr ());
|
|
}
|
|
}
|
|
else {
|
|
qemu_free (oss->pcm_buf);
|
|
}
|
|
oss->pcm_buf = NULL;
|
|
}
|
|
}
|
|
|
|
static int oss_hw_init (HWVoice *hw, int freq, int nchannels, audfmt_e fmt)
|
|
{
|
|
OSSVoice *oss = (OSSVoice *) hw;
|
|
struct oss_params req, obt;
|
|
|
|
assert (!oss->fd);
|
|
req.fmt = AUD_to_ossfmt (fmt);
|
|
req.freq = freq;
|
|
req.nchannels = nchannels;
|
|
req.fragsize = conf.fragsize;
|
|
req.nfrags = conf.nfrags;
|
|
|
|
if (oss_open (&req, &obt, &oss->fd))
|
|
return -1;
|
|
|
|
hw->freq = obt.freq;
|
|
hw->fmt = oss_to_audfmt (obt.fmt);
|
|
hw->nchannels = obt.nchannels;
|
|
|
|
oss->nfrags = obt.nfrags;
|
|
oss->fragsize = obt.fragsize;
|
|
hw->bufsize = obt.nfrags * obt.fragsize;
|
|
|
|
oss->mmapped = 0;
|
|
if (conf.try_mmap) {
|
|
oss->pcm_buf = mmap (0, hw->bufsize, PROT_READ | PROT_WRITE,
|
|
MAP_SHARED, oss->fd, 0);
|
|
if (oss->pcm_buf == MAP_FAILED) {
|
|
dolog ("Failed to mmap OSS device\nReason: %s\n",
|
|
errstr ());
|
|
} else {
|
|
int err;
|
|
int trig = 0;
|
|
if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
dolog ("SNDCTL_DSP_SETTRIGGER 0 failed\nReason: %s\n",
|
|
errstr ());
|
|
}
|
|
else {
|
|
trig = PCM_ENABLE_OUTPUT;
|
|
if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
dolog ("SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
|
|
"Reason: %s\n", errstr ());
|
|
}
|
|
else {
|
|
oss->mmapped = 1;
|
|
}
|
|
}
|
|
|
|
if (!oss->mmapped) {
|
|
err = munmap (oss->pcm_buf, hw->bufsize);
|
|
if (err) {
|
|
dolog ("Failed to unmap OSS device\nReason: %s\n",
|
|
errstr ());
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if (!oss->mmapped) {
|
|
oss->pcm_buf = qemu_mallocz (hw->bufsize);
|
|
if (!oss->pcm_buf) {
|
|
close (oss->fd);
|
|
oss->fd = -1;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int oss_hw_ctl (HWVoice *hw, int cmd, ...)
|
|
{
|
|
int trig;
|
|
OSSVoice *oss = (OSSVoice *) hw;
|
|
|
|
if (!oss->mmapped)
|
|
return 0;
|
|
|
|
switch (cmd) {
|
|
case VOICE_ENABLE:
|
|
ldebug ("enabling voice\n");
|
|
pcm_hw_clear (hw, oss->pcm_buf, hw->samples);
|
|
trig = PCM_ENABLE_OUTPUT;
|
|
if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
dolog ("SNDCTL_DSP_SETTRIGGER PCM_ENABLE_OUTPUT failed\n"
|
|
"Reason: %s\n", errstr ());
|
|
return -1;
|
|
}
|
|
break;
|
|
|
|
case VOICE_DISABLE:
|
|
ldebug ("disabling voice\n");
|
|
trig = 0;
|
|
if (ioctl (oss->fd, SNDCTL_DSP_SETTRIGGER, &trig) < 0) {
|
|
dolog ("SNDCTL_DSP_SETTRIGGER 0 failed\nReason: %s\n",
|
|
errstr ());
|
|
return -1;
|
|
}
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void *oss_audio_init (void)
|
|
{
|
|
conf.fragsize = audio_get_conf_int (QC_OSS_FRAGSIZE, conf.fragsize);
|
|
conf.nfrags = audio_get_conf_int (QC_OSS_NFRAGS, conf.nfrags);
|
|
conf.try_mmap = audio_get_conf_int (QC_OSS_MMAP, conf.try_mmap);
|
|
conf.dspname = audio_get_conf_str (QC_OSS_DEV, conf.dspname);
|
|
return &conf;
|
|
}
|
|
|
|
static void oss_audio_fini (void *opaque)
|
|
{
|
|
}
|
|
|
|
struct pcm_ops oss_pcm_ops = {
|
|
oss_hw_init,
|
|
oss_hw_fini,
|
|
oss_hw_run,
|
|
oss_hw_write,
|
|
oss_hw_ctl
|
|
};
|
|
|
|
struct audio_output_driver oss_output_driver = {
|
|
"oss",
|
|
oss_audio_init,
|
|
oss_audio_fini,
|
|
&oss_pcm_ops,
|
|
1,
|
|
INT_MAX,
|
|
sizeof (OSSVoice)
|
|
};
|