/* channel interface for ESS18xx */
static void *
bcmchan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b, struct pcm_channel *c, int dir)
{
struct bcm2835_audio_info *sc = devinfo;
struct bcm2835_audio_chinfo *ch = &sc->pch;
void *buffer;
if (dir == PCMDIR_REC)
return NULL;
ch->parent = sc;
ch->channel = c;
ch->buffer = b;
/* default values */
ch->spd = 44100;
ch->fmt = SND_FORMAT(AFMT_S16_LE, 2, 0);
ch->blksz = VCHIQ_AUDIO_PACKET_SIZE;
buffer = malloc(sc->bufsz, M_DEVBUF, M_WAITOK | M_ZERO);
if (sndbuf_setup(ch->buffer, buffer, sc->bufsz) != 0) {
free(buffer, M_DEVBUF);
return NULL;
}
bcm2835_audio_update_params(sc, ch);
return ch;
}
static uint32_t
bcmchan_setspeed(kobj_t obj, void *data, uint32_t speed)
{
struct bcm2835_audio_chinfo *ch = data;
struct bcm2835_audio_info *sc = ch->parent;
bcm2835_audio_lock(sc);
ch->spd = speed;
bcm2835_audio_update_params(sc, ch);
bcm2835_audio_unlock(sc);
return ch->spd;
}
static int
bcmchan_setformat(kobj_t obj, void *data, uint32_t format)
{
struct bcm2835_audio_chinfo *ch = data;
struct bcm2835_audio_info *sc = ch->parent;
bcm2835_audio_lock(sc);
ch->fmt = format;
bcm2835_audio_update_params(sc, ch);
bcm2835_audio_unlock(sc);
return 0;
}
static void
bcm2835_audio_worker(void *data)
{
struct bcm2835_audio_info *sc = (struct bcm2835_audio_info *)data;
struct bcm2835_audio_chinfo *ch = &sc->pch;
uint32_t speed, format;
uint32_t volume, dest;
uint32_t flags;
uint32_t count, size, readyptr;
uint8_t *buf;
ch->playback_state = PLAYBACK_IDLE;
while (1) {
if (sc->worker_state != WORKER_RUNNING)
break;
BCM2835_AUDIO_LOCK(sc);
/*
* wait until there are flags set or buffer is ready
* to consume more samples
*/
while ((sc->flags_pending == 0) &&
bcm2835_audio_buffer_should_sleep(ch)) {
cv_wait_sig(&sc->worker_cv, &sc->lock);
}
flags = sc->flags_pending;
/* Clear pending flags */
sc->flags_pending = 0;
BCM2835_AUDIO_UNLOCK(sc);
/* Requested to change parameters */
if (flags & AUDIO_PARAMS) {
BCM2835_AUDIO_LOCK(sc);
speed = ch->spd;
format = ch->fmt;
volume = sc->volume;
dest = sc->dest;
BCM2835_AUDIO_UNLOCK(sc);
if (ch->playback_state == PLAYBACK_IDLE)
bcm2835_audio_update_params(sc, format, speed);
bcm2835_audio_update_controls(sc, volume, dest);
}
/* Requested to stop playback */
if ((flags & AUDIO_STOP) &&
(ch->playback_state == PLAYBACK_PLAYING)) {
bcm2835_audio_stop(ch);
BCM2835_AUDIO_LOCK(sc);
bcm2835_audio_reset_channel(&sc->pch);
ch->playback_state = PLAYBACK_IDLE;
BCM2835_AUDIO_UNLOCK(sc);
continue;
}
/* Requested to start playback */
if ((flags & AUDIO_PLAY) &&
(ch->playback_state == PLAYBACK_IDLE)) {
BCM2835_AUDIO_LOCK(sc);
ch->playback_state = PLAYBACK_PLAYING;
BCM2835_AUDIO_UNLOCK(sc);
bcm2835_audio_start(ch);
}
if (ch->playback_state == PLAYBACK_IDLE)
continue;
if (sndbuf_getready(ch->buffer) == 0)
continue;
count = sndbuf_getready(ch->buffer);
size = sndbuf_getsize(ch->buffer);
readyptr = sndbuf_getreadyptr(ch->buffer);
BCM2835_AUDIO_LOCK(sc);
if (readyptr + count > size)
count = size - readyptr;
count = min(count, ch->available_space);
count -= (count % VCHIQ_AUDIO_PACKET_SIZE);
BCM2835_AUDIO_UNLOCK(sc);
if (count < VCHIQ_AUDIO_PACKET_SIZE)
continue;
buf = (uint8_t*)sndbuf_getbuf(ch->buffer) + readyptr;
bcm2835_audio_write_samples(ch, buf, count);
BCM2835_AUDIO_LOCK(sc);
ch->unsubmittedptr = (ch->unsubmittedptr + count) % sndbuf_getsize(ch->buffer);
ch->available_space -= count;
ch->submitted_samples += count;
KASSERT(ch->available_space >= 0, ("ch->available_space == %d\n", ch->available_space));
BCM2835_AUDIO_UNLOCK(sc);
}
BCM2835_AUDIO_LOCK(sc);
sc->worker_state = WORKER_STOPPED;
cv_signal(&sc->worker_cv);
BCM2835_AUDIO_UNLOCK(sc);
kproc_exit(0);
}
