root/sys/arch/arm/broadcom/bcm2835_vcaudio.c
/* $NetBSD: bcm2835_vcaudio.c,v 1.22 2026/06/21 10:28:07 andvar Exp $ */

/*-
 * Copyright (c) 2013 Jared D. McNeill <jmcneill@invisible.ca>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * VideoCore audio interface
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: bcm2835_vcaudio.c,v 1.22 2026/06/21 10:28:07 andvar Exp $");

#include <sys/param.h>
#include <sys/types.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/conf.h>
#include <sys/bus.h>
#include <sys/kmem.h>

#include <sys/audioio.h>
#include <dev/audio/audio_if.h>

#include <interface/compat/vchi_bsd.h>
#include <interface/vchiq_arm/vchiq_netbsd.h>
#include <interface/vchi/vchi.h>

#include "bcm2835_vcaudioreg.h"

/* levels with 5% volume step */
static int vcaudio_levels[] = {
        -10239, -4605, -3794, -3218, -2772,
        -2407, -2099, -1832, -1597, -1386,
        -1195, -1021, -861, -713, -575,
        -446, -325, -210, -102, 0,
};

#define vol2db(vol)     vcaudio_levels[((vol) * 20) >> 8]
#define vol2vc(vol)     ((uint32_t)(-(vol2db((vol)) << 8) / 100))

enum {
        VCAUDIO_OUTPUT_CLASS,
        VCAUDIO_INPUT_CLASS,
        VCAUDIO_OUTPUT_MASTER_VOLUME,
        VCAUDIO_INPUT_DAC_VOLUME,
        VCAUDIO_OUTPUT_AUTO_VOLUME,
        VCAUDIO_OUTPUT_HEADPHONE_VOLUME,
        VCAUDIO_OUTPUT_HDMI_VOLUME,
        VCAUDIO_OUTPUT_SELECT,
        VCAUDIO_ENUM_LAST,
};

enum vcaudio_dest {
        VCAUDIO_DEST_AUTO = 0,
        VCAUDIO_DEST_HP = 1,
        VCAUDIO_DEST_HDMI = 2,
};

/*
 * Maximum 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 4 x 1600 means that we send approx 33ms of audio. We
 * prefill by two blocks before starting audio meaning we have 50ms of latency.
 *
 * Six messages of 1600 bytes was chosen working back from a desired latency of
 * 50ms.
 */

/* 40ms block of 16bit 48kHz stereo is 7680 bytes. */
#define VCAUDIO_MSGSIZE         1920
#define VCAUDIO_NUMMSGS         4
#define VCAUDIO_BLOCKSIZE       (VCAUDIO_MSGSIZE * VCAUDIO_NUMMSGS)
/* The driver seems to have no buffer size restrictions. */
#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;

        struct audio_format             sc_format;

        void                            (*sc_pint)(void *);
        void                            *sc_pintarg;
        audio_params_t                  sc_pparam;
        bool                            sc_started;
        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;
        int                             sc_pblksize;

        bool                            sc_msgdone;
        int                             sc_success;

        VCHI_INSTANCE_T                 sc_instance;
        VCHI_CONNECTION_T               sc_connection;
        VCHI_SERVICE_HANDLE_T           sc_service;

        short                           sc_peer_version;

        int                             sc_hwvol[3];
        enum vcaudio_dest               sc_dest;

        uint8_t                         sc_swvol;
};

static int      vcaudio_match(device_t, cfdata_t, void *);
static void     vcaudio_attach(device_t, device_t, void *);
static int      vcaudio_rescan(device_t, const char *, const int *);
static void     vcaudio_childdet(device_t, device_t);

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(void *);

static int      vcaudio_query_format(void *, audio_format_query_t *);
static int      vcaudio_set_format(void *, int,
    const audio_params_t *, const audio_params_t *,
    audio_filter_reg_t *, audio_filter_reg_t *);
static int      vcaudio_halt_output(void *);
static int      vcaudio_set_port(void *, mixer_ctrl_t *);
static int      vcaudio_get_port(void *, mixer_ctrl_t *);
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_trigger_output(void *, void *, void *, int,
    void (*)(void *), void *, const audio_params_t *);

