558 lines
14 KiB
C
558 lines
14 KiB
C
/*
|
|
* QEMU ESD audio driver
|
|
*
|
|
* Copyright (c) 2006 Frederick Reeve (brushed up by 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 <esd.h>
|
|
#include "qemu-common.h"
|
|
#include "audio.h"
|
|
|
|
#define AUDIO_CAP "esd"
|
|
#include "audio_int.h"
|
|
#include "audio_pt_int.h"
|
|
|
|
typedef struct {
|
|
HWVoiceOut hw;
|
|
int done;
|
|
int live;
|
|
int decr;
|
|
int rpos;
|
|
void *pcm_buf;
|
|
int fd;
|
|
struct audio_pt pt;
|
|
} ESDVoiceOut;
|
|
|
|
typedef struct {
|
|
HWVoiceIn hw;
|
|
int done;
|
|
int dead;
|
|
int incr;
|
|
int wpos;
|
|
void *pcm_buf;
|
|
int fd;
|
|
struct audio_pt pt;
|
|
} ESDVoiceIn;
|
|
|
|
static struct {
|
|
int samples;
|
|
int divisor;
|
|
char *dac_host;
|
|
char *adc_host;
|
|
} conf = {
|
|
.samples = 1024,
|
|
.divisor = 2,
|
|
};
|
|
|
|
static void GCC_FMT_ATTR (2, 3) qesd_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));
|
|
}
|
|
|
|
/* playback */
|
|
static void *qesd_thread_out (void *arg)
|
|
{
|
|
ESDVoiceOut *esd = arg;
|
|
HWVoiceOut *hw = &esd->hw;
|
|
int threshold;
|
|
|
|
threshold = conf.divisor ? hw->samples / conf.divisor : 0;
|
|
|
|
if (audio_pt_lock (&esd->pt, AUDIO_FUNC)) {
|
|
return NULL;
|
|
}
|
|
|
|
for (;;) {
|
|
int decr, to_mix, rpos;
|
|
|
|
for (;;) {
|
|
if (esd->done) {
|
|
goto exit;
|
|
}
|
|
|
|
if (esd->live > threshold) {
|
|
break;
|
|
}
|
|
|
|
if (audio_pt_wait (&esd->pt, AUDIO_FUNC)) {
|
|
goto exit;
|
|
}
|
|
}
|
|
|
|
decr = to_mix = esd->live;
|
|
rpos = hw->rpos;
|
|
|
|
if (audio_pt_unlock (&esd->pt, AUDIO_FUNC)) {
|
|
return NULL;
|
|
}
|
|
|
|
while (to_mix) {
|
|
ssize_t written;
|
|
int chunk = audio_MIN (to_mix, hw->samples - rpos);
|
|
struct st_sample *src = hw->mix_buf + rpos;
|
|
|
|
hw->clip (esd->pcm_buf, src, chunk);
|
|
|
|
again:
|
|
written = write (esd->fd, esd->pcm_buf, chunk << hw->info.shift);
|
|
if (written == -1) {
|
|
if (errno == EINTR || errno == EAGAIN) {
|
|
goto again;
|
|
}
|
|
qesd_logerr (errno, "write failed\n");
|
|
return NULL;
|
|
}
|
|
|
|
if (written != chunk << hw->info.shift) {
|
|
int wsamples = written >> hw->info.shift;
|
|
int wbytes = wsamples << hw->info.shift;
|
|
if (wbytes != written) {
|
|
dolog ("warning: Misaligned write %d (requested %zd), "
|
|
"alignment %d\n",
|
|
wbytes, written, hw->info.align + 1);
|
|
}
|
|
to_mix -= wsamples;
|
|
rpos = (rpos + wsamples) % hw->samples;
|
|
break;
|
|
}
|
|
|
|
rpos = (rpos + chunk) % hw->samples;
|
|
to_mix -= chunk;
|
|
}
|
|
|
|
if (audio_pt_lock (&esd->pt, AUDIO_FUNC)) {
|
|
return NULL;
|
|
}
|
|
|
|
esd->rpos = rpos;
|
|
esd->live -= decr;
|
|
esd->decr += decr;
|
|
}
|
|
|
|
exit:
|
|
audio_pt_unlock (&esd->pt, AUDIO_FUNC);
|
|
return NULL;
|
|
}
|
|
|
|
static int qesd_run_out (HWVoiceOut *hw, int live)
|
|
{
|
|
int decr;
|
|
ESDVoiceOut *esd = (ESDVoiceOut *) hw;
|
|
|
|
if (audio_pt_lock (&esd->pt, AUDIO_FUNC)) {
|
|
return 0;
|
|
}
|
|
|
|
decr = audio_MIN (live, esd->decr);
|
|
esd->decr -= decr;
|
|
esd->live = live - decr;
|
|
hw->rpos = esd->rpos;
|
|
if (esd->live > 0) {
|
|
audio_pt_unlock_and_signal (&esd->pt, AUDIO_FUNC);
|
|
}
|
|
else {
|
|
audio_pt_unlock (&esd->pt, AUDIO_FUNC);
|
|
}
|
|
return decr;
|
|
}
|
|
|
|
static int qesd_write (SWVoiceOut *sw, void *buf, int len)
|
|
{
|
|
return audio_pcm_sw_write (sw, buf, len);
|
|
}
|
|
|
|
static int qesd_init_out (HWVoiceOut *hw, struct audsettings *as)
|
|
{
|
|
ESDVoiceOut *esd = (ESDVoiceOut *) hw;
|
|
struct audsettings obt_as = *as;
|
|
int esdfmt = ESD_STREAM | ESD_PLAY;
|
|
|
|
esdfmt |= (as->nchannels == 2) ? ESD_STEREO : ESD_MONO;
|
|
switch (as->fmt) {
|
|
case AUD_FMT_S8:
|
|
case AUD_FMT_U8:
|
|
esdfmt |= ESD_BITS8;
|
|
obt_as.fmt = AUD_FMT_U8;
|
|
break;
|
|
|
|
case AUD_FMT_S32:
|
|
case AUD_FMT_U32:
|
|
dolog ("Will use 16 instead of 32 bit samples\n");
|
|
/* fall through */
|
|
case AUD_FMT_S16:
|
|
case AUD_FMT_U16:
|
|
deffmt:
|
|
esdfmt |= ESD_BITS16;
|
|
obt_as.fmt = AUD_FMT_S16;
|
|
break;
|
|
|
|
default:
|
|
dolog ("Internal logic error: Bad audio format %d\n", as->fmt);
|
|
goto deffmt;
|
|
|
|
}
|
|
obt_as.endianness = AUDIO_HOST_ENDIANNESS;
|
|
|
|
audio_pcm_init_info (&hw->info, &obt_as);
|
|
|
|
hw->samples = conf.samples;
|
|
esd->pcm_buf = audio_calloc (AUDIO_FUNC, hw->samples, 1 << hw->info.shift);
|
|
if (!esd->pcm_buf) {
|
|
dolog ("Could not allocate buffer (%d bytes)\n",
|
|
hw->samples << hw->info.shift);
|
|
return -1;
|
|
}
|
|
|
|
esd->fd = esd_play_stream (esdfmt, as->freq, conf.dac_host, NULL);
|
|
if (esd->fd < 0) {
|
|
qesd_logerr (errno, "esd_play_stream failed\n");
|
|
goto fail1;
|
|
}
|
|
|
|
if (audio_pt_init (&esd->pt, qesd_thread_out, esd, AUDIO_CAP, AUDIO_FUNC)) {
|
|
goto fail2;
|
|
}
|
|
|
|
return 0;
|
|
|
|
fail2:
|
|
if (close (esd->fd)) {
|
|
qesd_logerr (errno, "%s: close on esd socket(%d) failed\n",
|
|
AUDIO_FUNC, esd->fd);
|
|
}
|
|
esd->fd = -1;
|
|
|
|
fail1:
|
|
g_free (esd->pcm_buf);
|
|
esd->pcm_buf = NULL;
|
|
return -1;
|
|
}
|
|
|
|
static void qesd_fini_out (HWVoiceOut *hw)
|
|
{
|
|
void *ret;
|
|
ESDVoiceOut *esd = (ESDVoiceOut *) hw;
|
|
|
|
audio_pt_lock (&esd->pt, AUDIO_FUNC);
|
|
esd->done = 1;
|
|
audio_pt_unlock_and_signal (&esd->pt, AUDIO_FUNC);
|
|
audio_pt_join (&esd->pt, &ret, AUDIO_FUNC);
|
|
|
|
if (esd->fd >= 0) {
|
|
if (close (esd->fd)) {
|
|
qesd_logerr (errno, "failed to close esd socket\n");
|
|
}
|
|
esd->fd = -1;
|
|
}
|
|
|
|
audio_pt_fini (&esd->pt, AUDIO_FUNC);
|
|
|
|
g_free (esd->pcm_buf);
|
|
esd->pcm_buf = NULL;
|
|
}
|
|
|
|
static int qesd_ctl_out (HWVoiceOut *hw, int cmd, ...)
|
|
{
|
|
(void) hw;
|
|
(void) cmd;
|
|
return 0;
|
|
}
|
|
|
|
/* capture */
|
|
static void *qesd_thread_in (void *arg)
|
|
{
|
|
ESDVoiceIn *esd = arg;
|
|
HWVoiceIn *hw = &esd->hw;
|
|
int threshold;
|
|
|
|
threshold = conf.divisor ? hw->samples / conf.divisor : 0;
|
|
|
|
if (audio_pt_lock (&esd->pt, AUDIO_FUNC)) {
|
|
return NULL;
|
|
}
|
|
|
|
for (;;) {
|
|
int incr, to_grab, wpos;
|
|
|
|
for (;;) {
|
|
if (esd->done) {
|
|
goto exit;
|
|
}
|
|
|
|
if (esd->dead > threshold) {
|
|
break;
|
|
}
|
|
|
|
if (audio_pt_wait (&esd->pt, AUDIO_FUNC)) {
|
|
goto exit;
|
|
}
|
|
}
|
|
|
|
incr = to_grab = esd->dead;
|
|
wpos = hw->wpos;
|
|
|
|
if (audio_pt_unlock (&esd->pt, AUDIO_FUNC)) {
|
|
return NULL;
|
|
}
|
|
|
|
while (to_grab) {
|
|
ssize_t nread;
|
|
int chunk = audio_MIN (to_grab, hw->samples - wpos);
|
|
void *buf = advance (esd->pcm_buf, wpos);
|
|
|
|
again:
|
|
nread = read (esd->fd, buf, chunk << hw->info.shift);
|
|
if (nread == -1) {
|
|
if (errno == EINTR || errno == EAGAIN) {
|
|
goto again;
|
|
}
|
|
qesd_logerr (errno, "read failed\n");
|
|
return NULL;
|
|
}
|
|
|
|
if (nread != chunk << hw->info.shift) {
|
|
int rsamples = nread >> hw->info.shift;
|
|
int rbytes = rsamples << hw->info.shift;
|
|
if (rbytes != nread) {
|
|
dolog ("warning: Misaligned write %d (requested %zd), "
|
|
"alignment %d\n",
|
|
rbytes, nread, hw->info.align + 1);
|
|
}
|
|
to_grab -= rsamples;
|
|
wpos = (wpos + rsamples) % hw->samples;
|
|
break;
|
|
}
|
|
|
|
hw->conv (hw->conv_buf + wpos, buf, nread >> hw->info.shift);
|
|
wpos = (wpos + chunk) % hw->samples;
|
|
to_grab -= chunk;
|
|
}
|
|
|
|
if (audio_pt_lock (&esd->pt, AUDIO_FUNC)) {
|
|
return NULL;
|
|
}
|
|
|
|
esd->wpos = wpos;
|
|
esd->dead -= incr;
|
|
esd->incr += incr;
|
|
}
|
|
|
|
exit:
|
|
audio_pt_unlock (&esd->pt, AUDIO_FUNC);
|
|
return NULL;
|
|
}
|
|
|
|
static int qesd_run_in (HWVoiceIn *hw)
|
|
{
|
|
int live, incr, dead;
|
|
ESDVoiceIn *esd = (ESDVoiceIn *) hw;
|
|
|
|
if (audio_pt_lock (&esd->pt, AUDIO_FUNC)) {
|
|
return 0;
|
|
}
|
|
|
|
live = audio_pcm_hw_get_live_in (hw);
|
|
dead = hw->samples - live;
|
|
incr = audio_MIN (dead, esd->incr);
|
|
esd->incr -= incr;
|
|
esd->dead = dead - incr;
|
|
hw->wpos = esd->wpos;
|
|
if (esd->dead > 0) {
|
|
audio_pt_unlock_and_signal (&esd->pt, AUDIO_FUNC);
|
|
}
|
|
else {
|
|
audio_pt_unlock (&esd->pt, AUDIO_FUNC);
|
|
}
|
|
return incr;
|
|
}
|
|
|
|
static int qesd_read (SWVoiceIn *sw, void *buf, int len)
|
|
{
|
|
return audio_pcm_sw_read (sw, buf, len);
|
|
}
|
|
|
|
static int qesd_init_in (HWVoiceIn *hw, struct audsettings *as)
|
|
{
|
|
ESDVoiceIn *esd = (ESDVoiceIn *) hw;
|
|
struct audsettings obt_as = *as;
|
|
int esdfmt = ESD_STREAM | ESD_RECORD;
|
|
|
|
esdfmt |= (as->nchannels == 2) ? ESD_STEREO : ESD_MONO;
|
|
switch (as->fmt) {
|
|
case AUD_FMT_S8:
|
|
case AUD_FMT_U8:
|
|
esdfmt |= ESD_BITS8;
|
|
obt_as.fmt = AUD_FMT_U8;
|
|
break;
|
|
|
|
case AUD_FMT_S16:
|
|
case AUD_FMT_U16:
|
|
esdfmt |= ESD_BITS16;
|
|
obt_as.fmt = AUD_FMT_S16;
|
|
break;
|
|
|
|
case AUD_FMT_S32:
|
|
case AUD_FMT_U32:
|
|
dolog ("Will use 16 instead of 32 bit samples\n");
|
|
esdfmt |= ESD_BITS16;
|
|
obt_as.fmt = AUD_FMT_S16;
|
|
break;
|
|
}
|
|
obt_as.endianness = AUDIO_HOST_ENDIANNESS;
|
|
|
|
audio_pcm_init_info (&hw->info, &obt_as);
|
|
|
|
hw->samples = conf.samples;
|
|
esd->pcm_buf = audio_calloc (AUDIO_FUNC, hw->samples, 1 << hw->info.shift);
|
|
if (!esd->pcm_buf) {
|
|
dolog ("Could not allocate buffer (%d bytes)\n",
|
|
hw->samples << hw->info.shift);
|
|
return -1;
|
|
}
|
|
|
|
esd->fd = esd_record_stream (esdfmt, as->freq, conf.adc_host, NULL);
|
|
if (esd->fd < 0) {
|
|
qesd_logerr (errno, "esd_record_stream failed\n");
|
|
goto fail1;
|
|
}
|
|
|
|
if (audio_pt_init (&esd->pt, qesd_thread_in, esd, AUDIO_CAP, AUDIO_FUNC)) {
|
|
goto fail2;
|
|
}
|
|
|
|
return 0;
|
|
|
|
fail2:
|
|
if (close (esd->fd)) {
|
|
qesd_logerr (errno, "%s: close on esd socket(%d) failed\n",
|
|
AUDIO_FUNC, esd->fd);
|
|
}
|
|
esd->fd = -1;
|
|
|
|
fail1:
|
|
g_free (esd->pcm_buf);
|
|
esd->pcm_buf = NULL;
|
|
return -1;
|
|
}
|
|
|
|
static void qesd_fini_in (HWVoiceIn *hw)
|
|
{
|
|
void *ret;
|
|
ESDVoiceIn *esd = (ESDVoiceIn *) hw;
|
|
|
|
audio_pt_lock (&esd->pt, AUDIO_FUNC);
|
|
esd->done = 1;
|
|
audio_pt_unlock_and_signal (&esd->pt, AUDIO_FUNC);
|
|
audio_pt_join (&esd->pt, &ret, AUDIO_FUNC);
|
|
|
|
if (esd->fd >= 0) {
|
|
if (close (esd->fd)) {
|
|
qesd_logerr (errno, "failed to close esd socket\n");
|
|
}
|
|
esd->fd = -1;
|
|
}
|
|
|
|
audio_pt_fini (&esd->pt, AUDIO_FUNC);
|
|
|
|
g_free (esd->pcm_buf);
|
|
esd->pcm_buf = NULL;
|
|
}
|
|
|
|
static int qesd_ctl_in (HWVoiceIn *hw, int cmd, ...)
|
|
{
|
|
(void) hw;
|
|
(void) cmd;
|
|
return 0;
|
|
}
|
|
|
|
/* common */
|
|
static void *qesd_audio_init (void)
|
|
{
|
|
return &conf;
|
|
}
|
|
|
|
static void qesd_audio_fini (void *opaque)
|
|
{
|
|
(void) opaque;
|
|
ldebug ("esd_fini");
|
|
}
|
|
|
|
struct audio_option qesd_options[] = {
|
|
{
|
|
.name = "SAMPLES",
|
|
.tag = AUD_OPT_INT,
|
|
.valp = &conf.samples,
|
|
.descr = "buffer size in samples"
|
|
},
|
|
{
|
|
.name = "DIVISOR",
|
|
.tag = AUD_OPT_INT,
|
|
.valp = &conf.divisor,
|
|
.descr = "threshold divisor"
|
|
},
|
|
{
|
|
.name = "DAC_HOST",
|
|
.tag = AUD_OPT_STR,
|
|
.valp = &conf.dac_host,
|
|
.descr = "playback host"
|
|
},
|
|
{
|
|
.name = "ADC_HOST",
|
|
.tag = AUD_OPT_STR,
|
|
.valp = &conf.adc_host,
|
|
.descr = "capture host"
|
|
},
|
|
{ /* End of list */ }
|
|
};
|
|
|
|
static struct audio_pcm_ops qesd_pcm_ops = {
|
|
.init_out = qesd_init_out,
|
|
.fini_out = qesd_fini_out,
|
|
.run_out = qesd_run_out,
|
|
.write = qesd_write,
|
|
.ctl_out = qesd_ctl_out,
|
|
|
|
.init_in = qesd_init_in,
|
|
.fini_in = qesd_fini_in,
|
|
.run_in = qesd_run_in,
|
|
.read = qesd_read,
|
|
.ctl_in = qesd_ctl_in,
|
|
};
|
|
|
|
struct audio_driver esd_audio_driver = {
|
|
.name = "esd",
|
|
.descr = "http://en.wikipedia.org/wiki/Esound",
|
|
.options = qesd_options,
|
|
.init = qesd_audio_init,
|
|
.fini = qesd_audio_fini,
|
|
.pcm_ops = &qesd_pcm_ops,
|
|
.can_be_default = 0,
|
|
.max_voices_out = INT_MAX,
|
|
.max_voices_in = INT_MAX,
|
|
.voice_size_out = sizeof (ESDVoiceOut),
|
|
.voice_size_in = sizeof (ESDVoiceIn)
|
|
};
|