Home | History | Annotate | Line # | Download | only in broadcom
bcm2835_vcaudio.c revision 1.6
      1  1.6  jmcneill /* $NetBSD: bcm2835_vcaudio.c,v 1.6 2014/09/02 21:46:35 jmcneill Exp $ */
      2  1.1  jmcneill 
      3  1.1  jmcneill /*-
      4  1.1  jmcneill  * Copyright (c) 2013 Jared D. McNeill <jmcneill (at) invisible.ca>
      5  1.1  jmcneill  * All rights reserved.
      6  1.1  jmcneill  *
      7  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8  1.1  jmcneill  * modification, are permitted provided that the following conditions
      9  1.1  jmcneill  * are met:
     10  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15  1.1  jmcneill  *
     16  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  jmcneill  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  jmcneill  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  jmcneill  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  jmcneill  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  jmcneill  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  jmcneill  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  jmcneill  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  jmcneill  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  jmcneill  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  jmcneill  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  jmcneill  */
     28  1.1  jmcneill 
     29  1.1  jmcneill /*
     30  1.1  jmcneill  * VideoCore audio interface
     31  1.1  jmcneill  */
     32  1.1  jmcneill 
     33  1.1  jmcneill #include <sys/cdefs.h>
     34  1.6  jmcneill __KERNEL_RCSID(0, "$NetBSD: bcm2835_vcaudio.c,v 1.6 2014/09/02 21:46:35 jmcneill Exp $");
     35  1.1  jmcneill 
     36  1.1  jmcneill #include <sys/param.h>
     37  1.1  jmcneill #include <sys/types.h>
     38  1.1  jmcneill #include <sys/systm.h>
     39  1.1  jmcneill #include <sys/device.h>
     40  1.1  jmcneill #include <sys/conf.h>
     41  1.1  jmcneill #include <sys/bus.h>
     42  1.1  jmcneill #include <sys/kmem.h>
     43  1.1  jmcneill #include <sys/workqueue.h>
     44  1.1  jmcneill 
     45  1.1  jmcneill #include <sys/audioio.h>
     46  1.1  jmcneill #include <dev/audio_if.h>
     47  1.1  jmcneill #include <dev/auconv.h>
     48  1.1  jmcneill 
     49  1.1  jmcneill #include <interface/compat/vchi_bsd.h>
     50  1.1  jmcneill #include <interface/vchiq_arm/vchiq_netbsd.h>
     51  1.1  jmcneill #include <interface/vchi/vchi.h>
     52  1.1  jmcneill 
     53  1.1  jmcneill #include "bcm2835_vcaudioreg.h"
     54  1.1  jmcneill 
     55  1.1  jmcneill #define vol2pct(vol)	(((vol) * 100) / 255)
     56  1.1  jmcneill 
     57  1.1  jmcneill enum {
     58  1.1  jmcneill 	VCAUDIO_OUTPUT_CLASS,
     59  1.1  jmcneill 	VCAUDIO_INPUT_CLASS,
     60  1.1  jmcneill 	VCAUDIO_OUTPUT_MASTER_VOLUME,
     61  1.1  jmcneill 	VCAUDIO_INPUT_DAC_VOLUME,
     62  1.1  jmcneill 	VCAUDIO_ENUM_LAST,
     63  1.1  jmcneill };
     64  1.1  jmcneill 
     65  1.1  jmcneill enum vcaudio_dest {
     66  1.1  jmcneill 	VCAUDIO_DEST_AUTO = 0,
     67  1.1  jmcneill 	VCAUDIO_DEST_HP = 1,
     68  1.1  jmcneill 	VCAUDIO_DEST_HDMI = 2,
     69  1.1  jmcneill };
     70  1.1  jmcneill 
     71  1.1  jmcneill struct vcaudio_work {
     72  1.1  jmcneill 	struct work			vw_wk;
     73  1.1  jmcneill };
     74  1.1  jmcneill 
     75  1.1  jmcneill struct vcaudio_softc {
     76  1.1  jmcneill 	device_t			sc_dev;
     77  1.1  jmcneill 	device_t			sc_audiodev;
     78  1.1  jmcneill 
     79  1.1  jmcneill 	kmutex_t			sc_lock;
     80  1.1  jmcneill 	kmutex_t			sc_intr_lock;
     81  1.3     skrll 
     82  1.3     skrll 	kmutex_t			sc_msglock;
     83  1.3     skrll 	kcondvar_t			sc_msgcv;
     84  1.1  jmcneill 
     85  1.1  jmcneill 	struct audio_format		sc_format;
     86  1.1  jmcneill 	struct audio_encoding_set	*sc_encodings;
     87  1.1  jmcneill 
     88  1.1  jmcneill 	void				(*sc_pint)(void *);
     89  1.1  jmcneill 	void				*sc_pintarg;
     90  1.1  jmcneill 	audio_params_t			sc_pparam;
     91  1.1  jmcneill 	bool				sc_started;
     92  1.1  jmcneill 	int				sc_pbytes;
     93  1.1  jmcneill 	off_t				sc_ppos;
     94  1.1  jmcneill 	void				*sc_pstart;
     95  1.1  jmcneill 	void				*sc_pend;
     96  1.1  jmcneill 	int				sc_pblksize;
     97  1.1  jmcneill 
     98  1.3     skrll 	bool				sc_msgdone;
     99  1.1  jmcneill 	int				sc_success;
    100  1.1  jmcneill 
    101  1.1  jmcneill 	VCHI_INSTANCE_T			sc_instance;
    102  1.1  jmcneill 	VCHI_CONNECTION_T		sc_connection;
    103  1.1  jmcneill 	VCHI_SERVICE_HANDLE_T		sc_service;
    104  1.1  jmcneill 
    105  1.6  jmcneill 	short				sc_peer_version;
    106  1.6  jmcneill 
    107  1.1  jmcneill 	struct workqueue		*sc_wq;
    108  1.1  jmcneill 	struct vcaudio_work		sc_work;
    109  1.1  jmcneill 
    110  1.1  jmcneill 	int				sc_volume;
    111  1.1  jmcneill 	enum vcaudio_dest		sc_dest;
    112  1.1  jmcneill };
    113  1.1  jmcneill 
    114  1.1  jmcneill static int	vcaudio_match(device_t, cfdata_t, void *);
    115  1.1  jmcneill static void	vcaudio_attach(device_t, device_t, void *);
    116  1.1  jmcneill static int	vcaudio_rescan(device_t, const char *, const int *);
    117  1.1  jmcneill static void	vcaudio_childdet(device_t, device_t);
    118  1.1  jmcneill 
    119  1.1  jmcneill static int	vcaudio_init(struct vcaudio_softc *);
    120  1.1  jmcneill static void	vcaudio_service_callback(void *,
    121  1.1  jmcneill 					 const VCHI_CALLBACK_REASON_T,
    122  1.1  jmcneill 					 void *);
    123  1.1  jmcneill static int	vcaudio_msg_sync(struct vcaudio_softc *, VC_AUDIO_MSG_T *, size_t);
    124  1.1  jmcneill static void	vcaudio_worker(struct work *, void *);
    125  1.1  jmcneill 
    126  1.1  jmcneill static int	vcaudio_open(void *, int);
    127  1.1  jmcneill static void	vcaudio_close(void *);
    128  1.1  jmcneill static int	vcaudio_query_encoding(void *, struct audio_encoding *);
    129  1.1  jmcneill static int	vcaudio_set_params(void *, int, int,
    130  1.1  jmcneill 				  audio_params_t *, audio_params_t *,
    131  1.1  jmcneill 				  stream_filter_list_t *,
    132  1.1  jmcneill 				  stream_filter_list_t *);
    133  1.1  jmcneill static int	vcaudio_halt_output(void *);
    134  1.1  jmcneill static int	vcaudio_halt_input(void *);
    135  1.1  jmcneill static int	vcaudio_set_port(void *, mixer_ctrl_t *);
    136  1.1  jmcneill static int	vcaudio_get_port(void *, mixer_ctrl_t *);
    137  1.1  jmcneill static int	vcaudio_query_devinfo(void *, mixer_devinfo_t *);
    138  1.1  jmcneill static int	vcaudio_getdev(void *, struct audio_device *);
    139  1.1  jmcneill static int	vcaudio_get_props(void *);
    140  1.1  jmcneill static int	vcaudio_round_blocksize(void *, int, int, const audio_params_t *);
    141  1.1  jmcneill static size_t	vcaudio_round_buffersize(void *, int, size_t);
    142  1.1  jmcneill static int	vcaudio_trigger_output(void *, void *, void *, int,
    143  1.1  jmcneill 				     void (*)(void *), void *,
    144  1.1  jmcneill 				     const audio_params_t *);
    145  1.1  jmcneill static int	vcaudio_trigger_input(void *, void *, void *, int,
    146  1.1  jmcneill 				    void (*)(void *), void *,
    147  1.1  jmcneill 				    const audio_params_t *);
    148  1.1  jmcneill static void	vcaudio_get_locks(void *, kmutex_t **, kmutex_t **);
    149  1.1  jmcneill 
    150  1.1  jmcneill static const struct audio_hw_if vcaudio_hw_if = {
    151  1.1  jmcneill 	.open = vcaudio_open,
    152  1.1  jmcneill 	.close = vcaudio_close,
    153  1.1  jmcneill 	.query_encoding = vcaudio_query_encoding,
    154  1.1  jmcneill 	.set_params = vcaudio_set_params,
    155  1.1  jmcneill 	.halt_output = vcaudio_halt_output,
    156  1.1  jmcneill 	.halt_input = vcaudio_halt_input,
    157  1.1  jmcneill 	.getdev = vcaudio_getdev,
    158  1.1  jmcneill 	.set_port = vcaudio_set_port,
    159  1.1  jmcneill 	.get_port = vcaudio_get_port,
    160  1.1  jmcneill 	.query_devinfo = vcaudio_query_devinfo,
    161  1.1  jmcneill 	.get_props = vcaudio_get_props,
    162  1.1  jmcneill 	.round_blocksize = vcaudio_round_blocksize,
    163  1.1  jmcneill 	.round_buffersize = vcaudio_round_buffersize,
    164  1.1  jmcneill 	.trigger_output = vcaudio_trigger_output,
    165  1.1  jmcneill 	.trigger_input = vcaudio_trigger_input,
    166  1.1  jmcneill 	.get_locks = vcaudio_get_locks,
    167  1.1  jmcneill };
    168  1.1  jmcneill 
    169  1.1  jmcneill CFATTACH_DECL2_NEW(vcaudio, sizeof(struct vcaudio_softc),
    170  1.1  jmcneill     vcaudio_match, vcaudio_attach, NULL, NULL, vcaudio_rescan, vcaudio_childdet);
    171  1.1  jmcneill 
    172  1.1  jmcneill static int
    173  1.1  jmcneill vcaudio_match(device_t parent, cfdata_t match, void *aux)
    174  1.1  jmcneill {
    175  1.1  jmcneill 	struct vchiq_attach_args *vaa = aux;
    176  1.1  jmcneill 
    177  1.1  jmcneill 	return !strcmp(vaa->vaa_name, "AUDS");
    178  1.1  jmcneill }
    179  1.1  jmcneill 
    180  1.1  jmcneill static void
    181  1.1  jmcneill vcaudio_attach(device_t parent, device_t self, void *aux)
    182  1.1  jmcneill {
    183  1.1  jmcneill 	struct vcaudio_softc *sc = device_private(self);
    184  1.1  jmcneill 	int error;
    185  1.1  jmcneill 
    186  1.1  jmcneill 	sc->sc_dev = self;
    187  1.1  jmcneill 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
    188  1.3     skrll 	mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_NONE);
    189  1.3     skrll 	mutex_init(&sc->sc_msglock, MUTEX_DEFAULT, IPL_NONE);
    190  1.3     skrll 	cv_init(&sc->sc_msgcv, "vcaudiocv");
    191  1.3     skrll 	sc->sc_success = -1;
    192  1.1  jmcneill 	error = workqueue_create(&sc->sc_wq, "vcaudiowq", vcaudio_worker,
    193  1.1  jmcneill 	    sc, PRI_BIO, IPL_SCHED, WQ_MPSAFE);
    194  1.1  jmcneill 	if (error) {
    195  1.1  jmcneill 		aprint_error(": couldn't create workqueue (%d)\n", error);
    196  1.1  jmcneill 		return;
    197  1.1  jmcneill 	}
    198  1.1  jmcneill 
    199  1.1  jmcneill 	aprint_naive("\n");
    200  1.1  jmcneill 	aprint_normal(": AUDS\n");
    201  1.1  jmcneill 
    202  1.1  jmcneill 	vcaudio_rescan(self, NULL, NULL);
    203  1.1  jmcneill }
    204  1.1  jmcneill 
    205  1.1  jmcneill static int
    206  1.1  jmcneill vcaudio_rescan(device_t self, const char *ifattr, const int *locs)
    207  1.1  jmcneill {
    208  1.1  jmcneill 	struct vcaudio_softc *sc = device_private(self);
    209  1.6  jmcneill 	int error;
    210  1.1  jmcneill 
    211  1.1  jmcneill 	if (ifattr_match(ifattr, "audiobus") && sc->sc_audiodev == NULL) {
    212  1.6  jmcneill 		error = vcaudio_init(sc);
    213  1.6  jmcneill 		if (error)
    214  1.6  jmcneill 			return error;
    215  1.6  jmcneill 
    216  1.1  jmcneill 		sc->sc_audiodev = audio_attach_mi(&vcaudio_hw_if,
    217  1.1  jmcneill 		    sc, sc->sc_dev);
    218  1.1  jmcneill 	}
    219  1.1  jmcneill 	return 0;
    220  1.1  jmcneill }
    221  1.1  jmcneill 
    222  1.1  jmcneill static void
    223  1.1  jmcneill vcaudio_childdet(device_t self, device_t child)
    224  1.1  jmcneill {
    225  1.1  jmcneill 	struct vcaudio_softc *sc = device_private(self);
    226  1.1  jmcneill 
    227  1.1  jmcneill 	if (sc->sc_audiodev == child)
    228  1.1  jmcneill 		sc->sc_audiodev = NULL;
    229  1.1  jmcneill }
    230  1.1  jmcneill 
    231  1.1  jmcneill static int
    232  1.1  jmcneill vcaudio_init(struct vcaudio_softc *sc)
    233  1.1  jmcneill {
    234  1.1  jmcneill 	VC_AUDIO_MSG_T msg;
    235  1.1  jmcneill 	int error;
    236  1.1  jmcneill 
    237  1.1  jmcneill 	sc->sc_volume = 128;
    238  1.1  jmcneill 	sc->sc_dest = VCAUDIO_DEST_AUTO;
    239  1.1  jmcneill 
    240  1.1  jmcneill 	sc->sc_format.mode = AUMODE_PLAY|AUMODE_RECORD;
    241  1.1  jmcneill 	sc->sc_format.encoding = AUDIO_ENCODING_SLINEAR_LE;
    242  1.1  jmcneill 	sc->sc_format.validbits = 16;
    243  1.1  jmcneill 	sc->sc_format.precision = 16;
    244  1.1  jmcneill 	sc->sc_format.channels = 2;
    245  1.1  jmcneill 	sc->sc_format.channel_mask = AUFMT_STEREO;
    246  1.1  jmcneill 	sc->sc_format.frequency_type = 0;
    247  1.4  jmcneill 	sc->sc_format.frequency[0] = 48000;
    248  1.1  jmcneill 	sc->sc_format.frequency[1] = 48000;
    249  1.2     skrll 
    250  1.1  jmcneill 	error = auconv_create_encodings(&sc->sc_format, 1, &sc->sc_encodings);
    251  1.1  jmcneill 	if (error) {
    252  1.1  jmcneill 		aprint_error_dev(sc->sc_dev,
    253  1.1  jmcneill 		    "couldn't create encodings (error=%d)\n", error);
    254  1.1  jmcneill 		return error;
    255  1.1  jmcneill 	}
    256  1.1  jmcneill 
    257  1.1  jmcneill 	error = vchi_initialise(&sc->sc_instance);
    258  1.1  jmcneill 	if (error) {
    259  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't init vchi instance (%d)\n",
    260  1.1  jmcneill 		    error);
    261  1.1  jmcneill 		return EIO;
    262  1.1  jmcneill 	}
    263  1.1  jmcneill 
    264  1.1  jmcneill 	error = vchi_connect(NULL, 0, sc->sc_instance);
    265  1.1  jmcneill 	if (error) {
    266  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't connect vchi (%d)\n",
    267  1.1  jmcneill 		    error);
    268  1.1  jmcneill 		return EIO;
    269  1.1  jmcneill 	}
    270  1.1  jmcneill 
    271  1.1  jmcneill 	SERVICE_CREATION_T setup = {
    272  1.1  jmcneill 		.version = VCHI_VERSION(VC_AUDIOSERV_VER),
    273  1.1  jmcneill 		.service_id = VC_AUDIO_SERVER_NAME,
    274  1.1  jmcneill 		.connection = &sc->sc_connection,
    275  1.1  jmcneill 		.rx_fifo_size = 0,
    276  1.1  jmcneill 		.tx_fifo_size = 0,
    277  1.1  jmcneill 		.callback = vcaudio_service_callback,
    278  1.1  jmcneill 		.callback_param = sc,
    279  1.1  jmcneill 		.want_unaligned_bulk_rx = 1,
    280  1.1  jmcneill 		.want_unaligned_bulk_tx = 1,
    281  1.1  jmcneill 		.want_crc = 0,
    282  1.1  jmcneill 	};
    283  1.1  jmcneill 
    284  1.1  jmcneill 	error = vchi_service_open(sc->sc_instance, &setup, &sc->sc_service);
    285  1.1  jmcneill 	if (error) {
    286  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't open service (%d)\n",
    287  1.1  jmcneill 		    error);
    288  1.1  jmcneill 		return EIO;
    289  1.1  jmcneill 	}
    290  1.1  jmcneill 
    291  1.6  jmcneill 	vchi_get_peer_version(sc->sc_service, &sc->sc_peer_version);
    292  1.6  jmcneill 
    293  1.6  jmcneill 	if (sc->sc_peer_version < 2) {
    294  1.6  jmcneill 		aprint_error_dev(sc->sc_dev,
    295  1.6  jmcneill 		    "peer version (%d) is less than the required version (2)\n",
    296  1.6  jmcneill 		    sc->sc_peer_version);
    297  1.6  jmcneill 		return EINVAL;
    298  1.6  jmcneill 	}
    299  1.6  jmcneill 
    300  1.1  jmcneill 	memset(&msg, 0, sizeof(msg));
    301  1.1  jmcneill 	msg.type = VC_AUDIO_MSG_TYPE_OPEN;
    302  1.1  jmcneill 	error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
    303  1.1  jmcneill 	    VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
    304  1.1  jmcneill 	if (error) {
    305  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't send OPEN message (%d)\n",
    306  1.1  jmcneill 		    error);
    307  1.1  jmcneill 	}
    308  1.1  jmcneill 
    309  1.1  jmcneill 	memset(&msg, 0, sizeof(msg));
    310  1.4  jmcneill 	msg.type = VC_AUDIO_MSG_TYPE_CONFIG;
    311  1.4  jmcneill 	msg.u.config.channels = 2;
    312  1.4  jmcneill 	msg.u.config.samplerate = 48000;
    313  1.4  jmcneill 	msg.u.config.bps = 16;
    314  1.4  jmcneill 	error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
    315  1.4  jmcneill 	if (error) {
    316  1.4  jmcneill 		device_printf(sc->sc_dev, "couldn't send CONFIG message (%d)\n",
    317  1.4  jmcneill 		    error);
    318  1.4  jmcneill 	}
    319  1.4  jmcneill 
    320  1.4  jmcneill 	memset(&msg, 0, sizeof(msg));
    321  1.1  jmcneill 	msg.type = VC_AUDIO_MSG_TYPE_CONTROL;
    322  1.1  jmcneill 	msg.u.control.volume = vol2pct(sc->sc_volume);
    323  1.1  jmcneill 	msg.u.control.dest = VCAUDIO_DEST_AUTO;
    324  1.1  jmcneill 	error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
    325  1.1  jmcneill 	if (error) {
    326  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't send CONTROL message (%d)\n", error);
    327  1.1  jmcneill 	}
    328  1.1  jmcneill 	vchi_service_release(sc->sc_service);
    329  1.1  jmcneill 
    330  1.1  jmcneill 	return 0;
    331  1.1  jmcneill }
    332  1.1  jmcneill 
    333  1.1  jmcneill static void
    334  1.1  jmcneill vcaudio_service_callback(void *priv, const VCHI_CALLBACK_REASON_T reason,
    335  1.1  jmcneill     void *msg_handle)
    336  1.1  jmcneill {
    337  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    338  1.1  jmcneill 	VC_AUDIO_MSG_T msg;
    339  1.1  jmcneill 	int32_t msglen = 0;
    340  1.1  jmcneill 	int error;
    341  1.1  jmcneill 	void (*intr)(void *) = NULL;
    342  1.1  jmcneill 	void *intrarg = NULL;
    343  1.1  jmcneill 
    344  1.1  jmcneill 	if (sc == NULL || reason != VCHI_CALLBACK_MSG_AVAILABLE)
    345  1.1  jmcneill 		return;
    346  1.1  jmcneill 
    347  1.1  jmcneill 	memset(&msg, 0, sizeof(msg));
    348  1.1  jmcneill 	error = vchi_msg_dequeue(sc->sc_service, &msg, sizeof(msg), &msglen,
    349  1.1  jmcneill 	    VCHI_FLAGS_NONE);
    350  1.1  jmcneill 	if (error) {
    351  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't dequeue msg (%d)\n",
    352  1.1  jmcneill 		    error);
    353  1.1  jmcneill 		return;
    354  1.1  jmcneill 	}
    355  1.1  jmcneill 
    356  1.1  jmcneill 	switch (msg.type) {
    357  1.1  jmcneill 	case VC_AUDIO_MSG_TYPE_RESULT:
    358  1.3     skrll 		mutex_enter(&sc->sc_msglock);
    359  1.1  jmcneill 		sc->sc_success = msg.u.result.success;
    360  1.3     skrll 		sc->sc_msgdone = true;
    361  1.3     skrll 		cv_broadcast(&sc->sc_msgcv);
    362  1.3     skrll 		mutex_exit(&sc->sc_msglock);
    363  1.1  jmcneill 		break;
    364  1.1  jmcneill 	case VC_AUDIO_MSG_TYPE_COMPLETE:
    365  1.1  jmcneill 		intr = msg.u.complete.callback;
    366  1.1  jmcneill 		intrarg = msg.u.complete.cookie;
    367  1.1  jmcneill 		if (intr && intrarg) {
    368  1.5  jmcneill 			int count = msg.u.complete.count & 0xffff;
    369  1.5  jmcneill 			int perr = (msg.u.complete.count & 0x40000000) != 0;
    370  1.5  jmcneill 			bool sched = false;
    371  1.3     skrll 			mutex_enter(&sc->sc_intr_lock);
    372  1.5  jmcneill 			if (count > 0) {
    373  1.5  jmcneill 				sc->sc_pbytes += count;
    374  1.5  jmcneill 			}
    375  1.5  jmcneill 			if (perr && sc->sc_started) {
    376  1.5  jmcneill #ifdef VCAUDIO_DEBUG
    377  1.5  jmcneill 				device_printf(sc->sc_dev, "underrun\n");
    378  1.5  jmcneill #endif
    379  1.5  jmcneill 				sched = true;
    380  1.1  jmcneill 			}
    381  1.1  jmcneill 			if (sc->sc_pbytes >= sc->sc_pblksize) {
    382  1.1  jmcneill 				sc->sc_pbytes -= sc->sc_pblksize;
    383  1.5  jmcneill 				sched = true;
    384  1.5  jmcneill 			}
    385  1.5  jmcneill 
    386  1.5  jmcneill 			if (sched) {
    387  1.1  jmcneill 				intr(intrarg);
    388  1.1  jmcneill 				workqueue_enqueue(sc->sc_wq, (struct work *)&sc->sc_work, NULL);
    389  1.1  jmcneill 			}
    390  1.3     skrll 			mutex_exit(&sc->sc_intr_lock);
    391  1.1  jmcneill 		}
    392  1.1  jmcneill 		break;
    393  1.1  jmcneill 	default:
    394  1.1  jmcneill 		break;
    395  1.1  jmcneill 	}
    396  1.1  jmcneill }
    397  1.1  jmcneill 
    398  1.1  jmcneill static void
    399  1.1  jmcneill vcaudio_worker(struct work *wk, void *priv)
    400  1.1  jmcneill {
    401  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    402  1.1  jmcneill 	VC_AUDIO_MSG_T msg;
    403  1.1  jmcneill 	void (*intr)(void *);
    404  1.1  jmcneill 	void *intrarg;
    405  1.1  jmcneill 	void *block;
    406  1.1  jmcneill 	int error, resid, off, nb, count;
    407  1.1  jmcneill 
    408  1.1  jmcneill 	mutex_enter(&sc->sc_intr_lock);
    409  1.1  jmcneill 	intr = sc->sc_pint;
    410  1.1  jmcneill 	intrarg = sc->sc_pintarg;
    411  1.1  jmcneill 
    412  1.3     skrll 	if (intr == NULL || intrarg == NULL) {
    413  1.3     skrll 		mutex_exit(&sc->sc_intr_lock);
    414  1.1  jmcneill 		return;
    415  1.3     skrll 	}
    416  1.1  jmcneill 
    417  1.1  jmcneill 	vchi_service_use(sc->sc_service);
    418  1.1  jmcneill 
    419  1.1  jmcneill 	if (sc->sc_started == false) {
    420  1.1  jmcneill #ifdef VCAUDIO_DEBUG
    421  1.1  jmcneill 		device_printf(sc->sc_dev, "starting output\n");
    422  1.1  jmcneill #endif
    423  1.1  jmcneill 
    424  1.1  jmcneill 		memset(&msg, 0, sizeof(msg));
    425  1.1  jmcneill 		msg.type = VC_AUDIO_MSG_TYPE_START;
    426  1.1  jmcneill 		error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
    427  1.1  jmcneill 		    VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
    428  1.1  jmcneill 		if (error) {
    429  1.1  jmcneill 			printf("%s: failed to start (%d)\n", __func__, error);
    430  1.1  jmcneill 			goto done;
    431  1.1  jmcneill 		}
    432  1.1  jmcneill 
    433  1.1  jmcneill 		sc->sc_started = true;
    434  1.1  jmcneill 		sc->sc_pbytes = 0;
    435  1.1  jmcneill 		sc->sc_ppos = 0;
    436  1.1  jmcneill 
    437  1.5  jmcneill 		count = sc->sc_pblksize * 2;
    438  1.1  jmcneill 	} else {
    439  1.1  jmcneill 		count = sc->sc_pblksize;
    440  1.1  jmcneill 	}
    441  1.1  jmcneill 
    442  1.1  jmcneill 	memset(&msg, 0, sizeof(msg));
    443  1.1  jmcneill 	msg.type = VC_AUDIO_MSG_TYPE_WRITE;
    444  1.1  jmcneill 	msg.u.write.max_packet = 4000;
    445  1.1  jmcneill 	msg.u.write.count = count;
    446  1.1  jmcneill 	msg.u.write.callback = intr;
    447  1.2     skrll 	msg.u.write.cookie = intrarg;
    448  1.1  jmcneill 	msg.u.write.silence = 0;
    449  1.1  jmcneill 
    450  1.1  jmcneill 	error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
    451  1.1  jmcneill 	    VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
    452  1.1  jmcneill 	if (error) {
    453  1.1  jmcneill 		printf("%s: failed to write (%d)\n", __func__, error);
    454  1.1  jmcneill 		goto done;
    455  1.1  jmcneill 	}
    456  1.1  jmcneill 
    457  1.1  jmcneill 	block = (uint8_t *)sc->sc_pstart + sc->sc_ppos;
    458  1.1  jmcneill 	resid = count;
    459  1.1  jmcneill 	off = 0;
    460  1.1  jmcneill 	while (resid > 0) {
    461  1.1  jmcneill 		nb = min(resid, msg.u.write.max_packet);
    462  1.1  jmcneill 		error = vchi_msg_queue(sc->sc_service,
    463  1.1  jmcneill 		    (char *)block + off, nb,
    464  1.1  jmcneill 		    VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
    465  1.1  jmcneill 		if (error) {
    466  1.1  jmcneill 			printf("%s: failed to queue data (%d)\n", __func__, error);
    467  1.1  jmcneill 			goto done;
    468  1.1  jmcneill 		}
    469  1.1  jmcneill 		off += nb;
    470  1.1  jmcneill 		resid -= nb;
    471  1.1  jmcneill 	}
    472  1.1  jmcneill 
    473  1.1  jmcneill 	sc->sc_ppos += count;
    474  1.1  jmcneill 	if ((uint8_t *)sc->sc_pstart + sc->sc_ppos >= (uint8_t *)sc->sc_pend)
    475  1.1  jmcneill 		sc->sc_ppos = 0;
    476  1.1  jmcneill 
    477  1.1  jmcneill done:
    478  1.3     skrll 	mutex_exit(&sc->sc_intr_lock);
    479  1.1  jmcneill 	vchi_service_release(sc->sc_service);
    480  1.1  jmcneill }
    481  1.1  jmcneill 
    482  1.1  jmcneill static int
    483  1.1  jmcneill vcaudio_msg_sync(struct vcaudio_softc *sc, VC_AUDIO_MSG_T *msg, size_t msglen)
    484  1.1  jmcneill {
    485  1.1  jmcneill 	int error = 0;
    486  1.1  jmcneill 
    487  1.3     skrll 	mutex_enter(&sc->sc_msglock);
    488  1.3     skrll 
    489  1.1  jmcneill 	sc->sc_success = -1;
    490  1.3     skrll 	sc->sc_msgdone = false;
    491  1.3     skrll 
    492  1.1  jmcneill 	error = vchi_msg_queue(sc->sc_service, msg, msglen,
    493  1.1  jmcneill 	    VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
    494  1.1  jmcneill 	if (error) {
    495  1.1  jmcneill 		printf("%s: failed to queue message (%d)\n", __func__, error);
    496  1.1  jmcneill 		goto done;
    497  1.1  jmcneill 	}
    498  1.3     skrll 
    499  1.3     skrll 	while (!sc->sc_msgdone) {
    500  1.3     skrll 		error = cv_wait_sig(&sc->sc_msgcv, &sc->sc_msglock);
    501  1.1  jmcneill 		if (error)
    502  1.1  jmcneill 			break;
    503  1.1  jmcneill 	}
    504  1.3     skrll 	if (sc->sc_success != 0)
    505  1.1  jmcneill 		error = EIO;
    506  1.1  jmcneill done:
    507  1.3     skrll 	mutex_exit(&sc->sc_msglock);
    508  1.1  jmcneill 
    509  1.1  jmcneill 	return error;
    510  1.1  jmcneill }
    511  1.1  jmcneill 
    512  1.1  jmcneill static int
    513  1.1  jmcneill vcaudio_open(void *priv, int flags)
    514  1.1  jmcneill {
    515  1.1  jmcneill 	return 0;
    516  1.1  jmcneill }
    517  1.1  jmcneill 
    518  1.1  jmcneill static void
    519  1.1  jmcneill vcaudio_close(void *priv)
    520  1.1  jmcneill {
    521  1.1  jmcneill }
    522  1.1  jmcneill 
    523  1.1  jmcneill static int
    524  1.1  jmcneill vcaudio_query_encoding(void *priv, struct audio_encoding *ae)
    525  1.1  jmcneill {
    526  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    527  1.1  jmcneill 
    528  1.1  jmcneill 	return auconv_query_encoding(sc->sc_encodings, ae);
    529  1.1  jmcneill }
    530  1.1  jmcneill 
    531  1.1  jmcneill static int
    532  1.1  jmcneill vcaudio_set_params(void *priv, int setmode, int usemode,
    533  1.1  jmcneill     audio_params_t *play, audio_params_t *rec,
    534  1.1  jmcneill     stream_filter_list_t *pfil, stream_filter_list_t *rfil)
    535  1.1  jmcneill {
    536  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    537  1.1  jmcneill 	int index;
    538  1.1  jmcneill 
    539  1.1  jmcneill 	if (play && (setmode & AUMODE_PLAY)) {
    540  1.1  jmcneill 		index = auconv_set_converter(&sc->sc_format, 1,
    541  1.1  jmcneill 		    AUMODE_PLAY, play, true, pfil);
    542  1.1  jmcneill 		if (index < 0)
    543  1.1  jmcneill 			return EINVAL;
    544  1.1  jmcneill 	}
    545  1.1  jmcneill 
    546  1.1  jmcneill 	return 0;
    547  1.1  jmcneill }
    548  1.1  jmcneill 
    549  1.1  jmcneill static int
    550  1.1  jmcneill vcaudio_halt_output(void *priv)
    551  1.1  jmcneill {
    552  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    553  1.1  jmcneill 	VC_AUDIO_MSG_T msg;
    554  1.1  jmcneill 	int error = 0;
    555  1.1  jmcneill 
    556  1.1  jmcneill 	vchi_service_use(sc->sc_service);
    557  1.1  jmcneill 	memset(&msg, 0, sizeof(msg));
    558  1.1  jmcneill 	msg.type = VC_AUDIO_MSG_TYPE_STOP;
    559  1.1  jmcneill 	msg.u.stop.draining = 1;
    560  1.1  jmcneill 	error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg),
    561  1.1  jmcneill 	    VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL);
    562  1.1  jmcneill 	if (error) {
    563  1.1  jmcneill 		device_printf(sc->sc_dev, "couldn't send STOP message (%d)\n",
    564  1.1  jmcneill 		    error);
    565  1.1  jmcneill 	}
    566  1.1  jmcneill 	vchi_service_release(sc->sc_service);
    567  1.1  jmcneill 
    568  1.1  jmcneill 	sc->sc_pint = NULL;
    569  1.1  jmcneill 	sc->sc_pintarg = NULL;
    570  1.1  jmcneill 	sc->sc_started = false;
    571  1.1  jmcneill 
    572  1.1  jmcneill #ifdef VCAUDIO_DEBUG
    573  1.1  jmcneill 	device_printf(sc->sc_dev, "halting output\n");
    574  1.1  jmcneill #endif
    575  1.1  jmcneill 
    576  1.1  jmcneill 	return error;
    577  1.1  jmcneill }
    578  1.1  jmcneill 
    579  1.1  jmcneill static int
    580  1.1  jmcneill vcaudio_halt_input(void *priv)
    581  1.1  jmcneill {
    582  1.1  jmcneill 	return EINVAL;
    583  1.1  jmcneill }
    584  1.1  jmcneill 
    585  1.1  jmcneill static int
    586  1.1  jmcneill vcaudio_set_port(void *priv, mixer_ctrl_t *mc)
    587  1.1  jmcneill {
    588  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    589  1.1  jmcneill 	VC_AUDIO_MSG_T msg;
    590  1.1  jmcneill 	int error;
    591  1.1  jmcneill 
    592  1.1  jmcneill 	switch (mc->dev) {
    593  1.1  jmcneill 	case VCAUDIO_OUTPUT_MASTER_VOLUME:
    594  1.1  jmcneill 	case VCAUDIO_INPUT_DAC_VOLUME:
    595  1.1  jmcneill 		sc->sc_volume = mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT];
    596  1.1  jmcneill 		memset(&msg, 0, sizeof(msg));
    597  1.1  jmcneill 		msg.type = VC_AUDIO_MSG_TYPE_CONTROL;
    598  1.1  jmcneill 		msg.u.control.volume = vol2pct(sc->sc_volume);
    599  1.1  jmcneill 		msg.u.control.dest = VCAUDIO_DEST_AUTO;
    600  1.1  jmcneill 		vchi_service_use(sc->sc_service);
    601  1.1  jmcneill 		error = vcaudio_msg_sync(sc, &msg, sizeof(msg));
    602  1.1  jmcneill 		if (error) {
    603  1.1  jmcneill 			device_printf(sc->sc_dev, "couldn't send CONTROL message (%d)\n", error);
    604  1.1  jmcneill 		}
    605  1.1  jmcneill 		vchi_service_release(sc->sc_service);
    606  1.1  jmcneill 
    607  1.1  jmcneill 		return error;
    608  1.1  jmcneill 	}
    609  1.1  jmcneill 	return ENXIO;
    610  1.1  jmcneill }
    611  1.1  jmcneill 
    612  1.1  jmcneill static int
    613  1.1  jmcneill vcaudio_get_port(void *priv, mixer_ctrl_t *mc)
    614  1.1  jmcneill {
    615  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    616  1.1  jmcneill 
    617  1.1  jmcneill 	switch (mc->dev) {
    618  1.1  jmcneill 	case VCAUDIO_OUTPUT_MASTER_VOLUME:
    619  1.1  jmcneill 	case VCAUDIO_INPUT_DAC_VOLUME:
    620  1.1  jmcneill 		mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] =
    621  1.1  jmcneill 		    mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] =
    622  1.1  jmcneill 		    sc->sc_volume;
    623  1.1  jmcneill 		return 0;
    624  1.1  jmcneill 	}
    625  1.1  jmcneill 	return ENXIO;
    626  1.1  jmcneill }
    627  1.1  jmcneill 
    628  1.1  jmcneill static int
    629  1.1  jmcneill vcaudio_query_devinfo(void *priv, mixer_devinfo_t *di)
    630  1.1  jmcneill {
    631  1.1  jmcneill 	switch (di->index) {
    632  1.1  jmcneill 	case VCAUDIO_OUTPUT_CLASS:
    633  1.1  jmcneill 		di->mixer_class = VCAUDIO_OUTPUT_CLASS;
    634  1.1  jmcneill 		strcpy(di->label.name, AudioCoutputs);
    635  1.1  jmcneill 		di->type = AUDIO_MIXER_CLASS;
    636  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    637  1.1  jmcneill 		return 0;
    638  1.1  jmcneill 	case VCAUDIO_INPUT_CLASS:
    639  1.1  jmcneill 		di->mixer_class = VCAUDIO_INPUT_CLASS;
    640  1.1  jmcneill 		strcpy(di->label.name, AudioCinputs);
    641  1.1  jmcneill 		di->type = AUDIO_MIXER_CLASS;
    642  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    643  1.1  jmcneill 		return 0;
    644  1.1  jmcneill 	case VCAUDIO_OUTPUT_MASTER_VOLUME:
    645  1.1  jmcneill 		di->mixer_class = VCAUDIO_OUTPUT_CLASS;
    646  1.1  jmcneill 		strcpy(di->label.name, AudioNmaster);
    647  1.1  jmcneill 		di->type = AUDIO_MIXER_VALUE;
    648  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    649  1.1  jmcneill 		di->un.v.num_channels = 2;
    650  1.1  jmcneill 		strcpy(di->un.v.units.name, AudioNvolume);
    651  1.1  jmcneill 		return 0;
    652  1.1  jmcneill 	case VCAUDIO_INPUT_DAC_VOLUME:
    653  1.1  jmcneill 		di->mixer_class = VCAUDIO_INPUT_CLASS;
    654  1.1  jmcneill 		strcpy(di->label.name, AudioNdac);
    655  1.1  jmcneill 		di->type = AUDIO_MIXER_VALUE;
    656  1.1  jmcneill 		di->next = di->prev = AUDIO_MIXER_LAST;
    657  1.1  jmcneill 		di->un.v.num_channels = 2;
    658  1.1  jmcneill 		strcpy(di->un.v.units.name, AudioNvolume);
    659  1.1  jmcneill 		return 0;
    660  1.1  jmcneill 	}
    661  1.1  jmcneill 
    662  1.1  jmcneill 	return ENXIO;
    663  1.1  jmcneill }
    664  1.1  jmcneill 
    665  1.1  jmcneill static int
    666  1.1  jmcneill vcaudio_getdev(void *priv, struct audio_device *audiodev)
    667  1.1  jmcneill {
    668  1.6  jmcneill 	struct vcaudio_softc *sc = priv;
    669  1.6  jmcneill 
    670  1.1  jmcneill 	snprintf(audiodev->name, sizeof(audiodev->name), "VCHIQ AUDS");
    671  1.6  jmcneill 	snprintf(audiodev->version, sizeof(audiodev->version),
    672  1.6  jmcneill 	    "%d", sc->sc_peer_version);
    673  1.1  jmcneill 	snprintf(audiodev->config, sizeof(audiodev->config), "vcaudio");
    674  1.6  jmcneill 
    675  1.1  jmcneill 	return 0;
    676  1.1  jmcneill }
    677  1.1  jmcneill 
    678  1.1  jmcneill static int
    679  1.1  jmcneill vcaudio_get_props(void *priv)
    680  1.1  jmcneill {
    681  1.1  jmcneill 	return AUDIO_PROP_PLAYBACK|AUDIO_PROP_CAPTURE|AUDIO_PROP_INDEPENDENT;
    682  1.1  jmcneill }
    683  1.1  jmcneill 
    684  1.1  jmcneill static int
    685  1.1  jmcneill vcaudio_round_blocksize(void *priv, int bs, int mode,
    686  1.1  jmcneill     const audio_params_t *params)
    687  1.1  jmcneill {
    688  1.1  jmcneill 	return PAGE_SIZE;
    689  1.1  jmcneill }
    690  1.1  jmcneill 
    691  1.1  jmcneill static size_t
    692  1.1  jmcneill vcaudio_round_buffersize(void *priv, int direction, size_t bufsize)
    693  1.1  jmcneill {
    694  1.1  jmcneill 	size_t sz;
    695  1.1  jmcneill 
    696  1.1  jmcneill 	sz = (bufsize + 0x3ff) & ~0x3ff;
    697  1.1  jmcneill 	if (sz > 32768)
    698  1.1  jmcneill 		sz = 32768;
    699  1.1  jmcneill 
    700  1.1  jmcneill 	return sz;
    701  1.1  jmcneill }
    702  1.1  jmcneill 
    703  1.1  jmcneill static int
    704  1.1  jmcneill vcaudio_trigger_output(void *priv, void *start, void *end, int blksize,
    705  1.1  jmcneill     void (*intr)(void *), void *intrarg, const audio_params_t *params)
    706  1.1  jmcneill {
    707  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    708  1.1  jmcneill 
    709  1.1  jmcneill 	sc->sc_pparam = *params;
    710  1.1  jmcneill 	sc->sc_pint = intr;
    711  1.1  jmcneill 	sc->sc_pintarg = intrarg;
    712  1.1  jmcneill 	sc->sc_ppos = 0;
    713  1.1  jmcneill 	sc->sc_pstart = start;
    714  1.1  jmcneill 	sc->sc_pend = end;
    715  1.1  jmcneill 	sc->sc_pblksize = blksize;
    716  1.1  jmcneill 	workqueue_enqueue(sc->sc_wq, (struct work *)&sc->sc_work, NULL);
    717  1.1  jmcneill 
    718  1.1  jmcneill 	return 0;
    719  1.1  jmcneill }
    720  1.2     skrll 
    721  1.1  jmcneill static int
    722  1.1  jmcneill vcaudio_trigger_input(void *priv, void *start, void *end, int blksize,
    723  1.1  jmcneill     void (*intr)(void *), void *intrarg, const audio_params_t *params)
    724  1.1  jmcneill {
    725  1.1  jmcneill 	return EINVAL;
    726  1.1  jmcneill }
    727  1.1  jmcneill 
    728  1.1  jmcneill static void
    729  1.1  jmcneill vcaudio_get_locks(void *priv, kmutex_t **intr, kmutex_t **thread)
    730  1.1  jmcneill {
    731  1.1  jmcneill 	struct vcaudio_softc *sc = priv;
    732  1.1  jmcneill 
    733  1.1  jmcneill 	*intr = &sc->sc_intr_lock;
    734  1.1  jmcneill 	*thread = &sc->sc_lock;
    735  1.1  jmcneill }
    736