static void     vcaudio_get_locks(void *, kmutex_t **, kmutex_t **);

static void vcaudio_swvol_codec(audio_filter_arg_t *);

static const struct audio_hw_if vcaudio_hw_if = {
        .query_format = vcaudio_query_format,
        .set_format = vcaudio_set_format,
        .halt_output = vcaudio_halt_output,
        .getdev = vcaudio_getdev,
        .set_port = vcaudio_set_port,
        .get_port = vcaudio_get_port,
        .query_devinfo = vcaudio_query_devinfo,
        .get_props = vcaudio_get_props,
        .round_blocksize = vcaudio_round_blocksize,
        .trigger_output = vcaudio_trigger_output,
        .get_locks = vcaudio_get_locks,
};

CFATTACH_DECL2_NEW(vcaudio, sizeof(struct vcaudio_softc),
    vcaudio_match, vcaudio_attach, NULL, NULL, vcaudio_rescan,
    vcaudio_childdet);

static int
vcaudio_match(device_t parent, cfdata_t match, void *aux)
{
        struct vchiq_attach_args *vaa = aux;

        return !strcmp(vaa->vaa_name, "AUDS");
}

static void
vcaudio_attach(device_t parent, device_t self, void *aux)
{
        struct vcaudio_softc *sc = device_private(self);
        int error;

        sc->sc_dev = self;
        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, "msg");
        cv_init(&sc->sc_datacv, "data");
        sc->sc_success = -1;

        error = kthread_create(PRI_BIO, KTHREAD_MPSAFE, NULL, vcaudio_worker,
            sc, &sc->sc_lwp, "vcaudio");
        if (error) {
                aprint_error(": couldn't create thread (%d)\n", error);
                return;
        }

        aprint_naive("\n");
        aprint_normal(": auds\n");

        error = vcaudio_rescan(self, NULL, NULL);
        if (error)
                aprint_error_dev(self, "not configured\n");

}

static int
vcaudio_rescan(device_t self, const char *ifattr, const int *locs)
{
        struct vcaudio_softc *sc = device_private(self);
        int error;

        if (sc->sc_audiodev == NULL) {
                error = vcaudio_init(sc);
                if (error) {
                        return error;
                }

                sc->sc_audiodev = audio_attach_mi(&vcaudio_hw_if,
                    sc, sc->sc_dev);
        }
        return 0;
}

static void
vcaudio_childdet(device_t self, device_t child)
{
        struct vcaudio_softc *sc = device_private(self);

        if (sc->sc_audiodev == child)
                sc->sc_audiodev = NULL;
}

