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