mirror of
https://github.com/ericonr/sndio.git
synced 2024-02-18 04:45:21 -06:00
a3a868da74
maxwrite
496 lines
12 KiB
C
496 lines
12 KiB
C
/* $OpenBSD$ */
|
|
/*
|
|
* 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.
|
|
*/
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/un.h>
|
|
#include <netinet/in.h>
|
|
|
|
#include <errno.h>
|
|
#include <fcntl.h>
|
|
#include <poll.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
|
|
#include "aucat.h"
|
|
#include "debug.h"
|
|
#include "sio_priv.h"
|
|
#include "bsd-compat.h"
|
|
|
|
struct sio_aucat_hdl {
|
|
struct sio_hdl sio;
|
|
struct aucat aucat;
|
|
unsigned int rbpf, wbpf; /* read and write bytes-per-frame */
|
|
int events; /* events the user requested */
|
|
unsigned int curvol, reqvol; /* current and requested volume */
|
|
int delta; /* some of received deltas */
|
|
#define PSTATE_INIT 0
|
|
#define PSTATE_RUN 1
|
|
int pstate;
|
|
size_t round; /* write block size */
|
|
size_t walign; /* align write packets size to this */
|
|
};
|
|
|
|
static void sio_aucat_close(struct sio_hdl *);
|
|
static int sio_aucat_start(struct sio_hdl *);
|
|
static int sio_aucat_stop(struct sio_hdl *);
|
|
static int sio_aucat_setpar(struct sio_hdl *, struct sio_par *);
|
|
static int sio_aucat_getpar(struct sio_hdl *, struct sio_par *);
|
|
static int sio_aucat_getcap(struct sio_hdl *, struct sio_cap *);
|
|
static size_t sio_aucat_read(struct sio_hdl *, void *, size_t);
|
|
static size_t sio_aucat_write(struct sio_hdl *, const void *, size_t);
|
|
static int sio_aucat_nfds(struct sio_hdl *);
|
|
static int sio_aucat_pollfd(struct sio_hdl *, struct pollfd *, int);
|
|
static int sio_aucat_revents(struct sio_hdl *, struct pollfd *);
|
|
static int sio_aucat_setvol(struct sio_hdl *, unsigned int);
|
|
static void sio_aucat_getvol(struct sio_hdl *);
|
|
|
|
static struct sio_ops sio_aucat_ops = {
|
|
sio_aucat_close,
|
|
sio_aucat_setpar,
|
|
sio_aucat_getpar,
|
|
sio_aucat_getcap,
|
|
sio_aucat_write,
|
|
sio_aucat_read,
|
|
sio_aucat_start,
|
|
sio_aucat_stop,
|
|
sio_aucat_nfds,
|
|
sio_aucat_pollfd,
|
|
sio_aucat_revents,
|
|
sio_aucat_setvol,
|
|
sio_aucat_getvol
|
|
};
|
|
|
|
/*
|
|
* execute the next message, return 0 if blocked
|
|
*/
|
|
static int
|
|
sio_aucat_runmsg(struct sio_aucat_hdl *hdl)
|
|
{
|
|
int delta;
|
|
unsigned int size, ctl;
|
|
|
|
if (!aucat_rmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
switch (ntohl(hdl->aucat.rmsg.cmd)) {
|
|
case AMSG_DATA:
|
|
size = ntohl(hdl->aucat.rmsg.u.data.size);
|
|
if (size == 0 || size % hdl->rbpf) {
|
|
DPRINTF("sio_aucat_runmsg: bad data message\n");
|
|
hdl->sio.eof = 1;
|
|
return 0;
|
|
}
|
|
return 1;
|
|
case AMSG_FLOWCTL:
|
|
delta = ntohl(hdl->aucat.rmsg.u.ts.delta);
|
|
hdl->aucat.maxwrite += delta * (int)hdl->wbpf;
|
|
DPRINTF("aucat: flowctl = %d, maxwrite = %d\n",
|
|
delta, hdl->aucat.maxwrite);
|
|
break;
|
|
case AMSG_MOVE:
|
|
delta = ntohl(hdl->aucat.rmsg.u.ts.delta);
|
|
hdl->delta += delta;
|
|
DPRINTFN(2, "aucat: move = %d, delta = %d, maxwrite = %d\n",
|
|
delta, hdl->delta, hdl->aucat.maxwrite);
|
|
if (hdl->delta >= 0) {
|
|
sio_onmove_cb(&hdl->sio, hdl->delta);
|
|
hdl->delta = 0;
|
|
}
|
|
break;
|
|
case AMSG_SETVOL:
|
|
ctl = ntohl(hdl->aucat.rmsg.u.vol.ctl);
|
|
hdl->curvol = hdl->reqvol = ctl;
|
|
sio_onvol_cb(&hdl->sio, ctl);
|
|
break;
|
|
case AMSG_STOP:
|
|
hdl->pstate = PSTATE_INIT;
|
|
break;
|
|
default:
|
|
DPRINTF("sio_aucat_runmsg: unhandled message %u\n", hdl->aucat.rmsg.cmd);
|
|
hdl->sio.eof = 1;
|
|
return 0;
|
|
}
|
|
hdl->aucat.rstate = RSTATE_MSG;
|
|
hdl->aucat.rtodo = sizeof(struct amsg);
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_buildmsg(struct sio_aucat_hdl *hdl)
|
|
{
|
|
if (hdl->curvol != hdl->reqvol) {
|
|
hdl->aucat.wstate = WSTATE_MSG;
|
|
hdl->aucat.wtodo = sizeof(struct amsg);
|
|
hdl->aucat.wmsg.cmd = htonl(AMSG_SETVOL);
|
|
hdl->aucat.wmsg.u.vol.ctl = htonl(hdl->reqvol);
|
|
hdl->curvol = hdl->reqvol;
|
|
return aucat_wmsg(&hdl->aucat, &hdl->sio.eof);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
struct sio_hdl *
|
|
sio_aucat_open(const char *str, unsigned int mode, int nbio)
|
|
{
|
|
struct sio_aucat_hdl *hdl;
|
|
|
|
hdl = malloc(sizeof(struct sio_aucat_hdl));
|
|
if (hdl == NULL)
|
|
return NULL;
|
|
if (!aucat_open(&hdl->aucat, str, mode, 0)) {
|
|
free(hdl);
|
|
return NULL;
|
|
}
|
|
sio_create(&hdl->sio, &sio_aucat_ops, mode, nbio);
|
|
hdl->curvol = SIO_MAXVOL;
|
|
hdl->reqvol = SIO_MAXVOL;
|
|
hdl->pstate = PSTATE_INIT;
|
|
hdl->round = 0xdeadbeef;
|
|
hdl->walign = 0xdeadbeef;
|
|
return (struct sio_hdl *)hdl;
|
|
}
|
|
|
|
static void
|
|
sio_aucat_close(struct sio_hdl *sh)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
if (!hdl->sio.eof && hdl->sio.started)
|
|
(void)sio_aucat_stop(&hdl->sio);
|
|
aucat_close(&hdl->aucat, hdl->sio.eof);
|
|
free(hdl);
|
|
}
|
|
|
|
static int
|
|
sio_aucat_start(struct sio_hdl *sh)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
struct sio_par par;
|
|
|
|
/*
|
|
* save bpf
|
|
*/
|
|
if (!sio_getpar(&hdl->sio, &par))
|
|
return 0;
|
|
hdl->wbpf = par.bps * par.pchan;
|
|
hdl->rbpf = par.bps * par.rchan;
|
|
hdl->aucat.maxwrite = 0;
|
|
hdl->round = par.round;
|
|
hdl->delta = 0;
|
|
DPRINTF("aucat: start, maxwrite = %d\n", hdl->aucat.maxwrite);
|
|
|
|
AMSG_INIT(&hdl->aucat.wmsg);
|
|
hdl->aucat.wmsg.cmd = htonl(AMSG_START);
|
|
hdl->aucat.wtodo = sizeof(struct amsg);
|
|
if (!aucat_wmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
hdl->aucat.rstate = RSTATE_MSG;
|
|
hdl->aucat.rtodo = sizeof(struct amsg);
|
|
if (!aucat_setfl(&hdl->aucat, 1, &hdl->sio.eof))
|
|
return 0;
|
|
hdl->walign = hdl->round * hdl->wbpf;
|
|
hdl->pstate = PSTATE_RUN;
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_stop(struct sio_hdl *sh)
|
|
{
|
|
#define ZERO_MAX 0x400
|
|
static unsigned char zero[ZERO_MAX];
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
unsigned int n, count;
|
|
|
|
if (!aucat_setfl(&hdl->aucat, 0, &hdl->sio.eof))
|
|
return 0;
|
|
/*
|
|
* complete message or data block in progress
|
|
*/
|
|
if (hdl->aucat.wstate == WSTATE_MSG) {
|
|
if (!aucat_wmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
}
|
|
if (hdl->aucat.wstate == WSTATE_DATA) {
|
|
hdl->aucat.maxwrite = hdl->aucat.wtodo;
|
|
while (hdl->aucat.wstate != WSTATE_IDLE) {
|
|
count = hdl->aucat.wtodo;
|
|
if (count > ZERO_MAX)
|
|
count = ZERO_MAX;
|
|
n = sio_aucat_write(&hdl->sio, zero, count);
|
|
if (n == 0)
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* send stop message
|
|
*/
|
|
AMSG_INIT(&hdl->aucat.wmsg);
|
|
hdl->aucat.wmsg.cmd = htonl(AMSG_STOP);
|
|
hdl->aucat.wtodo = sizeof(struct amsg);
|
|
if (!aucat_wmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
|
|
/*
|
|
* wait for the STOP ACK
|
|
*/
|
|
while (hdl->pstate != PSTATE_INIT) {
|
|
switch (hdl->aucat.rstate) {
|
|
case RSTATE_MSG:
|
|
if (!sio_aucat_runmsg(hdl))
|
|
return 0;
|
|
break;
|
|
case RSTATE_DATA:
|
|
if (!sio_aucat_read(&hdl->sio, zero, ZERO_MAX))
|
|
return 0;
|
|
break;
|
|
}
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_setpar(struct sio_hdl *sh, struct sio_par *par)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
AMSG_INIT(&hdl->aucat.wmsg);
|
|
hdl->aucat.wmsg.cmd = htonl(AMSG_SETPAR);
|
|
hdl->aucat.wmsg.u.par.bits = par->bits;
|
|
hdl->aucat.wmsg.u.par.bps = par->bps;
|
|
hdl->aucat.wmsg.u.par.sig = par->sig;
|
|
hdl->aucat.wmsg.u.par.le = par->le;
|
|
hdl->aucat.wmsg.u.par.msb = par->msb;
|
|
hdl->aucat.wmsg.u.par.rate = htonl(par->rate);
|
|
hdl->aucat.wmsg.u.par.appbufsz = htonl(par->appbufsz);
|
|
hdl->aucat.wmsg.u.par.xrun = par->xrun;
|
|
if (hdl->sio.mode & SIO_REC)
|
|
hdl->aucat.wmsg.u.par.rchan = htons(par->rchan);
|
|
if (hdl->sio.mode & SIO_PLAY)
|
|
hdl->aucat.wmsg.u.par.pchan = htons(par->pchan);
|
|
hdl->aucat.wtodo = sizeof(struct amsg);
|
|
if (!aucat_wmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_getpar(struct sio_hdl *sh, struct sio_par *par)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
AMSG_INIT(&hdl->aucat.wmsg);
|
|
hdl->aucat.wmsg.cmd = htonl(AMSG_GETPAR);
|
|
hdl->aucat.wtodo = sizeof(struct amsg);
|
|
if (!aucat_wmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
hdl->aucat.rtodo = sizeof(struct amsg);
|
|
if (!aucat_rmsg(&hdl->aucat, &hdl->sio.eof))
|
|
return 0;
|
|
if (ntohl(hdl->aucat.rmsg.cmd) != AMSG_GETPAR) {
|
|
DPRINTF("sio_aucat_getpar: protocol err\n");
|
|
hdl->sio.eof = 1;
|
|
return 0;
|
|
}
|
|
par->bits = hdl->aucat.rmsg.u.par.bits;
|
|
par->bps = hdl->aucat.rmsg.u.par.bps;
|
|
par->sig = hdl->aucat.rmsg.u.par.sig;
|
|
par->le = hdl->aucat.rmsg.u.par.le;
|
|
par->msb = hdl->aucat.rmsg.u.par.msb;
|
|
par->rate = ntohl(hdl->aucat.rmsg.u.par.rate);
|
|
par->bufsz = ntohl(hdl->aucat.rmsg.u.par.bufsz);
|
|
par->appbufsz = ntohl(hdl->aucat.rmsg.u.par.appbufsz);
|
|
par->xrun = hdl->aucat.rmsg.u.par.xrun;
|
|
par->round = ntohl(hdl->aucat.rmsg.u.par.round);
|
|
if (hdl->sio.mode & SIO_PLAY)
|
|
par->pchan = ntohs(hdl->aucat.rmsg.u.par.pchan);
|
|
if (hdl->sio.mode & SIO_REC)
|
|
par->rchan = ntohs(hdl->aucat.rmsg.u.par.rchan);
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_getcap(struct sio_hdl *sh, struct sio_cap *cap)
|
|
{
|
|
unsigned int i, bps, le, sig, chan, rindex, rmult;
|
|
static unsigned int rates[] = { 8000, 11025, 12000 };
|
|
|
|
bps = 1;
|
|
sig = le = 0;
|
|
cap->confs[0].enc = 0;
|
|
for (i = 0; i < SIO_NENC; i++) {
|
|
if (bps > 4)
|
|
break;
|
|
cap->confs[0].enc |= 1 << i;
|
|
cap->enc[i].bits = bps == 4 ? 24 : bps * 8;
|
|
cap->enc[i].bps = bps;
|
|
cap->enc[i].sig = sig ^ 1;
|
|
cap->enc[i].le = bps > 1 ? le : SIO_LE_NATIVE;
|
|
cap->enc[i].msb = 1;
|
|
le++;
|
|
if (le > 1 || bps == 1) {
|
|
le = 0;
|
|
sig++;
|
|
}
|
|
if (sig > 1 || (le == 0 && bps > 1)) {
|
|
sig = 0;
|
|
bps++;
|
|
}
|
|
}
|
|
chan = 1;
|
|
cap->confs[0].rchan = 0;
|
|
for (i = 0; i < SIO_NCHAN; i++) {
|
|
if (chan > 16)
|
|
break;
|
|
cap->confs[0].rchan |= 1 << i;
|
|
cap->rchan[i] = chan;
|
|
if (chan >= 12) {
|
|
chan += 4;
|
|
} else if (chan >= 2) {
|
|
chan += 2;
|
|
} else
|
|
chan++;
|
|
}
|
|
chan = 1;
|
|
cap->confs[0].pchan = 0;
|
|
for (i = 0; i < SIO_NCHAN; i++) {
|
|
if (chan > 16)
|
|
break;
|
|
cap->confs[0].pchan |= 1 << i;
|
|
cap->pchan[i] = chan;
|
|
if (chan >= 12) {
|
|
chan += 4;
|
|
} else if (chan >= 2) {
|
|
chan += 2;
|
|
} else
|
|
chan++;
|
|
}
|
|
rindex = 0;
|
|
rmult = 1;
|
|
cap->confs[0].rate = 0;
|
|
for (i = 0; i < SIO_NRATE; i++) {
|
|
if (rmult >= 32)
|
|
break;
|
|
cap->rate[i] = rates[rindex] * rmult;
|
|
cap->confs[0].rate |= 1 << i;
|
|
rindex++;
|
|
if (rindex == sizeof(rates) / sizeof(unsigned int)) {
|
|
rindex = 0;
|
|
rmult *= 2;
|
|
}
|
|
}
|
|
cap->nconf = 1;
|
|
return 1;
|
|
}
|
|
|
|
static size_t
|
|
sio_aucat_read(struct sio_hdl *sh, void *buf, size_t len)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
while (hdl->aucat.rstate == RSTATE_MSG) {
|
|
if (!sio_aucat_runmsg(hdl))
|
|
return 0;
|
|
}
|
|
return aucat_rdata(&hdl->aucat, buf, len, &hdl->sio.eof);
|
|
}
|
|
|
|
static size_t
|
|
sio_aucat_write(struct sio_hdl *sh, const void *buf, size_t len)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
size_t n;
|
|
|
|
while (hdl->aucat.wstate == WSTATE_IDLE) {
|
|
if (!sio_aucat_buildmsg(hdl))
|
|
break;
|
|
}
|
|
if (len <= 0 || hdl->aucat.maxwrite <= 0)
|
|
return 0;
|
|
if (len > hdl->aucat.maxwrite)
|
|
len = hdl->aucat.maxwrite;
|
|
if (len > hdl->walign)
|
|
len = hdl->walign;
|
|
n = aucat_wdata(&hdl->aucat, buf, len, hdl->wbpf, &hdl->sio.eof);
|
|
hdl->aucat.maxwrite -= n;
|
|
hdl->walign -= n;
|
|
if (hdl->walign == 0)
|
|
hdl->walign = hdl->round * hdl->wbpf;
|
|
return n;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_nfds(struct sio_hdl *hdl)
|
|
{
|
|
return 1;
|
|
}
|
|
|
|
static int
|
|
sio_aucat_pollfd(struct sio_hdl *sh, struct pollfd *pfd, int events)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
hdl->events = events;
|
|
if (hdl->aucat.maxwrite <= 0)
|
|
events &= ~POLLOUT;
|
|
return aucat_pollfd(&hdl->aucat, pfd, events);
|
|
}
|
|
|
|
static int
|
|
sio_aucat_revents(struct sio_hdl *sh, struct pollfd *pfd)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
int revents = pfd->revents;
|
|
|
|
if (revents & POLLIN) {
|
|
while (hdl->aucat.rstate == RSTATE_MSG) {
|
|
if (!sio_aucat_runmsg(hdl))
|
|
break;
|
|
}
|
|
if (hdl->aucat.rstate != RSTATE_DATA)
|
|
revents &= ~POLLIN;
|
|
}
|
|
if (revents & POLLOUT) {
|
|
if (hdl->aucat.maxwrite <= 0)
|
|
revents &= ~POLLOUT;
|
|
}
|
|
if (hdl->sio.eof)
|
|
return POLLHUP;
|
|
DPRINTFN(2, "sio_aucat_revents: %x\n", revents & hdl->events);
|
|
return revents & (hdl->events | POLLHUP);
|
|
}
|
|
|
|
static int
|
|
sio_aucat_setvol(struct sio_hdl *sh, unsigned int vol)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
hdl->reqvol = vol;
|
|
return 1;
|
|
}
|
|
|
|
static void
|
|
sio_aucat_getvol(struct sio_hdl *sh)
|
|
{
|
|
struct sio_aucat_hdl *hdl = (struct sio_aucat_hdl *)sh;
|
|
|
|
sio_onvol_cb(&hdl->sio, hdl->reqvol);
|
|
return;
|
|
}
|