static int
vcaudio_init(struct vcaudio_softc *sc)
{
        VC_AUDIO_MSG_T msg;
        int error;

        sc->sc_swvol = 255;
        sc->sc_hwvol[VCAUDIO_DEST_AUTO] = 255;
        sc->sc_hwvol[VCAUDIO_DEST_HP] = 255;
        sc->sc_hwvol[VCAUDIO_DEST_HDMI] = 255;
        sc->sc_dest = VCAUDIO_DEST_AUTO;

        sc->sc_format.mode = AUMODE_PLAY;
        sc->sc_format.encoding = AUDIO_ENCODING_SLINEAR_LE;
        sc->sc_format.validbits = 16;
        sc->sc_format.precision = 16;
        sc->sc_format.channels = 2;
        sc->sc_format.channel_mask = AUFMT_STEREO;
        sc->sc_format.frequency_type = 0;
        sc->sc_format.frequency[0] = 48000;
        sc->sc_format.frequency[1] = 48000;

        error = vchi_initialise(&sc->sc_instance);
        if (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) {
                aprint_error_dev(sc->sc_dev,
                    "couldn't connect vchi (%d)\n", error);
                return EIO;
        }

        SERVICE_CREATION_T setup = {
                .version = VCHI_VERSION(VC_AUDIOSERV_VER),
                .service_id = VC_AUDIO_SERVER_NAME,
                .connection = &sc->sc_connection,
                .rx_fifo_size = 0,
                .tx_fifo_size = 0,
                .callback = vcaudio_service_callback,
                .callback_param = sc,
                .want_unaligned_bulk_rx = 1,
                .want_unaligned_bulk_tx = 1,
                .want_crc = 0,
        };

        error = vchi_service_open(sc->sc_instance, &setup, &sc->sc_service);
        if (error) {
                aprint_error_dev(sc->sc_dev, "couldn't open service (%d)\n",
                    error);
                return EIO;
        }

        vchi_get_peer_version(sc->sc_service, &sc->sc_peer_version);

        if (sc->sc_peer_version < 2) {
                aprint_error_dev(sc->sc_dev,
                    "peer version (%d) is less than the required version (2)\n",
                    sc->sc_peer_version);
                return EINVAL;
        }

        memset(&msg, 0, sizeof(msg));
        msg.type = htole32(VC_AUDIO_MSG_TYPE_OPEN);
        error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
            VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
        if (error) {
                aprint_error_dev(sc->sc_dev,
                    "couldn't send OPEN message (%d)\n", error);
        }

        memset(&msg, 0, sizeof(msg));
        msg.type = htole32(VC_AUDIO_MSG_TYPE_CONFIG);
        msg.u.config.channels = htole32(2);
        msg.u.config.samplerate = htole32(48000);
        msg.u.config.bps = htole32(16);
        error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
        if (error) {
                aprint_error_dev(sc->sc_dev,
                    "couldn't send CONFIG message (%d)\n", error);
        }

        memset(&msg, 0, sizeof(msg));
        msg.type = htole32(VC_AUDIO_MSG_TYPE_CONTROL);
        msg.u.control.volume = htole32(vol2vc(sc->sc_hwvol[sc->sc_dest]));
        msg.u.control.dest = htole32(sc->sc_dest);
        error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
        if (error) {
                aprint_error_dev(sc->sc_dev,
                    "couldn't send CONTROL message (%d)\n", error);
        }

        vchi_service_release(sc->sc_service);

        return 0;
}

static void
vcaudio_service_callback(void *priv, const VCHI_CALLBACK_REASON_T reason,
    void *msg_handle)
{
        struct vcaudio_softc *sc = priv;
        VC_AUDIO_MSG_T msg;
        int32_t msglen = 0;
        int error;

        if (sc == NULL || reason != VCHI_CALLBACK_MSG_AVAILABLE)
                return;

        memset(&msg, 0, sizeof(msg));
        error = vchi_msg_dequeue(sc->sc_service, &msg, sizeof(msg), &msglen,
            VCHI_FLAGS_NONE);
        if (error) {
                device_printf(sc->sc_dev, "couldn't dequeue msg (%d)\n",
                    error);
                return;
        }

        switch (le32toh(msg.type)) {
        case VC_AUDIO_MSG_TYPE_RESULT:
                mutex_enter(&sc->sc_msglock);
                sc->sc_success = le32toh(msg.u.result.success);
                sc->sc_msgdone = true;
                cv_broadcast(&sc->sc_msgcv);
                mutex_exit(&sc->sc_msglock);
                break;

        case VC_AUDIO_MSG_TYPE_COMPLETE:
                if (le32toh(msg.u.complete.cookie1) == VC_AUDIO_WRITE_COOKIE1 &&
                    le32toh(msg.u.complete.cookie2) == VC_AUDIO_WRITE_COOKIE2) {
                        int count = le32toh(msg.u.complete.count) & 0xffff;
                        int perr = (le32toh(msg.u.complete.count) & __BIT(30)) != 0;
                        bool sched = false;

                        mutex_enter(&sc->sc_intr_lock);

                        if (count > 0) {
                                sc->sc_pbytes += count;
                        }
                        if (perr && sc->sc_started) {
#ifdef VCAUDIO_DEBUG
                                device_printf(sc->sc_dev, "underrun\n");
#endif
                                sched = true;
                        }
                        if (sc->sc_pbytes >= sc->sc_pblksize) {
                                sc->sc_pbytes -= sc->sc_pblksize;
                                sched = true;
                        }

                        if (sched && sc->sc_pint) {
                                sc->sc_pint(sc->sc_pintarg);
                                sc->sc_abytes += sc->sc_pblksize;
                                cv_signal(&sc->sc_datacv);
                        }
                        mutex_exit(&sc->sc_intr_lock);
                }
                break;
        default:
                break;
        }
}

