Module Name: src
Committed By: skrll
Date: Mon Oct 6 06:59:20 UTC 2014
Modified Files:
src/sys/arch/arm/broadcom: bcm2835_vcaudio.c
Log Message:
Some improvements that make playback mostly reliable for me - the final
piece of the jigaw is probably in vchiq:
- prefill vchiq with a number (currently 2) blocks of audio before
starting
- use a kthread as workqueue isn't suited to our usage.
- don't drain on stopping as for some reason it leaves data behind.
To generate a diff of this commit:
cvs rdiff -u -r1.6 -r1.7 src/sys/arch/arm/broadcom/bcm2835_vcaudio.c
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Modified files:
Index: src/sys/arch/arm/broadcom/bcm2835_vcaudio.c
diff -u src/sys/arch/arm/broadcom/bcm2835_vcaudio.c:1.6 src/sys/arch/arm/broadcom/bcm2835_vcaudio.c:1.7
--- src/sys/arch/arm/broadcom/bcm2835_vcaudio.c:1.6 Tue Sep 2 21:46:35 2014
+++ src/sys/arch/arm/broadcom/bcm2835_vcaudio.c Mon Oct 6 06:59:20 2014
@@ -1,4 +1,4 @@
-/* $NetBSD: bcm2835_vcaudio.c,v 1.6 2014/09/02 21:46:35 jmcneill Exp $ */
+/* $NetBSD: bcm2835_vcaudio.c,v 1.7 2014/10/06 06:59:20 skrll Exp $ */
/*-
* Copyright (c) 2013 Jared D. McNeill <[email protected]>
@@ -31,7 +31,7 @@
*/
#include <sys/cdefs.h>
-__KERNEL_RCSID(0, "$NetBSD: bcm2835_vcaudio.c,v 1.6 2014/09/02 21:46:35 jmcneill Exp $");
+__KERNEL_RCSID(0, "$NetBSD: bcm2835_vcaudio.c,v 1.7 2014/10/06 06:59:20 skrll Exp $");
#include <sys/param.h>
#include <sys/types.h>
@@ -40,7 +40,6 @@ __KERNEL_RCSID(0, "$NetBSD: bcm2835_vcau
#include <sys/conf.h>
#include <sys/bus.h>
#include <sys/kmem.h>
-#include <sys/workqueue.h>
#include <sys/audioio.h>
#include <dev/audio_if.h>
@@ -68,16 +67,33 @@ enum vcaudio_dest {
VCAUDIO_DEST_HDMI = 2,
};
-struct vcaudio_work {
- struct work vw_wk;
-};
+
+/*
+ * Standard message size is 4000 bytes and VCHIQ can accept 16 messages.
+ *
+ * 4000 bytes of 16bit 48kHz stereo is approximately 21ms.
+ *
+ * We get complete messages at ~10ms intervals.
+ *
+ * Setting blocksize to 2 x 4000 means that we send approx 42ms of audio. We
+ * prefill by two blocks before starting audio meaning we have 83ms of latency.
+ */
+
+#define VCAUDIO_MSGSIZE 4000
+#define VCAUDIO_NUMMSGS 2
+#define VCAUDIO_BLOCKSIZE (VCAUDIO_MSGSIZE * VCAUDIO_NUMMSGS)
+#define VCAUDIO_BUFFERSIZE 128000
+#define VCAUDIO_PREFILLCOUNT 2
struct vcaudio_softc {
device_t sc_dev;
device_t sc_audiodev;
+ lwp_t *sc_lwp;
+
kmutex_t sc_lock;
kmutex_t sc_intr_lock;
+ kcondvar_t sc_datacv;
kmutex_t sc_msglock;
kcondvar_t sc_msgcv;
@@ -89,7 +105,9 @@ struct vcaudio_softc {
void *sc_pintarg;
audio_params_t sc_pparam;
bool sc_started;
- int sc_pbytes;
+ int sc_pblkcnt; // prefill block count
+ int sc_abytes; // available bytes
+ int sc_pbytes; // played bytes
off_t sc_ppos;
void *sc_pstart;
void *sc_pend;
@@ -104,9 +122,6 @@ struct vcaudio_softc {
short sc_peer_version;
- struct workqueue *sc_wq;
- struct vcaudio_work sc_work;
-
int sc_volume;
enum vcaudio_dest sc_dest;
};
@@ -118,18 +133,17 @@ static void vcaudio_childdet(device_t, d
static int vcaudio_init(struct vcaudio_softc *);
static void vcaudio_service_callback(void *,
- const VCHI_CALLBACK_REASON_T,
- void *);
-static int vcaudio_msg_sync(struct vcaudio_softc *, VC_AUDIO_MSG_T *, size_t);
-static void vcaudio_worker(struct work *, void *);
+ const VCHI_CALLBACK_REASON_T, void *);
+static int vcaudio_msg_sync(struct vcaudio_softc *, VC_AUDIO_MSG_T *,
+ size_t);
+static void vcaudio_worker(void *);
static int vcaudio_open(void *, int);
static void vcaudio_close(void *);
static int vcaudio_query_encoding(void *, struct audio_encoding *);
static int vcaudio_set_params(void *, int, int,
- audio_params_t *, audio_params_t *,
- stream_filter_list_t *,
- stream_filter_list_t *);
+ audio_params_t *, audio_params_t *,
+ stream_filter_list_t *, stream_filter_list_t *);
static int vcaudio_halt_output(void *);
static int vcaudio_halt_input(void *);
static int vcaudio_set_port(void *, mixer_ctrl_t *);
@@ -137,14 +151,16 @@ static int vcaudio_get_port(void *, mixe
static int vcaudio_query_devinfo(void *, mixer_devinfo_t *);
static int vcaudio_getdev(void *, struct audio_device *);
static int vcaudio_get_props(void *);
-static int vcaudio_round_blocksize(void *, int, int, const audio_params_t *);
+
+static int vcaudio_round_blocksize(void *, int, int,
+ const audio_params_t *);
static size_t vcaudio_round_buffersize(void *, int, size_t);
+
static int vcaudio_trigger_output(void *, void *, void *, int,
- void (*)(void *), void *,
- const audio_params_t *);
+ void (*)(void *), void *, const audio_params_t *);
static int vcaudio_trigger_input(void *, void *, void *, int,
- void (*)(void *), void *,
- const audio_params_t *);
+ void (*)(void *), void *, const audio_params_t *);
+
static void vcaudio_get_locks(void *, kmutex_t **, kmutex_t **);
static const struct audio_hw_if vcaudio_hw_if = {
@@ -167,7 +183,8 @@ static const struct audio_hw_if vcaudio_
};
CFATTACH_DECL2_NEW(vcaudio, sizeof(struct vcaudio_softc),
- vcaudio_match, vcaudio_attach, NULL, NULL, vcaudio_rescan, vcaudio_childdet);
+ vcaudio_match, vcaudio_attach, NULL, NULL, vcaudio_rescan,
+ vcaudio_childdet);
static int
vcaudio_match(device_t parent, cfdata_t match, void *aux)
@@ -187,19 +204,24 @@ vcaudio_attach(device_t parent, device_t
mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_NONE);
mutex_init(&sc->sc_msglock, MUTEX_DEFAULT, IPL_NONE);
- cv_init(&sc->sc_msgcv, "vcaudiocv");
+ cv_init(&sc->sc_msgcv, "msg");
+ cv_init(&sc->sc_datacv, "data");
sc->sc_success = -1;
- error = workqueue_create(&sc->sc_wq, "vcaudiowq", vcaudio_worker,
- sc, PRI_BIO, IPL_SCHED, WQ_MPSAFE);
+
+ error = kthread_create(PRI_BIO, KTHREAD_MPSAFE, NULL, vcaudio_worker,
+ sc, &sc->sc_lwp, "vcaudio");
if (error) {
- aprint_error(": couldn't create workqueue (%d)\n", error);
+ aprint_error(": couldn't create thread (%d)\n", error);
return;
}
aprint_naive("\n");
- aprint_normal(": AUDS\n");
+ aprint_normal(": auds\n");
+
+ error = vcaudio_rescan(self, NULL, NULL);
+ if (error)
+ aprint_error_dev(self, "not configured\n");
- vcaudio_rescan(self, NULL, NULL);
}
static int
@@ -210,8 +232,9 @@ vcaudio_rescan(device_t self, const char
if (ifattr_match(ifattr, "audiobus") && sc->sc_audiodev == NULL) {
error = vcaudio_init(sc);
- if (error)
+ if (error) {
return error;
+ }
sc->sc_audiodev = audio_attach_mi(&vcaudio_hw_if,
sc, sc->sc_dev);
@@ -256,15 +279,15 @@ vcaudio_init(struct vcaudio_softc *sc)
error = vchi_initialise(&sc->sc_instance);
if (error) {
- device_printf(sc->sc_dev, "couldn't init vchi instance (%d)\n",
- error);
+ aprint_error_dev(sc->sc_dev,
+ "couldn't init vchi instance (%d)\n", error);
return EIO;
}
error = vchi_connect(NULL, 0, sc->sc_instance);
if (error) {
- device_printf(sc->sc_dev, "couldn't connect vchi (%d)\n",
- error);
+ aprint_error_dev(sc->sc_dev,
+ "couldn't connect vchi (%d)\n", error);
return EIO;
}
@@ -283,7 +306,7 @@ vcaudio_init(struct vcaudio_softc *sc)
error = vchi_service_open(sc->sc_instance, &setup, &sc->sc_service);
if (error) {
- device_printf(sc->sc_dev, "couldn't open service (%d)\n",
+ aprint_error_dev(sc->sc_dev, "couldn't open service (%d)\n",
error);
return EIO;
}
@@ -302,8 +325,8 @@ vcaudio_init(struct vcaudio_softc *sc)
error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
if (error) {
- device_printf(sc->sc_dev, "couldn't send OPEN message (%d)\n",
- error);
+ aprint_error_dev(sc->sc_dev,
+ "couldn't send OPEN message (%d)\n", error);
}
memset(&msg, 0, sizeof(msg));
@@ -313,8 +336,8 @@ vcaudio_init(struct vcaudio_softc *sc)
msg.u.config.bps = 16;
error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
if (error) {
- device_printf(sc->sc_dev, "couldn't send CONFIG message (%d)\n",
- error);
+ aprint_error_dev(sc->sc_dev,
+ "couldn't send CONFIG message (%d)\n", error);
}
memset(&msg, 0, sizeof(msg));
@@ -323,8 +346,10 @@ vcaudio_init(struct vcaudio_softc *sc)
msg.u.control.dest = VCAUDIO_DEST_AUTO;
error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
if (error) {
- device_printf(sc->sc_dev, "couldn't send CONTROL message (%d)\n", error);
+ aprint_error_dev(sc->sc_dev,
+ "couldn't send CONTROL message (%d)\n", error);
}
+
vchi_service_release(sc->sc_service);
return 0;
@@ -361,14 +386,17 @@ vcaudio_service_callback(void *priv, con
cv_broadcast(&sc->sc_msgcv);
mutex_exit(&sc->sc_msglock);
break;
+
case VC_AUDIO_MSG_TYPE_COMPLETE:
intr = msg.u.complete.callback;
intrarg = msg.u.complete.cookie;
if (intr && intrarg) {
int count = msg.u.complete.count & 0xffff;
- int perr = (msg.u.complete.count & 0x40000000) != 0;
+ int perr = (msg.u.complete.count & __BIT(30)) != 0;
bool sched = false;
+
mutex_enter(&sc->sc_intr_lock);
+
if (count > 0) {
sc->sc_pbytes += count;
}
@@ -385,7 +413,8 @@ vcaudio_service_callback(void *priv, con
if (sched) {
intr(intrarg);
- workqueue_enqueue(sc->sc_wq, (struct work *)&sc->sc_work, NULL);
+ sc->sc_abytes += sc->sc_pblksize;
+ cv_signal(&sc->sc_datacv);
}
mutex_exit(&sc->sc_intr_lock);
}
@@ -396,7 +425,7 @@ vcaudio_service_callback(void *priv, con
}
static void
-vcaudio_worker(struct work *wk, void *priv)
+vcaudio_worker(void *priv)
{
struct vcaudio_softc *sc = priv;
VC_AUDIO_MSG_T msg;
@@ -406,77 +435,92 @@ vcaudio_worker(struct work *wk, void *pr
int error, resid, off, nb, count;
mutex_enter(&sc->sc_intr_lock);
- intr = sc->sc_pint;
- intrarg = sc->sc_pintarg;
-
- if (intr == NULL || intrarg == NULL) {
- mutex_exit(&sc->sc_intr_lock);
- return;
- }
- vchi_service_use(sc->sc_service);
-
- if (sc->sc_started == false) {
-#ifdef VCAUDIO_DEBUG
- device_printf(sc->sc_dev, "starting output\n");
-#endif
-
- memset(&msg, 0, sizeof(msg));
- msg.type = VC_AUDIO_MSG_TYPE_START;
- error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
- VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
- if (error) {
- printf("%s: failed to start (%d)\n", __func__, error);
- goto done;
+ while (true) {
+ intr = sc->sc_pint;
+ intrarg = sc->sc_pintarg;
+
+ if (intr == NULL || intrarg == NULL) {
+ cv_wait_sig(&sc->sc_datacv, &sc->sc_intr_lock);
+ continue;
}
- sc->sc_started = true;
- sc->sc_pbytes = 0;
- sc->sc_ppos = 0;
+ KASSERT(sc->sc_pblksize != 0);
- count = sc->sc_pblksize * 2;
- } else {
+ if (sc->sc_abytes < sc->sc_pblksize) {
+ cv_wait_sig(&sc->sc_datacv, &sc->sc_intr_lock);
+ continue;
+ }
count = sc->sc_pblksize;
- }
- memset(&msg, 0, sizeof(msg));
- msg.type = VC_AUDIO_MSG_TYPE_WRITE;
- msg.u.write.max_packet = 4000;
- msg.u.write.count = count;
- msg.u.write.callback = intr;
- msg.u.write.cookie = intrarg;
- msg.u.write.silence = 0;
+ memset(&msg, 0, sizeof(msg));
+ msg.type = VC_AUDIO_MSG_TYPE_WRITE;
+ msg.u.write.max_packet = VCAUDIO_MSGSIZE;
+ msg.u.write.count = count;
+ msg.u.write.callback = intr;
+ msg.u.write.cookie = intrarg;
+ msg.u.write.silence = 0;
+
+ block = (uint8_t *)sc->sc_pstart + sc->sc_ppos;
+ resid = count;
+ off = 0;
- error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
- VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
- if (error) {
- printf("%s: failed to write (%d)\n", __func__, error);
- goto done;
- }
+ vchi_service_use(sc->sc_service);
- block = (uint8_t *)sc->sc_pstart + sc->sc_ppos;
- resid = count;
- off = 0;
- while (resid > 0) {
- nb = min(resid, msg.u.write.max_packet);
- error = vchi_msg_queue(sc->sc_service,
- (char *)block + off, nb,
+ error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
if (error) {
- printf("%s: failed to queue data (%d)\n", __func__, error);
+ printf("%s: failed to write (%d)\n", __func__, error);
goto done;
}
- off += nb;
- resid -= nb;
- }
- sc->sc_ppos += count;
- if ((uint8_t *)sc->sc_pstart + sc->sc_ppos >= (uint8_t *)sc->sc_pend)
- sc->sc_ppos = 0;
+ while (resid > 0) {
+ nb = min(resid, msg.u.write.max_packet);
+ error = vchi_msg_queue(sc->sc_service,
+ (char *)block + off, nb,
+ VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
+ if (error) {
+ /* XXX What to do here? */
+ device_printf(sc->sc_dev,
+ "failed to queue data (%d)\n", error);
+ goto done;
+ }
+ off += nb;
+ resid -= nb;
+ }
+
+ sc->sc_abytes -= count;
+ sc->sc_ppos += count;
+ if ((uint8_t *)sc->sc_pstart + sc->sc_ppos >=
+ (uint8_t *)sc->sc_pend)
+ sc->sc_ppos = 0;
+
+ if (!sc->sc_started) {
+ ++sc->sc_pblkcnt;
+
+ if (sc->sc_pblkcnt == VCAUDIO_PREFILLCOUNT) {
+
+ memset(&msg, 0, sizeof(msg));
+ msg.type = VC_AUDIO_MSG_TYPE_START;
+ error = vchi_msg_queue(sc->sc_service, &msg,
+ sizeof(msg), VCHI_FLAGS_BLOCK_UNTIL_QUEUED,
+ NULL);
+ if (error) {
+ device_printf(sc->sc_dev,
+ "failed to start (%d)\n", error);
+ goto done;
+ }
+ sc->sc_started = true;
+ sc->sc_pbytes = 0;
+ } else {
+ intr(intrarg);
+ sc->sc_abytes += sc->sc_pblksize;
+ }
+ }
done:
- mutex_exit(&sc->sc_intr_lock);
- vchi_service_release(sc->sc_service);
+ vchi_service_release(sc->sc_service);
+ }
}
static int
@@ -553,10 +597,12 @@ vcaudio_halt_output(void *priv)
VC_AUDIO_MSG_T msg;
int error = 0;
+ KASSERT(mutex_owned(&sc->sc_intr_lock));
+
vchi_service_use(sc->sc_service);
memset(&msg, 0, sizeof(msg));
msg.type = VC_AUDIO_MSG_TYPE_STOP;
- msg.u.stop.draining = 1;
+ msg.u.stop.draining = 0;
error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
if (error) {
@@ -593,15 +639,20 @@ vcaudio_set_port(void *priv, mixer_ctrl_
case VCAUDIO_OUTPUT_MASTER_VOLUME:
case VCAUDIO_INPUT_DAC_VOLUME:
sc->sc_volume = mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
+
+ vchi_service_use(sc->sc_service);
+
memset(&msg, 0, sizeof(msg));
msg.type = VC_AUDIO_MSG_TYPE_CONTROL;
msg.u.control.volume = vol2pct(sc->sc_volume);
msg.u.control.dest = VCAUDIO_DEST_AUTO;
- vchi_service_use(sc->sc_service);
+
error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
if (error) {
- device_printf(sc->sc_dev, "couldn't send CONTROL message (%d)\n", error);
+ device_printf(sc->sc_dev,
+ "couldn't send CONTROL message (%d)\n", error);
}
+
vchi_service_release(sc->sc_service);
return error;
@@ -667,7 +718,7 @@ vcaudio_getdev(void *priv, struct audio_
{
struct vcaudio_softc *sc = priv;
- snprintf(audiodev->name, sizeof(audiodev->name), "VCHIQ AUDS");
+ snprintf(audiodev->name, sizeof(audiodev->name), "vchiq auds");
snprintf(audiodev->version, sizeof(audiodev->version),
"%d", sc->sc_peer_version);
snprintf(audiodev->config, sizeof(audiodev->config), "vcaudio");
@@ -685,19 +736,14 @@ static int
vcaudio_round_blocksize(void *priv, int bs, int mode,
const audio_params_t *params)
{
- return PAGE_SIZE;
+ return VCAUDIO_BLOCKSIZE;
}
static size_t
vcaudio_round_buffersize(void *priv, int direction, size_t bufsize)
{
- size_t sz;
-
- sz = (bufsize + 0x3ff) & ~0x3ff;
- if (sz > 32768)
- sz = 32768;
- return sz;
+ return VCAUDIO_BUFFERSIZE;
}
static int
@@ -706,6 +752,9 @@ vcaudio_trigger_output(void *priv, void
{
struct vcaudio_softc *sc = priv;
+ ASSERT_SLEEPABLE();
+ KASSERT(mutex_owned(&sc->sc_intr_lock));
+
sc->sc_pparam = *params;
sc->sc_pint = intr;
sc->sc_pintarg = intrarg;
@@ -713,7 +762,11 @@ vcaudio_trigger_output(void *priv, void
sc->sc_pstart = start;
sc->sc_pend = end;
sc->sc_pblksize = blksize;
- workqueue_enqueue(sc->sc_wq, (struct work *)&sc->sc_work, NULL);
+ sc->sc_pblkcnt = 0;
+ sc->sc_pbytes = 0;
+ sc->sc_abytes = blksize;
+
+ cv_signal(&sc->sc_datacv);
return 0;
}
