sndio/libsndio/sio_alsa.c

1242 lines
29 KiB
C

/* $OpenBSD$ */
/*
* Copyright (c) 2010 Jacob Meuser <jakemsr@sdf.lonestar.org>
* Copyright (c) 2008 Alexandre Ratchov <alex@caoua.org>
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
#ifdef USE_ALSA
#include <sys/types.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <errno.h>
#include <fcntl.h>
#include <limits.h>
#include <poll.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <values.h>
#include <alsa/asoundlib.h>
#include "debug.h"
#include "sio_priv.h"
#include "bsd-compat.h"
#ifdef DEBUG
static snd_output_t *output = NULL;
#define DALSA(str, err) fprintf(stderr, "%s: %s\n", str, snd_strerror(err))
#else
#define DALSA(str, err) do {} while (0)
#endif
struct sio_alsa_hdl {
struct sio_hdl sio;
struct sio_par par;
struct pollfd *pfds;
snd_pcm_t *opcm;
snd_pcm_t *ipcm;
unsigned ibpf, obpf; /* bytes per frame */
unsigned int osil; /* frames to insert on next write */
unsigned int idrop; /* frames to discard on next read */
int iused, oused; /* frames used in hardware fifos */
int idelta, odelta; /* position reported to client */
int nfds, infds, onfds;
int running;
#ifdef DEBUG
long long wpos, rpos, cpos;
#endif
};
static void sio_alsa_close(struct sio_hdl *);
static int sio_alsa_start(struct sio_hdl *);
static int sio_alsa_stop(struct sio_hdl *);
static int sio_alsa_setpar(struct sio_hdl *, struct sio_par *);
static int sio_alsa_getpar(struct sio_hdl *, struct sio_par *);
static int sio_alsa_getcap(struct sio_hdl *, struct sio_cap *);
static size_t sio_alsa_read(struct sio_hdl *, void *, size_t);
static size_t sio_alsa_write(struct sio_hdl *, const void *, size_t);
static int sio_alsa_nfds(struct sio_hdl *);
static int sio_alsa_pollfd(struct sio_hdl *, struct pollfd *, int);
static int sio_alsa_revents(struct sio_hdl *, struct pollfd *);
static struct sio_ops sio_alsa_ops = {
sio_alsa_close,
sio_alsa_setpar,
sio_alsa_getpar,
sio_alsa_getcap,
sio_alsa_write,
sio_alsa_read,
sio_alsa_start,
sio_alsa_stop,
sio_alsa_nfds,
sio_alsa_pollfd,
sio_alsa_revents,
NULL,
NULL
};
/*
* convert ALSA format to sio_par encoding
*/
static int
sio_alsa_fmttopar(struct sio_alsa_hdl *hdl, snd_pcm_format_t fmt, struct sio_par *par)
{
switch (fmt) {
case SND_PCM_FORMAT_U8:
par->bits = 8;
par->sig = 0;
break;
case SND_PCM_FORMAT_S8:
par->bits = 8;
par->sig = 1;
break;
case SND_PCM_FORMAT_S16_LE:
par->bits = 16;
par->sig = 1;
par->le = 1;
break;
case SND_PCM_FORMAT_S16_BE:
par->bits = 16;
par->sig = 1;
par->le = 0;
break;
case SND_PCM_FORMAT_U16_LE:
par->bits = 16;
par->sig = 0;
par->le = 1;
break;
case SND_PCM_FORMAT_U16_BE:
par->bits = 16;
par->sig = 0;
par->le = 0;
break;
case SND_PCM_FORMAT_S24_LE:
par->bits = 24;
par->sig = 1;
par->le = 1;
break;
case SND_PCM_FORMAT_S24_BE:
par->bits = 24;
par->sig = 1;
par->le = 0;
break;
case SND_PCM_FORMAT_U24_LE:
par->bits = 24;
par->sig = 0;
par->le = 1;
break;
case SND_PCM_FORMAT_U24_BE:
par->bits = 24;
par->sig = 0;
par->le = 0;
break;
default:
DPRINTF("sio_alsa_fmttopar: 0x%x: unsupported format\n", fmt);
hdl->sio.eof = 1;
return 0;
}
par->msb = 1;
par->bps = SIO_BPS(par->bits);
return 1;
}
/*
* convert sio_par encoding to ALSA format
*/
static void
sio_alsa_enctofmt(struct sio_alsa_hdl *hdl, snd_pcm_format_t *rfmt, struct sio_par *enc)
{
if (enc->bits == 8) {
if (enc->sig == ~0U || !enc->sig)
*rfmt = SND_PCM_FORMAT_U8;
else
*rfmt = SND_PCM_FORMAT_S8;
} else if (enc->bits == 16) {
if (enc->sig == ~0U || enc->sig) {
if (enc->le == ~0U) {
*rfmt = SIO_LE_NATIVE ?
SND_PCM_FORMAT_S16_LE :
SND_PCM_FORMAT_S16_BE;
} else if (enc->le)
*rfmt = SND_PCM_FORMAT_S16_LE;
else
*rfmt = SND_PCM_FORMAT_S16_BE;
} else {
if (enc->le == ~0U) {
*rfmt = SIO_LE_NATIVE ?
SND_PCM_FORMAT_U16_LE :
SND_PCM_FORMAT_U16_BE;
} else if (enc->le)
*rfmt = SND_PCM_FORMAT_U16_LE;
else
*rfmt = SND_PCM_FORMAT_U16_BE;
}
} else if (enc->bits == 24) {
if (enc->sig == ~0U || enc->sig) {
if (enc->le == ~0U) {
*rfmt = SIO_LE_NATIVE ?
SND_PCM_FORMAT_S24_LE :
SND_PCM_FORMAT_S24_BE;
} else if (enc->le)
*rfmt = SND_PCM_FORMAT_S24_LE;
else
*rfmt = SND_PCM_FORMAT_S24_BE;
} else {
if (enc->le == ~0U) {
*rfmt = SIO_LE_NATIVE ?
SND_PCM_FORMAT_U24_LE :
SND_PCM_FORMAT_U24_BE;
} else if (enc->le)
*rfmt = SND_PCM_FORMAT_U24_LE;
else
*rfmt = SND_PCM_FORMAT_U24_BE;
}
} else {
*rfmt = SIO_LE_NATIVE ?
SND_PCM_FORMAT_S16_LE : SND_PCM_FORMAT_S16_BE;
}
}
/*
* guess device capabilities
*/
static int
sio_alsa_getcap(struct sio_hdl *sh, struct sio_cap *cap)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
DPRINTF("sio_alsa_getcap: not implemented\n");
hdl->sio.eof = 1;
return 0;
}
struct sio_hdl *
sio_alsa_open(const char *str, unsigned mode, int nbio)
{
struct sio_alsa_hdl *hdl;
char path[PATH_MAX];
struct sio_par par;
int err;
switch (*str) {
case '/':
case ':': /* XXX: for backward compat */
str++;
break;
default:
DPRINTF("sio_sun_open: %s: '/<devnum>' expected\n", str);
return NULL;
}
hdl = malloc(sizeof(struct sio_alsa_hdl));
if (hdl == NULL)
return NULL;
sio_create(&hdl->sio, &sio_alsa_ops, mode, nbio);
#ifdef DEBUG
err = snd_output_stdio_attach(&output, stderr, 0);
if (err < 0)
DALSA("couldn't attach to stderr", err);
#endif
snprintf(path, sizeof(path), "hw:%s", str);
if (mode & SIO_PLAY) {
err = snd_pcm_open(&hdl->opcm, path,
SND_PCM_STREAM_PLAYBACK, SND_PCM_NONBLOCK);
if (err < 0) {
DALSA("couldn't open play stream", err);
goto bad_free;
}
}
if (mode & SIO_REC) {
err = snd_pcm_open(&hdl->ipcm, path,
SND_PCM_STREAM_CAPTURE, SND_PCM_NONBLOCK);
if (err < 0) {
DALSA("couldn't open rec stream", err);
goto bad_free_opcm;
}
}
hdl->nfds = SIO_MAXNFDS;
hdl->pfds = malloc(sizeof(struct pollfd) * hdl->nfds);
if (hdl->pfds == NULL) {
DPERROR("couldn't allocate pollfd structures");
goto bad_free_ipcm;
}
DPRINTF("mode = %d, allocated %d descriptors\n", mode, hdl->nfds);
/*
* Default parameters may not be compatible with libsndio (eg. mulaw
* encodings, different playback and recording parameters, etc...), so
* set parameters to a random value. If the requested parameters are
* not supported by the device, then sio_setpar() will pick supported
* ones.
*/
sio_initpar(&par);
par.bits = 16;
par.le = SIO_LE_NATIVE;
par.rate = 48000;
if (mode & SIO_PLAY)
par.pchan = 2;
if (mode & SIO_REC)
par.rchan = 2;
if (!sio_setpar(&hdl->sio, &par))
goto bad_free_ipcm;
return (struct sio_hdl *)hdl;
bad_free_ipcm:
if (mode & SIO_REC)
snd_pcm_close(hdl->ipcm);
bad_free_opcm:
if (mode & SIO_PLAY)
snd_pcm_close(hdl->opcm);
bad_free:
free(hdl);
return NULL;
}
static void
sio_alsa_close(struct sio_hdl *sh)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
if (hdl->sio.mode & SIO_PLAY)
snd_pcm_close(hdl->opcm);
if (hdl->sio.mode & SIO_REC)
snd_pcm_close(hdl->ipcm);
free(hdl);
}
#ifdef DEBUG
void
sio_alsa_printpos(struct sio_alsa_hdl *hdl, int delta)
{
long long rpos, rdiff;
long long cpos, cdiff;
long long wpos, wdiff;
cdiff = hdl->cpos % hdl->par.round;
cpos = hdl->cpos / hdl->par.round;
if (cdiff > hdl->par.round / 2) {
cpos++;
cdiff = cdiff - hdl->par.round;
}
rdiff = hdl->rpos % hdl->par.round;
rpos = hdl->rpos / hdl->par.round;
if (rdiff > hdl->par.round / 2) {
rpos++;
rdiff = rdiff - hdl->par.round;
}
wdiff = hdl->wpos % hdl->par.round;
wpos = hdl->wpos / hdl->par.round;
if (wdiff > hdl->par.round / 2) {
wpos++;
wdiff = wdiff - hdl->par.round;
}
fprintf(stderr,
"clk: %+4lld %+4lld, wr %+4lld %+4lld rd: %+4lld %+4lld\n",
cpos, cdiff, wpos, wdiff, rpos, rdiff);
}
#endif
static int
sio_alsa_start(struct sio_hdl *sh)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
int err;
DPRINTF("sio_alsa_start:\n");
hdl->ibpf = hdl->par.rchan * hdl->par.bps;
hdl->obpf = hdl->par.pchan * hdl->par.bps;
hdl->iused = 0;
hdl->oused = 0;
hdl->idelta = 0;
hdl->odelta = -hdl->par.bufsz;
hdl->infds = 0;
hdl->onfds = 0;
hdl->osil = 0;
hdl->idrop = 0;
hdl->running = 0;
#ifdef DEBUG
hdl->cpos = hdl->rpos = hdl->wpos = 0;
#endif
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_prepare(hdl->opcm);
if (err < 0) {
DALSA("couldn't prepare play stream", err);
hdl->sio.eof = 1;
return 0;
}
}
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_prepare(hdl->ipcm);
if (err < 0) {
DALSA("couldn't prepare rec stream", err);
hdl->sio.eof = 1;
return 0;
}
}
if ((hdl->sio.mode & SIO_PLAY) && (hdl->sio.mode & SIO_REC)) {
err = snd_pcm_link(hdl->ipcm, hdl->opcm);
if (err < 0) {
DALSA("couldn't link streams", err);
hdl->sio.eof = 1;
return 0;
}
}
if (!(hdl->sio.mode & SIO_PLAY)) {
err = snd_pcm_start(hdl->ipcm);
if (err < 0) {
DALSA("couldn't start rec stream", err);
hdl->sio.eof = 1;
return 0;
}
}
#ifdef DEBUG
if (sndio_debug) {
if (hdl->sio.mode & SIO_REC)
snd_pcm_dump(hdl->ipcm, output);
if (hdl->sio.mode & SIO_PLAY)
snd_pcm_dump(hdl->opcm, output);
}
#endif
return 1;
}
static int
sio_alsa_stop(struct sio_hdl *sh)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
int err;
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_drop(hdl->opcm);
if (err < 0) {
DALSA("couldn't stop play stream", err);
hdl->sio.eof = 1;
return 0;
}
}
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_drop(hdl->ipcm);
if (err < 0) {
DALSA("couldn't stop rec stream", err);
hdl->sio.eof = 1;
return 0;
}
}
if ((hdl->sio.mode & SIO_PLAY) && (hdl->sio.mode & SIO_REC)) {
err = snd_pcm_unlink(hdl->ipcm);
if (err < 0) {
DALSA("couldn't unlink streams", err);
hdl->sio.eof = 1;
return 0;
}
}
DPRINTF("stopped");
return 1;
}
static int
sio_alsa_xrun(struct sio_alsa_hdl *hdl)
{
int wdiff, cdiff, rdiff, offs;
fprintf(stderr, "xrun: stop ");
sio_alsa_printpos(hdl, 0);
cdiff = hdl->par.round - (hdl->cpos % hdl->par.round);
if (cdiff == hdl->par.round)
cdiff = 0;
if (cdiff > 0) {
hdl->cpos += cdiff;
sio_onmove_cb(&hdl->sio, cdiff);
}
fprintf(stderr, "xrun: tick ");
sio_alsa_printpos(hdl, 0);
if (hdl->sio.mode & SIO_PLAY) {
wdiff = hdl->wpos - hdl->cpos;
if (hdl->sio.mode & SIO_REC)
offs = hdl->wpos - hdl->rpos;
} else {
rdiff = hdl->par.bufsz - (hdl->cpos - hdl->rpos);
}
if (!sio_alsa_stop(&hdl->sio))
return 0;
if (!sio_alsa_start(&hdl->sio))
return 0;
hdl->running = 1;
if (hdl->sio.mode & SIO_PLAY) {
if (hdl->sio.mode & SIO_REC) {
while (wdiff < offs) {
wdiff += hdl->par.round;
hdl->odelta -= hdl->par.round;
hdl->cpos += hdl->par.round;
}
}
fprintf(stderr, "xrun: inserting silence: %d\n", wdiff);
hdl->osil = wdiff;
if (hdl->sio.mode & SIO_REC)
hdl->idrop = wdiff - offs;
} else {
while (rdiff > (int)hdl->par.bufsz) {
rdiff -= hdl->par.round;
hdl->idelta -= hdl->par.round;
hdl->cpos += hdl->par.round;
}
fprintf(stderr, "xrun: dropping: %d\n", rdiff);
hdl->idrop = rdiff;
}
fprintf(stderr, "xrun: osil = %d, idrop = %d\n", hdl->osil, hdl->idrop);
fprintf(stderr, "xrun: corr ");
sio_alsa_printpos(hdl, 0);
return 1;
}
static int
sio_alsa_setpar(struct sio_hdl *sh, struct sio_par *par)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
snd_pcm_hw_params_t *ohwp, *ihwp;
snd_pcm_sw_params_t *oswp, *iswp;
snd_pcm_uframes_t iround, oround, ibufsz, obufsz;
snd_pcm_format_t ifmt, ofmt;
unsigned bufsz, round, periods;
unsigned irate, orate, req_rate;
unsigned ich, och;
int err, dir;
snd_pcm_hw_params_malloc(&ohwp);
snd_pcm_sw_params_malloc(&oswp);
snd_pcm_hw_params_malloc(&ihwp);
snd_pcm_sw_params_malloc(&iswp);
/*
* set encoding
*/
sio_alsa_enctofmt(hdl, &ofmt, par);
DPRINTF("ofmt = %u\n", ofmt);
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_hw_params_any(hdl->opcm, ohwp);
if (err < 0) {
DALSA("couldn't init play pars", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_access(hdl->opcm, ohwp,
SND_PCM_ACCESS_RW_INTERLEAVED);
if (err < 0) {
DALSA("couldn't set play access", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_format(hdl->opcm, ohwp, ofmt);
if (err < 0) {
DALSA("couldn't set play fmt", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_get_format(ohwp, &ofmt);
if (err < 0) {
DALSA("couldn't get play fmt", err);
hdl->sio.eof = 1;
return 0;
}
}
ifmt = ofmt;
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_hw_params_any(hdl->ipcm, ihwp);
if (err < 0) {
DALSA("couldn't init rec pars", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_access(hdl->ipcm, ihwp,
SND_PCM_ACCESS_RW_INTERLEAVED);
if (err < 0) {
DALSA("couldn't set rec access", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_format(hdl->ipcm, ihwp, ifmt);
if (err < 0) {
DALSA("couldn't set rec fmt", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_get_format(ihwp, &ifmt);
if (err < 0) {
DALSA("couldn't get play fmt", err);
hdl->sio.eof = 1;
return 0;
}
if (!(hdl->sio.mode & SIO_PLAY))
ofmt = ifmt;
}
if (ifmt != ofmt) {
DPRINTF("play and rec formats differ\n");
hdl->sio.eof = 1;
return 0;
}
if (!sio_alsa_fmttopar(hdl, ofmt, &hdl->par))
return 0;
/*
* set rate
*/
orate = (par->rate == ~0U) ? 48000 : par->rate;
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_hw_params_set_rate_resample(hdl->opcm, ohwp, 0);
if (err < 0) {
DALSA("couldn't turn play resampling off", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_rate_near(hdl->opcm,
ohwp, &orate, 0);
if (err < 0) {
DALSA("couldn't set play rate", err);
hdl->sio.eof = 1;
return 0;
}
}
irate = orate;
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_hw_params_set_rate_resample(hdl->ipcm, ihwp, 0);
if (err < 0) {
DALSA("couldn't turn rec resampling off", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_rate_near(hdl->ipcm,
ihwp, &irate, 0);
if (err < 0) {
DALSA("couldn't set rec rate", err);
hdl->sio.eof = 1;
return 0;
}
if (!(hdl->sio.mode & SIO_PLAY))
orate = irate;
}
if (irate != orate) {
DPRINTF("could not get matching play/record rate");
hdl->sio.eof = 1;
return 0;
}
hdl->par.rate = orate;
/*
* set number of channels
*/
if ((hdl->sio.mode & SIO_PLAY) && par->pchan != ~0U) {
och = par->pchan;
err = snd_pcm_hw_params_set_channels_near(hdl->opcm,
ohwp, &och);
if (err < 0) {
DALSA("couldn't set play channel count", err);
hdl->sio.eof = 1;
return 0;
}
hdl->par.pchan = och;
}
if ((hdl->sio.mode & SIO_REC) && par->rchan != ~0U) {
ich = par->rchan;
err = snd_pcm_hw_params_set_channels_near(hdl->ipcm,
ihwp, &ich);
if (err < 0) {
DALSA("couldn't set rec channel count", err);
hdl->sio.eof = 1;
return 0;
}
hdl->par.rchan = ich;
}
/*
* If the rate that the hardware is using is different than
* the requested rate, scale buffer sizes so they will be the
* same time duration as what was requested. This just gets
* the rates to use for scaling, that actual scaling is done
* later.
*/
req_rate = (par->rate != ~0U) ? par->rate : hdl->par.rate;
DPRINTF("req_rate = %u, orate = %u\n", req_rate, orate);
/*
* if block size and buffer size are not both set then
* set the blocksize to half the buffer size
*/
bufsz = par->appbufsz;
round = par->round;
if (bufsz != ~0U) {
bufsz = bufsz * orate / req_rate;
bufsz = (bufsz + 63) & ~63;
if (round == ~0U)
round = bufsz / 2;
else {
round = round * orate / req_rate;
round = (bufsz + 31) & ~31;
bufsz += round - 1;
bufsz -= bufsz % round;
}
} else if (round != ~0U) {
round = round * orate / req_rate;
round = (bufsz + 31) & ~31;
bufsz = round * 2;
} else {
round = orate / 100;
round = (round + 31) & ~31;
bufsz = round * 2;
}
DPRINTF("sio_alsa_setpar: trying bufsz = %u, round = %u\n", bufsz, round);
oround = round;
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_hw_params_set_period_size_integer(hdl->opcm, ohwp);
if (err < 0) {
DALSA("couldn't set play period to integer", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_period_size_near(hdl->opcm, ohwp, &oround, &dir);
if (err < 0) {
DALSA("couldn't set play period size failed", err);
hdl->sio.eof = 1;
return 0;
}
}
iround = oround;
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_hw_params_set_period_size_integer(hdl->ipcm, ihwp);
if (err < 0) {
DALSA("couldn't set rec period to integer", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_period_size_near(hdl->ipcm,
ihwp, &iround, NULL);
if (err < 0) {
DALSA("couldn't set rec period size failed", err);
hdl->sio.eof = 1;
return 0;
}
if (!(hdl->sio.mode & SIO_PLAY))
oround = iround;
}
if (iround != oround) {
DPRINTF("could not get matching play/record period size");
hdl->sio.eof = 1;
return 0;
}
hdl->par.round = oround;
/*
* make sure we've at least two periods
*/
periods = bufsz / round;
if (periods < 2)
periods = 2;
bufsz = hdl->par.round * periods;
obufsz = bufsz;
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_hw_params_set_periods_integer(hdl->opcm, ohwp);
if (err < 0) {
DALSA("couldn't set play periods to integer", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_buffer_size_near(hdl->opcm,
ohwp, &obufsz);
if (err < 0) {
DALSA("couldn't set play buffer size", err);
hdl->sio.eof = 1;
return 0;
}
}
ibufsz = obufsz;
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_hw_params_set_periods_integer(hdl->ipcm, ihwp);
if (err < 0) {
DALSA("couldn't set rec periods to integer", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_hw_params_set_buffer_size_near(hdl->ipcm,
ihwp, &ibufsz);
if (err < 0) {
DALSA("couldn't set rec buffer size", err);
hdl->sio.eof = 1;
return 0;
}
if (!(hdl->sio.mode & SIO_PLAY))
ibufsz = obufsz;
}
if (ibufsz != obufsz) {
DPRINTF("could not get matching play/record buffer size");
hdl->sio.eof = 1;
return 0;
}
hdl->par.appbufsz = hdl->par.bufsz = obufsz;
DPRINTF("sio_alsa_setpar: got bufsz = %u, round = %u\n",
hdl->par.bufsz, hdl->par.round);
/* commit hardware params */
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_hw_params(hdl->opcm, ohwp);
if (err < 0) {
DALSA("couldn't commit play params", err);
hdl->sio.eof = 1;
return 0;
}
}
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_hw_params(hdl->ipcm, ihwp);
if (err < 0) {
DALSA("couldn't commit rec params failed", err);
hdl->sio.eof = 1;
return 0;
}
}
/* software params */
if (hdl->sio.mode & SIO_PLAY) {
err = snd_pcm_sw_params_current(hdl->opcm, oswp);
if (err < 0) {
DALSA("couldn't get current play params", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_start_threshold(hdl->opcm,
oswp, hdl->par.bufsz);
if (err < 0) {
DALSA("couldn't set play start threshold", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_stop_threshold(hdl->opcm,
oswp, hdl->par.bufsz);
if (err < 0) {
DALSA("couldn't set play stop threshold", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_avail_min(hdl->opcm,
oswp, hdl->par.round);
if (err < 0) {
DALSA("couldn't set play avail min", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_period_event(hdl->opcm, oswp, 1);
if (err < 0) {
DALSA("couldn't set play period event", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params(hdl->opcm, oswp);
if (err < 0) {
DALSA("couldn't commit play sw params", err);
hdl->sio.eof = 1;
return 0;
}
}
if (hdl->sio.mode & SIO_REC) {
err = snd_pcm_sw_params_current(hdl->ipcm, iswp);
if (err < 0) {
DALSA("couldn't get current rec params", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_start_threshold(hdl->ipcm,
iswp, 0);
if (err < 0) {
DALSA("couldn't set rec start threshold", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_stop_threshold(hdl->ipcm,
iswp, hdl->par.bufsz);
if (err < 0) {
DALSA("couldn't set rec stop threshold", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_avail_min(hdl->ipcm,
iswp, hdl->par.round);
if (err < 0) {
DALSA("couldn't set rec avail min", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params_set_period_event(hdl->ipcm, iswp, 1);
if (err < 0) {
DALSA("couldn't set rec period event", err);
hdl->sio.eof = 1;
return 0;
}
err = snd_pcm_sw_params(hdl->ipcm, iswp);
if (err < 0) {
DALSA("couldn't commit rec sw params", err);
hdl->sio.eof = 1;
return 0;
}
}
DPRINTF("sio_alsa_setpar: done\n");
return 1;
}
static int
sio_alsa_getpar(struct sio_hdl *sh, struct sio_par *par)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
*par = hdl->par;
return 1;
}
/*
* drop recorded samples to compensate xruns
*/
static int
sio_alsa_rdrop(struct sio_alsa_hdl *hdl)
{
#define DROP_NMAX 0x1000
static char buf[DROP_NMAX];
ssize_t n, todo, max;
max = DROP_NMAX / hdl->ibpf;
while (hdl->idrop > 0) {
todo = hdl->idrop;
if (todo > max)
todo = max;
while ((n = snd_pcm_readi(hdl->ipcm, buf, todo)) < 0) {
if (n == -EINTR)
continue;
if (n == -EPIPE && sio_alsa_xrun(hdl))
continue;
if (n != -EAGAIN) {
DALSA("couldn't read data to drop", n);
hdl->sio.eof = 1;
}
return 0;
}
if (n == 0) {
DPRINTF("sio_alsa_rdrop: eof\n");
hdl->sio.eof = 1;
return 0;
}
hdl->idrop -= n;
#ifdef DEBUG
hdl->rpos += n;
#endif
hdl->idelta += n;
DPRINTF("sio_alsa_rdrop: dropped %ld/%ld frames\n", n, todo);
}
return 1;
}
static size_t
sio_alsa_read(struct sio_hdl *sh, void *buf, size_t len)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
snd_pcm_sframes_t n;
snd_pcm_uframes_t todo;
todo = len / hdl->ibpf;
while ((n = snd_pcm_readi(hdl->ipcm, buf, todo)) < 0) {
if (n == -EINTR)
continue;
if (n == -EPIPE && sio_alsa_xrun(hdl))
continue;
if (n != -EAGAIN) {
DALSA("couldn't read data", n);
hdl->sio.eof = 1;
}
return 0;
}
if (n == 0) {
DPRINTF("sio_alsa_read: eof\n");
hdl->sio.eof = 1;
return 0;
}
#ifdef DEBUG
hdl->rpos += n;
#endif
hdl->idelta += n;
n *= hdl->ibpf;
return n;
}
/*
* insert silence to play to compensate xruns
*/
static int
sio_alsa_wsil(struct sio_alsa_hdl *hdl)
{
#define ZERO_NMAX 0x1000
static char zero[ZERO_NMAX];
ssize_t n, todo, max;
max = ZERO_NMAX / hdl->obpf;
while (hdl->osil > 0) {
todo = hdl->osil;
if (todo > max)
todo = max;
while ((n = snd_pcm_writei(hdl->opcm, zero, todo)) < 0) {
if (n == -EINTR)
continue;
if (n == -ESTRPIPE && sio_alsa_xrun(hdl))
continue;
if (n != -EAGAIN) {
DALSA("couldn't write silence", n);
hdl->sio.eof = 1;
}
return 0;
}
#ifdef DEBUG
hdl->wpos += n;
#endif
hdl->odelta += n;
hdl->osil -= n;
DPRINTF("sio_alsa_wsil: inserted %ld/%ld frames\n", n, todo);
}
return 1;
}
static size_t
sio_alsa_write(struct sio_hdl *sh, const void *buf, size_t len)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
ssize_t n, todo;
if (!sio_alsa_wsil(hdl))
return 0;
if (len < hdl->obpf) {
/*
* we can't just return, because sio_write() will loop
* forever. Fix this by saving partial samples in a
* temporary buffer.
*/
fprintf(stderr, "sio_alsa_write: wrong chunk size\n");
hdl->sio.eof = 1;
return 0;
}
todo = len / hdl->obpf;
DPRINTF("sio_alsa_write: len = %zd, todo = %zd\n", len, todo);
while ((n = snd_pcm_writei(hdl->opcm, buf, todo)) < 0) {
if (n == -EINTR)
continue;
if ((n == -ESTRPIPE || n == -EPIPE) && sio_alsa_xrun(hdl))
continue;
if (n != -EAGAIN) {
DALSA("couldn't write data", n);
hdl->sio.eof = 1;
}
return 0;
}
DPRINTF("wrote %zd\n", n);
#ifdef DEBUG
hdl->wpos += n;
#endif
hdl->odelta += n;
n *= hdl->obpf;
return n;
}
static int
sio_alsa_nfds(struct sio_hdl *sh)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
return hdl->nfds;
}
static int
sio_alsa_pollfd(struct sio_hdl *sh, struct pollfd *pfd, int events)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
if (hdl->sio.eof)
return 0;
memset(pfd, 0, sizeof(struct pollfd) * hdl->nfds);
if ((hdl->sio.mode & SIO_PLAY) && hdl->sio.started) {
if (!hdl->running &&
snd_pcm_state(hdl->opcm) == SND_PCM_STATE_RUNNING) {
hdl->running = 1;
sio_onmove_cb(&hdl->sio, 0);
}
hdl->onfds = snd_pcm_poll_descriptors(hdl->opcm,
pfd, hdl->nfds);
if (hdl->onfds < 0) {
DALSA("couldn't poll play descriptors", hdl->onfds);
hdl->sio.eof = 1;
return 0;
}
} else
hdl->onfds = 0;
if ((hdl->sio.mode & SIO_REC) && hdl->sio.started) {
if (!hdl->running &&
snd_pcm_state(hdl->ipcm) == SND_PCM_STATE_RUNNING) {
hdl->running = 1;
sio_onmove_cb(&hdl->sio, 0);
}
hdl->infds = snd_pcm_poll_descriptors(hdl->ipcm,
pfd + hdl->onfds, hdl->nfds - hdl->onfds);
if (hdl->infds < 0) {
DALSA("couldn't poll rec descriptors", hdl->infds);
hdl->sio.eof = 1;
return 0;
}
} else
hdl->infds = 0;
DPRINTF("sio_alsa_pollfd: events = %x, nfds = %d + %d\n",
events, hdl->onfds, hdl->infds);
#if 0
for (i = 0; i < hdl->onfds + hdl->infds; i++) {
DPRINTF("sio_alsa_pollfd: pfds[%d].events = %x\n",
i, pfd[i].events);
}
#endif
return hdl->onfds + hdl->infds;
}
int
sio_alsa_revents(struct sio_hdl *sh, struct pollfd *pfd)
{
struct sio_alsa_hdl *hdl = (struct sio_alsa_hdl *)sh;
snd_pcm_sframes_t iused, oavail, oused;
snd_pcm_state_t istate, ostate;
int nfds;
unsigned short revents, r;
int err;
if (hdl->sio.eof)
return POLLHUP;
#if 0
int i
for (i = 0; i < hdl->onfds + hdl->infds; i++) {
DPRINTF("sio_alsa_revents: pfds[%d].events = %x\n",
i, pfd[i].revents);
}
#endif
revents = nfds = 0;
if (hdl->sio.mode & SIO_PLAY) {
ostate = snd_pcm_state(hdl->opcm);
if (ostate == SND_PCM_STATE_XRUN) {
if (!sio_alsa_xrun(hdl))
return POLLHUP;
return 0;
}
err = snd_pcm_poll_descriptors_revents(hdl->opcm, pfd, hdl->onfds, &r);
if (err < 0) {
DALSA("couldn't get play events", err);
hdl->sio.eof = 1;
return POLLHUP;
}
revents |= r;
nfds += hdl->onfds;
}
if (hdl->sio.mode & SIO_REC) {
istate = snd_pcm_state(hdl->ipcm);
if (istate == SND_PCM_STATE_XRUN) {
if (!sio_alsa_xrun(hdl))
return POLLHUP;
return 0;
}
err = snd_pcm_poll_descriptors_revents(hdl->ipcm, pfd + nfds, hdl->infds, &r);
if (err < 0) {
DALSA("couldn't get rec events", err);
hdl->sio.eof = 1;
return POLLHUP;
}
revents |= r;
nfds += hdl->infds;
}
DPRINTF("sio_alsa_revents: revents = %x\n", revents);
if ((revents & POLLOUT) && (hdl->sio.mode & SIO_PLAY) &&
(ostate == SND_PCM_STATE_RUNNING ||
ostate == SND_PCM_STATE_PREPARED)) {
oavail = snd_pcm_avail_update(hdl->opcm);
if (oavail < 0) {
if (oavail == -EPIPE) {
if (!sio_alsa_xrun(hdl))
return POLLHUP;
return 0;
}
DALSA("couldn't get play buffer pointer", oavail);
hdl->sio.eof = 1;
return POLLHUP;
}
oused = hdl->par.bufsz - oavail;
hdl->odelta += oused - hdl->oused;
hdl->oused = oused;
while (hdl->odelta > 0) {
#ifdef DEBUG
hdl->cpos += hdl->odelta;
if (sndio_debug)
sio_alsa_printpos(hdl, hdl->odelta);
#endif
sio_onmove_cb(&hdl->sio, hdl->odelta);
hdl->odelta = 0;
}
}
if ((revents & POLLIN) && !(hdl->sio.mode & SIO_PLAY) &&
(istate == SND_PCM_STATE_RUNNING ||
istate == SND_PCM_STATE_PREPARED)) {
iused = snd_pcm_avail_update(hdl->ipcm);
if (iused < 0) {
if (iused == -EPIPE) {
if (!sio_alsa_xrun(hdl))
return POLLHUP;
return 0;
}
DALSA("couldn't get rec buffer pointer", iused);
hdl->sio.eof = 1;
return POLLHUP;
}
hdl->idelta += iused - hdl->iused;
hdl->iused = iused;
if (hdl->idelta > 0) {
#ifdef DEBUG
hdl->cpos += hdl->idelta;
if (sndio_debug)
sio_onmove_cb(&hdl->sio, hdl->idelta);
#endif
hdl->idelta = 0;
}
}
if ((hdl->sio.mode & SIO_PLAY) && !sio_alsa_wsil(hdl))
revents &= ~POLLOUT;
if ((hdl->sio.mode & SIO_REC) && !sio_alsa_rdrop(hdl))
revents &= ~POLLIN;
return revents;
}
#endif /* defined USE_ALSA */