static void
vcaudio_worker(void *priv)
{
        struct vcaudio_softc *sc = priv;
        VC_AUDIO_MSG_T msg;
        void (*intr)(void *);
        void *intrarg;
        void *block;
        int error, resid, off, nb, count;

        mutex_enter(&sc->sc_intr_lock);

        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;
                }

                KASSERT(sc->sc_pblksize != 0);

                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 = htole32(VC_AUDIO_MSG_TYPE_WRITE);
                msg.u.write.max_packet = htole16(VCAUDIO_MSGSIZE);
                msg.u.write.count = htole32(count);
                msg.u.write.cookie1 = htole32(VC_AUDIO_WRITE_COOKIE1);
                msg.u.write.cookie2 = htole32(VC_AUDIO_WRITE_COOKIE2);
                msg.u.write.silence = htole16(0);

                block = (uint8_t *)sc->sc_pstart + sc->sc_ppos;
                resid = count;
                off = 0;

                vchi_service_use(sc->sc_service);

                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;
                }

                while (resid > 0) {
                        nb = uimin(resid, le16toh(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 = htole32(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:
                vchi_service_release(sc->sc_service);
        }
}

static int
vcaudio_msg_sync(struct vcaudio_softc *sc, VC_AUDIO_MSG_T *msg, size_t msglen)
{
        int error = 0;

        mutex_enter(&sc->sc_msglock);

        sc->sc_success = -1;
        sc->sc_msgdone = false;

        error = vchi_msg_queue(sc->sc_service, msg, msglen,
            VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
        if (error) {
                printf("%s: failed to queue message (%d)\n", __func__, error);
                goto done;
        }

        while (!sc->sc_msgdone) {
                error = cv_wait_sig(&sc->sc_msgcv, &sc->sc_msglock);
                if (error)
                        break;
        }
        if (sc->sc_success != 0)
                error = EIO;
done:
        mutex_exit(&sc->sc_msglock);

        return error;
}

static int
vcaudio_query_format(void *priv, audio_format_query_t *afp)
{
        struct vcaudio_softc *sc = priv;

        return audio_query_format(&sc->sc_format, 1, afp);
}

static int
vcaudio_set_format(void *priv, int setmode,
    const audio_params_t *play, const audio_params_t *rec,
    audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
{
        struct vcaudio_softc *sc = priv;

        pfil->codec = vcaudio_swvol_codec;
        pfil->context = sc;

        return 0;
}

static int
vcaudio_halt_output(void *priv)
{
        struct vcaudio_softc *sc = 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 = htole32(VC_AUDIO_MSG_TYPE_STOP);
        msg.u.stop.draining = htole32(0);
        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 STOP message (%d)\n",
                    error);
        }
        vchi_service_release(sc->sc_service);

        sc->sc_pint = NULL;
        sc->sc_pintarg = NULL;
        sc->sc_started = false;

#ifdef VCAUDIO_DEBUG
        device_printf(sc->sc_dev, "halting output\n");
#endif

        return error;
}

static int
vcaudio_set_volume(struct vcaudio_softc *sc, enum vcaudio_dest dest,
    int hwvol)
{
        VC_AUDIO_MSG_T msg;
        int error;

        sc->sc_hwvol[dest] = hwvol;
        if (dest != sc->sc_dest)
                return 0;

        vchi_service_use(sc->sc_service);

        memset(&msg, 0, sizeof(msg));
        msg.type = htole32(VC_AUDIO_MSG_TYPE_CONTROL);
        msg.u.control.volume = htole32(vol2vc(hwvol));
        msg.u.control.dest = htole32(dest);

        error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
        if (error) {
                device_printf(sc->sc_dev,
                    "couldn't send CONTROL message (%d)\n", error);
        }

        vchi_service_release(sc->sc_service);

        return error;
}

static int
vcaudio_set_port(void *priv, mixer_ctrl_t *mc)
{
        struct vcaudio_softc *sc = priv;

        switch (mc->dev) {
        case VCAUDIO_OUTPUT_MASTER_VOLUME:
        case VCAUDIO_INPUT_DAC_VOLUME:
                sc->sc_swvol = mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
                return 0;
        case VCAUDIO_OUTPUT_AUTO_VOLUME:
                return vcaudio_set_volume(sc, VCAUDIO_DEST_AUTO,
                    mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]);
        case VCAUDIO_OUTPUT_HEADPHONE_VOLUME:
                return vcaudio_set_volume(sc, VCAUDIO_DEST_HP,
                    mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]);
        case VCAUDIO_OUTPUT_HDMI_VOLUME:
                return vcaudio_set_volume(sc, VCAUDIO_DEST_HDMI,
                    mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]);
        case VCAUDIO_OUTPUT_SELECT:
                if (mc->un.ord < 0 || mc->un.ord > 2)
                        return EINVAL;
                sc->sc_dest = mc->un.ord;
                return vcaudio_set_volume(sc, mc->un.ord,
                    sc->sc_hwvol[mc->un.ord]);
        }
        return ENXIO;
}

static int
vcaudio_get_port(void *priv, mixer_ctrl_t *mc)
{
        struct vcaudio_softc *sc = priv;

        switch (mc->dev) {
        case VCAUDIO_OUTPUT_MASTER_VOLUME:
        case VCAUDIO_INPUT_DAC_VOLUME:
                mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
                    mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
                    sc->sc_swvol;
                return 0;
        case VCAUDIO_OUTPUT_AUTO_VOLUME:
                mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
                    mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
                    sc->sc_hwvol[VCAUDIO_DEST_AUTO];
                return 0;
        case VCAUDIO_OUTPUT_HEADPHONE_VOLUME:
                mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
                    mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
                    sc->sc_hwvol[VCAUDIO_DEST_HP];
                return 0;
        case VCAUDIO_OUTPUT_HDMI_VOLUME:
                mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
                    mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
                    sc->sc_hwvol[VCAUDIO_DEST_HDMI];
                return 0;
        case VCAUDIO_OUTPUT_SELECT:
                mc->un.ord = sc->sc_dest;
                return 0;
        }
        return ENXIO;
}

static int
vcaudio_query_devinfo(void *priv, mixer_devinfo_t *di)
{
        switch (di->index) {
        case VCAUDIO_OUTPUT_CLASS:
                di->mixer_class = VCAUDIO_OUTPUT_CLASS;
                strcpy(di->label.name, AudioCoutputs);
                di->type = AUDIO_MIXER_CLASS;
                di->next = di->prev = AUDIO_MIXER_LAST;
                return 0;
        case VCAUDIO_INPUT_CLASS:
                di->mixer_class = VCAUDIO_INPUT_CLASS;
                strcpy(di->label.name, AudioCinputs);
                di->type = AUDIO_MIXER_CLASS;
                di->next = di->prev = AUDIO_MIXER_LAST;
                return 0;
        case VCAUDIO_OUTPUT_MASTER_VOLUME:
                di->mixer_class = VCAUDIO_OUTPUT_CLASS;
                strcpy(di->label.name, AudioNmaster);
                di->type = AUDIO_MIXER_VALUE;
                di->next = di->prev = AUDIO_MIXER_LAST;
                di->un.v.num_channels = 2;
                strcpy(di->un.v.units.name, AudioNvolume);
                return 0;
        case VCAUDIO_OUTPUT_AUTO_VOLUME:
                di->mixer_class = VCAUDIO_OUTPUT_CLASS;
                strcpy(di->label.name, "auto");
                di->type = AUDIO_MIXER_VALUE;
                di->next = di->prev = AUDIO_MIXER_LAST;
                di->un.v.num_channels = 2;
                di->un.v.delta = 13;
                strcpy(di->un.v.units.name, AudioNvolume);
                return 0;
        case VCAUDIO_OUTPUT_HEADPHONE_VOLUME:
                di->mixer_class = VCAUDIO_OUTPUT_CLASS;
                strcpy(di->label.name, AudioNheadphone);
                di->type = AUDIO_MIXER_VALUE;
                di->next = di->prev = AUDIO_MIXER_LAST;
                di->un.v.num_channels = 2;
                di->un.v.delta = 13;
                strcpy(di->un.v.units.name, AudioNvolume);
                return 0;
        case VCAUDIO_OUTPUT_HDMI_VOLUME:
                di->mixer_class = VCAUDIO_OUTPUT_CLASS;
                strcpy(di->label.name, "hdmi");
                di->type = AUDIO_MIXER_VALUE;
                di->next = di->prev = AUDIO_MIXER_LAST;
                di->un.v.num_channels = 2;
                di->un.v.delta = 13;
                strcpy(di->un.v.units.name, AudioNvolume);
                return 0;
        case VCAUDIO_INPUT_DAC_VOLUME:
                di->mixer_class = VCAUDIO_INPUT_CLASS;
                strcpy(di->label.name, AudioNdac);
                di->type = AUDIO_MIXER_VALUE;
                di->next = di->prev = AUDIO_MIXER_LAST;
                di->un.v.num_channels = 2;
                strcpy(di->un.v.units.name, AudioNvolume);
                return 0;
        case VCAUDIO_OUTPUT_SELECT:
                di->mixer_class = VCAUDIO_OUTPUT_CLASS;
                strcpy(di->label.name, AudioNselect);
                di->type = AUDIO_MIXER_ENUM;
                di->next = di->prev = AUDIO_MIXER_LAST;
                di->un.e.num_mem = 3;
                di->un.e.member[0].ord = 0;
                strcpy(di->un.e.member[0].label.name, "auto");
                di->un.e.member[1].ord = 1;
                strcpy(di->un.e.member[1].label.name, AudioNheadphone);
                di->un.e.member[2].ord = 2;
                strcpy(di->un.e.member[2].label.name, "hdmi");
                return 0;
        }

        return ENXIO;
}

static int
vcaudio_getdev(void *priv, struct audio_device *audiodev)
{
        struct vcaudio_softc *sc = priv;

        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");

        return 0;
}

static int
vcaudio_get_props(void *priv)
{
        return AUDIO_PROP_PLAYBACK;
}

static int
vcaudio_round_blocksize(void *priv, int bs, int mode,
    const audio_params_t *params)
{
        return VCAUDIO_BLOCKSIZE;
}

static int
vcaudio_trigger_output(void *priv, void *start, void *end, int blksize,
    void (*intr)(void *), void *intrarg, const audio_params_t *params)
{
        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;
        sc->sc_ppos = 0;
        sc->sc_pstart = start;
        sc->sc_pend = end;
        sc->sc_pblksize = blksize;
        sc->sc_pblkcnt = 0;
        sc->sc_pbytes = 0;
        sc->sc_abytes = blksize;

        cv_signal(&sc->sc_datacv);

        return 0;
}

static void
vcaudio_get_locks(void *priv, kmutex_t **intr, kmutex_t **thread)
{
        struct vcaudio_softc *sc = priv;

        *intr = &sc->sc_intr_lock;
        *thread = &sc->sc_lock;
}

static void
vcaudio_swvol_codec(audio_filter_arg_t *arg)
{
        struct vcaudio_softc *sc = arg->context;
        const aint_t *src;
        int16_t *dst;
        u_int sample_count;
        u_int i;

        src = arg->src;
        dst = arg->dst;
        sample_count = arg->count * arg->srcfmt->channels;
        for (i = 0; i < sample_count; i++) {
                /* assume SLINEAR_NE:16 is preferred on playback */
                aint2_t v = (aint2_t)(*src++);
                v = v * sc->sc_swvol / 255;
                /* output vcaudio requires SLINEAR_LE:16 */
                *dst++ = (int16_t)htole16((uint16_t)(aint_t)v);
        }
}