bcm2835_vcaudio.c revision 1.2.4.4
1 1.2.4.2 tls /* $NetBSD: bcm2835_vcaudio.c,v 1.2.4.4 2017/12/03 11:35:52 jdolecek 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.4 2017/12/03 11:35:52 jdolecek 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 44 1.2.4.2 tls #include <sys/audioio.h> 45 1.2.4.2 tls #include <dev/audio_if.h> 46 1.2.4.2 tls #include <dev/auconv.h> 47 1.2.4.4 jdolecek #include <dev/auvolconv.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.4 jdolecek /* levels with 5% volume step */ 56 1.2.4.4 jdolecek static int vcaudio_levels[] = { 57 1.2.4.4 jdolecek -10239, -4605, -3794, -3218, -2772, 58 1.2.4.4 jdolecek -2407, -2099, -1832, -1597, -1386, 59 1.2.4.4 jdolecek -1195, -1021, -861, -713, -575, 60 1.2.4.4 jdolecek -446, -325, -210, -102, 0, 61 1.2.4.4 jdolecek }; 62 1.2.4.4 jdolecek 63 1.2.4.4 jdolecek #define vol2db(vol) vcaudio_levels[((vol) * 20) >> 8] 64 1.2.4.4 jdolecek #define vol2vc(vol) ((uint32_t)(-(vol2db((vol)) << 8) / 100)) 65 1.2.4.2 tls 66 1.2.4.2 tls enum { 67 1.2.4.2 tls VCAUDIO_OUTPUT_CLASS, 68 1.2.4.2 tls VCAUDIO_INPUT_CLASS, 69 1.2.4.2 tls VCAUDIO_OUTPUT_MASTER_VOLUME, 70 1.2.4.2 tls VCAUDIO_INPUT_DAC_VOLUME, 71 1.2.4.4 jdolecek VCAUDIO_OUTPUT_AUTO_VOLUME, 72 1.2.4.4 jdolecek VCAUDIO_OUTPUT_HEADPHONE_VOLUME, 73 1.2.4.4 jdolecek VCAUDIO_OUTPUT_HDMI_VOLUME, 74 1.2.4.4 jdolecek VCAUDIO_OUTPUT_SELECT, 75 1.2.4.2 tls VCAUDIO_ENUM_LAST, 76 1.2.4.2 tls }; 77 1.2.4.2 tls 78 1.2.4.2 tls enum vcaudio_dest { 79 1.2.4.2 tls VCAUDIO_DEST_AUTO = 0, 80 1.2.4.2 tls VCAUDIO_DEST_HP = 1, 81 1.2.4.2 tls VCAUDIO_DEST_HDMI = 2, 82 1.2.4.2 tls }; 83 1.2.4.2 tls 84 1.2.4.4 jdolecek /* 85 1.2.4.4 jdolecek * Maximum message size is 4000 bytes and VCHIQ can accept 16 messages. 86 1.2.4.4 jdolecek * 87 1.2.4.4 jdolecek * 4000 bytes of 16bit 48kHz stereo is approximately 21ms. 88 1.2.4.4 jdolecek * 89 1.2.4.4 jdolecek * We get complete messages at ~10ms intervals. 90 1.2.4.4 jdolecek * 91 1.2.4.4 jdolecek * Setting blocksize to 4 x 1600 means that we send approx 33ms of audio. We 92 1.2.4.4 jdolecek * prefill by two blocks before starting audio meaning we have 50ms of latency. 93 1.2.4.4 jdolecek * 94 1.2.4.4 jdolecek * Six messages of 1600 bytes was chosen working back from a desired latency of 95 1.2.4.4 jdolecek * 50ms. 96 1.2.4.4 jdolecek */ 97 1.2.4.4 jdolecek 98 1.2.4.4 jdolecek #define VCAUDIO_MSGSIZE 1600 99 1.2.4.4 jdolecek #define VCAUDIO_NUMMSGS 4 100 1.2.4.4 jdolecek #define VCAUDIO_BLOCKSIZE (VCAUDIO_MSGSIZE * VCAUDIO_NUMMSGS) 101 1.2.4.4 jdolecek #define VCAUDIO_BUFFERSIZE 128000 102 1.2.4.4 jdolecek #define VCAUDIO_PREFILLCOUNT 2 103 1.2.4.2 tls 104 1.2.4.2 tls struct vcaudio_softc { 105 1.2.4.2 tls device_t sc_dev; 106 1.2.4.2 tls device_t sc_audiodev; 107 1.2.4.2 tls 108 1.2.4.4 jdolecek lwp_t *sc_lwp; 109 1.2.4.4 jdolecek 110 1.2.4.2 tls kmutex_t sc_lock; 111 1.2.4.2 tls kmutex_t sc_intr_lock; 112 1.2.4.4 jdolecek kcondvar_t sc_datacv; 113 1.2.4.3 tls 114 1.2.4.3 tls kmutex_t sc_msglock; 115 1.2.4.3 tls kcondvar_t sc_msgcv; 116 1.2.4.2 tls 117 1.2.4.2 tls struct audio_format sc_format; 118 1.2.4.2 tls struct audio_encoding_set *sc_encodings; 119 1.2.4.2 tls 120 1.2.4.2 tls void (*sc_pint)(void *); 121 1.2.4.2 tls void *sc_pintarg; 122 1.2.4.2 tls audio_params_t sc_pparam; 123 1.2.4.2 tls bool sc_started; 124 1.2.4.4 jdolecek int sc_pblkcnt; // prefill block count 125 1.2.4.4 jdolecek int sc_abytes; // available bytes 126 1.2.4.4 jdolecek int sc_pbytes; // played bytes 127 1.2.4.2 tls off_t sc_ppos; 128 1.2.4.2 tls void *sc_pstart; 129 1.2.4.2 tls void *sc_pend; 130 1.2.4.2 tls int sc_pblksize; 131 1.2.4.2 tls 132 1.2.4.3 tls bool sc_msgdone; 133 1.2.4.2 tls int sc_success; 134 1.2.4.2 tls 135 1.2.4.2 tls VCHI_INSTANCE_T sc_instance; 136 1.2.4.2 tls VCHI_CONNECTION_T sc_connection; 137 1.2.4.2 tls VCHI_SERVICE_HANDLE_T sc_service; 138 1.2.4.2 tls 139 1.2.4.4 jdolecek short sc_peer_version; 140 1.2.4.2 tls 141 1.2.4.4 jdolecek int sc_hwvol[3]; 142 1.2.4.2 tls enum vcaudio_dest sc_dest; 143 1.2.4.4 jdolecek 144 1.2.4.4 jdolecek uint8_t sc_swvol; 145 1.2.4.2 tls }; 146 1.2.4.2 tls 147 1.2.4.2 tls static int vcaudio_match(device_t, cfdata_t, void *); 148 1.2.4.2 tls static void vcaudio_attach(device_t, device_t, void *); 149 1.2.4.2 tls static int vcaudio_rescan(device_t, const char *, const int *); 150 1.2.4.2 tls static void vcaudio_childdet(device_t, device_t); 151 1.2.4.2 tls 152 1.2.4.2 tls static int vcaudio_init(struct vcaudio_softc *); 153 1.2.4.2 tls static void vcaudio_service_callback(void *, 154 1.2.4.4 jdolecek const VCHI_CALLBACK_REASON_T, void *); 155 1.2.4.4 jdolecek static int vcaudio_msg_sync(struct vcaudio_softc *, VC_AUDIO_MSG_T *, 156 1.2.4.4 jdolecek size_t); 157 1.2.4.4 jdolecek static void vcaudio_worker(void *); 158 1.2.4.2 tls 159 1.2.4.2 tls static int vcaudio_open(void *, int); 160 1.2.4.2 tls static void vcaudio_close(void *); 161 1.2.4.2 tls static int vcaudio_query_encoding(void *, struct audio_encoding *); 162 1.2.4.2 tls static int vcaudio_set_params(void *, int, int, 163 1.2.4.4 jdolecek audio_params_t *, audio_params_t *, 164 1.2.4.4 jdolecek stream_filter_list_t *, stream_filter_list_t *); 165 1.2.4.2 tls static int vcaudio_halt_output(void *); 166 1.2.4.2 tls static int vcaudio_halt_input(void *); 167 1.2.4.2 tls static int vcaudio_set_port(void *, mixer_ctrl_t *); 168 1.2.4.2 tls static int vcaudio_get_port(void *, mixer_ctrl_t *); 169 1.2.4.2 tls static int vcaudio_query_devinfo(void *, mixer_devinfo_t *); 170 1.2.4.2 tls static int vcaudio_getdev(void *, struct audio_device *); 171 1.2.4.2 tls static int vcaudio_get_props(void *); 172 1.2.4.4 jdolecek 173 1.2.4.4 jdolecek static int vcaudio_round_blocksize(void *, int, int, 174 1.2.4.4 jdolecek const audio_params_t *); 175 1.2.4.2 tls static size_t vcaudio_round_buffersize(void *, int, size_t); 176 1.2.4.4 jdolecek 177 1.2.4.2 tls static int vcaudio_trigger_output(void *, void *, void *, int, 178 1.2.4.4 jdolecek void (*)(void *), void *, const audio_params_t *); 179 1.2.4.2 tls static int vcaudio_trigger_input(void *, void *, void *, int, 180 1.2.4.4 jdolecek void (*)(void *), void *, const audio_params_t *); 181 1.2.4.4 jdolecek 182 1.2.4.2 tls static void vcaudio_get_locks(void *, kmutex_t **, kmutex_t **); 183 1.2.4.2 tls 184 1.2.4.4 jdolecek static stream_filter_t *vcaudio_swvol_filter(struct audio_softc *, 185 1.2.4.4 jdolecek const audio_params_t *, const audio_params_t *); 186 1.2.4.4 jdolecek static void vcaudio_swvol_dtor(stream_filter_t *); 187 1.2.4.4 jdolecek 188 1.2.4.2 tls static const struct audio_hw_if vcaudio_hw_if = { 189 1.2.4.2 tls .open = vcaudio_open, 190 1.2.4.2 tls .close = vcaudio_close, 191 1.2.4.2 tls .query_encoding = vcaudio_query_encoding, 192 1.2.4.2 tls .set_params = vcaudio_set_params, 193 1.2.4.2 tls .halt_output = vcaudio_halt_output, 194 1.2.4.2 tls .halt_input = vcaudio_halt_input, 195 1.2.4.2 tls .getdev = vcaudio_getdev, 196 1.2.4.2 tls .set_port = vcaudio_set_port, 197 1.2.4.2 tls .get_port = vcaudio_get_port, 198 1.2.4.2 tls .query_devinfo = vcaudio_query_devinfo, 199 1.2.4.2 tls .get_props = vcaudio_get_props, 200 1.2.4.2 tls .round_blocksize = vcaudio_round_blocksize, 201 1.2.4.2 tls .round_buffersize = vcaudio_round_buffersize, 202 1.2.4.2 tls .trigger_output = vcaudio_trigger_output, 203 1.2.4.2 tls .trigger_input = vcaudio_trigger_input, 204 1.2.4.2 tls .get_locks = vcaudio_get_locks, 205 1.2.4.2 tls }; 206 1.2.4.2 tls 207 1.2.4.2 tls CFATTACH_DECL2_NEW(vcaudio, sizeof(struct vcaudio_softc), 208 1.2.4.4 jdolecek vcaudio_match, vcaudio_attach, NULL, NULL, vcaudio_rescan, 209 1.2.4.4 jdolecek vcaudio_childdet); 210 1.2.4.2 tls 211 1.2.4.2 tls static int 212 1.2.4.2 tls vcaudio_match(device_t parent, cfdata_t match, void *aux) 213 1.2.4.2 tls { 214 1.2.4.2 tls struct vchiq_attach_args *vaa = aux; 215 1.2.4.2 tls 216 1.2.4.2 tls return !strcmp(vaa->vaa_name, "AUDS"); 217 1.2.4.2 tls } 218 1.2.4.2 tls 219 1.2.4.2 tls static void 220 1.2.4.2 tls vcaudio_attach(device_t parent, device_t self, void *aux) 221 1.2.4.2 tls { 222 1.2.4.2 tls struct vcaudio_softc *sc = device_private(self); 223 1.2.4.2 tls int error; 224 1.2.4.2 tls 225 1.2.4.2 tls sc->sc_dev = self; 226 1.2.4.2 tls mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE); 227 1.2.4.3 tls mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_NONE); 228 1.2.4.3 tls mutex_init(&sc->sc_msglock, MUTEX_DEFAULT, IPL_NONE); 229 1.2.4.4 jdolecek cv_init(&sc->sc_msgcv, "msg"); 230 1.2.4.4 jdolecek cv_init(&sc->sc_datacv, "data"); 231 1.2.4.3 tls sc->sc_success = -1; 232 1.2.4.4 jdolecek 233 1.2.4.4 jdolecek error = kthread_create(PRI_BIO, KTHREAD_MPSAFE, NULL, vcaudio_worker, 234 1.2.4.4 jdolecek sc, &sc->sc_lwp, "vcaudio"); 235 1.2.4.2 tls if (error) { 236 1.2.4.4 jdolecek aprint_error(": couldn't create thread (%d)\n", error); 237 1.2.4.2 tls return; 238 1.2.4.2 tls } 239 1.2.4.2 tls 240 1.2.4.2 tls aprint_naive("\n"); 241 1.2.4.4 jdolecek aprint_normal(": auds\n"); 242 1.2.4.2 tls 243 1.2.4.4 jdolecek error = vcaudio_rescan(self, NULL, NULL); 244 1.2.4.4 jdolecek if (error) 245 1.2.4.2 tls aprint_error_dev(self, "not configured\n"); 246 1.2.4.2 tls 247 1.2.4.2 tls } 248 1.2.4.2 tls 249 1.2.4.2 tls static int 250 1.2.4.2 tls vcaudio_rescan(device_t self, const char *ifattr, const int *locs) 251 1.2.4.2 tls { 252 1.2.4.2 tls struct vcaudio_softc *sc = device_private(self); 253 1.2.4.4 jdolecek int error; 254 1.2.4.2 tls 255 1.2.4.2 tls if (ifattr_match(ifattr, "audiobus") && sc->sc_audiodev == NULL) { 256 1.2.4.4 jdolecek error = vcaudio_init(sc); 257 1.2.4.4 jdolecek if (error) { 258 1.2.4.4 jdolecek return error; 259 1.2.4.4 jdolecek } 260 1.2.4.4 jdolecek 261 1.2.4.2 tls sc->sc_audiodev = audio_attach_mi(&vcaudio_hw_if, 262 1.2.4.2 tls sc, sc->sc_dev); 263 1.2.4.2 tls } 264 1.2.4.2 tls return 0; 265 1.2.4.2 tls } 266 1.2.4.2 tls 267 1.2.4.2 tls static void 268 1.2.4.2 tls vcaudio_childdet(device_t self, device_t child) 269 1.2.4.2 tls { 270 1.2.4.2 tls struct vcaudio_softc *sc = device_private(self); 271 1.2.4.2 tls 272 1.2.4.2 tls if (sc->sc_audiodev == child) 273 1.2.4.2 tls sc->sc_audiodev = NULL; 274 1.2.4.2 tls } 275 1.2.4.2 tls 276 1.2.4.2 tls static int 277 1.2.4.2 tls vcaudio_init(struct vcaudio_softc *sc) 278 1.2.4.2 tls { 279 1.2.4.2 tls VC_AUDIO_MSG_T msg; 280 1.2.4.2 tls int error; 281 1.2.4.2 tls 282 1.2.4.4 jdolecek sc->sc_swvol = 255; 283 1.2.4.4 jdolecek sc->sc_hwvol[VCAUDIO_DEST_AUTO] = 255; 284 1.2.4.4 jdolecek sc->sc_hwvol[VCAUDIO_DEST_HP] = 255; 285 1.2.4.4 jdolecek sc->sc_hwvol[VCAUDIO_DEST_HDMI] = 255; 286 1.2.4.2 tls sc->sc_dest = VCAUDIO_DEST_AUTO; 287 1.2.4.2 tls 288 1.2.4.2 tls sc->sc_format.mode = AUMODE_PLAY|AUMODE_RECORD; 289 1.2.4.2 tls sc->sc_format.encoding = AUDIO_ENCODING_SLINEAR_LE; 290 1.2.4.2 tls sc->sc_format.validbits = 16; 291 1.2.4.2 tls sc->sc_format.precision = 16; 292 1.2.4.2 tls sc->sc_format.channels = 2; 293 1.2.4.2 tls sc->sc_format.channel_mask = AUFMT_STEREO; 294 1.2.4.2 tls sc->sc_format.frequency_type = 0; 295 1.2.4.4 jdolecek sc->sc_format.frequency[0] = 48000; 296 1.2.4.2 tls sc->sc_format.frequency[1] = 48000; 297 1.2.4.2 tls 298 1.2.4.2 tls error = auconv_create_encodings(&sc->sc_format, 1, &sc->sc_encodings); 299 1.2.4.2 tls if (error) { 300 1.2.4.2 tls aprint_error_dev(sc->sc_dev, 301 1.2.4.2 tls "couldn't create encodings (error=%d)\n", error); 302 1.2.4.2 tls return error; 303 1.2.4.2 tls } 304 1.2.4.2 tls 305 1.2.4.2 tls error = vchi_initialise(&sc->sc_instance); 306 1.2.4.2 tls if (error) { 307 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, 308 1.2.4.4 jdolecek "couldn't init vchi instance (%d)\n", error); 309 1.2.4.2 tls return EIO; 310 1.2.4.2 tls } 311 1.2.4.2 tls 312 1.2.4.2 tls error = vchi_connect(NULL, 0, sc->sc_instance); 313 1.2.4.2 tls if (error) { 314 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, 315 1.2.4.4 jdolecek "couldn't connect vchi (%d)\n", error); 316 1.2.4.2 tls return EIO; 317 1.2.4.2 tls } 318 1.2.4.2 tls 319 1.2.4.2 tls SERVICE_CREATION_T setup = { 320 1.2.4.2 tls .version = VCHI_VERSION(VC_AUDIOSERV_VER), 321 1.2.4.2 tls .service_id = VC_AUDIO_SERVER_NAME, 322 1.2.4.2 tls .connection = &sc->sc_connection, 323 1.2.4.2 tls .rx_fifo_size = 0, 324 1.2.4.2 tls .tx_fifo_size = 0, 325 1.2.4.2 tls .callback = vcaudio_service_callback, 326 1.2.4.2 tls .callback_param = sc, 327 1.2.4.2 tls .want_unaligned_bulk_rx = 1, 328 1.2.4.2 tls .want_unaligned_bulk_tx = 1, 329 1.2.4.2 tls .want_crc = 0, 330 1.2.4.2 tls }; 331 1.2.4.2 tls 332 1.2.4.2 tls error = vchi_service_open(sc->sc_instance, &setup, &sc->sc_service); 333 1.2.4.2 tls if (error) { 334 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, "couldn't open service (%d)\n", 335 1.2.4.2 tls error); 336 1.2.4.2 tls return EIO; 337 1.2.4.2 tls } 338 1.2.4.2 tls 339 1.2.4.4 jdolecek vchi_get_peer_version(sc->sc_service, &sc->sc_peer_version); 340 1.2.4.4 jdolecek 341 1.2.4.4 jdolecek if (sc->sc_peer_version < 2) { 342 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, 343 1.2.4.4 jdolecek "peer version (%d) is less than the required version (2)\n", 344 1.2.4.4 jdolecek sc->sc_peer_version); 345 1.2.4.4 jdolecek return EINVAL; 346 1.2.4.4 jdolecek } 347 1.2.4.4 jdolecek 348 1.2.4.2 tls memset(&msg, 0, sizeof(msg)); 349 1.2.4.2 tls msg.type = VC_AUDIO_MSG_TYPE_OPEN; 350 1.2.4.2 tls error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg), 351 1.2.4.2 tls VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL); 352 1.2.4.2 tls if (error) { 353 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, 354 1.2.4.4 jdolecek "couldn't send OPEN message (%d)\n", error); 355 1.2.4.4 jdolecek } 356 1.2.4.4 jdolecek 357 1.2.4.4 jdolecek memset(&msg, 0, sizeof(msg)); 358 1.2.4.4 jdolecek msg.type = VC_AUDIO_MSG_TYPE_CONFIG; 359 1.2.4.4 jdolecek msg.u.config.channels = 2; 360 1.2.4.4 jdolecek msg.u.config.samplerate = 48000; 361 1.2.4.4 jdolecek msg.u.config.bps = 16; 362 1.2.4.4 jdolecek error = vcaudio_msg_sync(sc, &msg, sizeof(msg)); 363 1.2.4.4 jdolecek if (error) { 364 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, 365 1.2.4.4 jdolecek "couldn't send CONFIG message (%d)\n", error); 366 1.2.4.2 tls } 367 1.2.4.2 tls 368 1.2.4.2 tls memset(&msg, 0, sizeof(msg)); 369 1.2.4.2 tls msg.type = VC_AUDIO_MSG_TYPE_CONTROL; 370 1.2.4.4 jdolecek msg.u.control.volume = vol2vc(sc->sc_hwvol[sc->sc_dest]); 371 1.2.4.4 jdolecek msg.u.control.dest = sc->sc_dest; 372 1.2.4.2 tls error = vcaudio_msg_sync(sc, &msg, sizeof(msg)); 373 1.2.4.2 tls if (error) { 374 1.2.4.4 jdolecek aprint_error_dev(sc->sc_dev, 375 1.2.4.4 jdolecek "couldn't send CONTROL message (%d)\n", error); 376 1.2.4.2 tls } 377 1.2.4.4 jdolecek 378 1.2.4.2 tls vchi_service_release(sc->sc_service); 379 1.2.4.2 tls 380 1.2.4.2 tls return 0; 381 1.2.4.2 tls } 382 1.2.4.2 tls 383 1.2.4.2 tls static void 384 1.2.4.2 tls vcaudio_service_callback(void *priv, const VCHI_CALLBACK_REASON_T reason, 385 1.2.4.2 tls void *msg_handle) 386 1.2.4.2 tls { 387 1.2.4.2 tls struct vcaudio_softc *sc = priv; 388 1.2.4.2 tls VC_AUDIO_MSG_T msg; 389 1.2.4.2 tls int32_t msglen = 0; 390 1.2.4.2 tls int error; 391 1.2.4.2 tls void (*intr)(void *) = NULL; 392 1.2.4.2 tls void *intrarg = NULL; 393 1.2.4.2 tls 394 1.2.4.2 tls if (sc == NULL || reason != VCHI_CALLBACK_MSG_AVAILABLE) 395 1.2.4.2 tls return; 396 1.2.4.2 tls 397 1.2.4.2 tls memset(&msg, 0, sizeof(msg)); 398 1.2.4.2 tls error = vchi_msg_dequeue(sc->sc_service, &msg, sizeof(msg), &msglen, 399 1.2.4.2 tls VCHI_FLAGS_NONE); 400 1.2.4.2 tls if (error) { 401 1.2.4.2 tls device_printf(sc->sc_dev, "couldn't dequeue msg (%d)\n", 402 1.2.4.2 tls error); 403 1.2.4.2 tls return; 404 1.2.4.2 tls } 405 1.2.4.2 tls 406 1.2.4.2 tls switch (msg.type) { 407 1.2.4.2 tls case VC_AUDIO_MSG_TYPE_RESULT: 408 1.2.4.3 tls mutex_enter(&sc->sc_msglock); 409 1.2.4.2 tls sc->sc_success = msg.u.result.success; 410 1.2.4.3 tls sc->sc_msgdone = true; 411 1.2.4.3 tls cv_broadcast(&sc->sc_msgcv); 412 1.2.4.3 tls mutex_exit(&sc->sc_msglock); 413 1.2.4.2 tls break; 414 1.2.4.4 jdolecek 415 1.2.4.2 tls case VC_AUDIO_MSG_TYPE_COMPLETE: 416 1.2.4.2 tls intr = msg.u.complete.callback; 417 1.2.4.2 tls intrarg = msg.u.complete.cookie; 418 1.2.4.2 tls if (intr && intrarg) { 419 1.2.4.4 jdolecek int count = msg.u.complete.count & 0xffff; 420 1.2.4.4 jdolecek int perr = (msg.u.complete.count & __BIT(30)) != 0; 421 1.2.4.4 jdolecek bool sched = false; 422 1.2.4.4 jdolecek 423 1.2.4.3 tls mutex_enter(&sc->sc_intr_lock); 424 1.2.4.4 jdolecek 425 1.2.4.4 jdolecek if (count > 0) { 426 1.2.4.4 jdolecek sc->sc_pbytes += count; 427 1.2.4.4 jdolecek } 428 1.2.4.4 jdolecek if (perr && sc->sc_started) { 429 1.2.4.4 jdolecek #ifdef VCAUDIO_DEBUG 430 1.2.4.4 jdolecek device_printf(sc->sc_dev, "underrun\n"); 431 1.2.4.4 jdolecek #endif 432 1.2.4.4 jdolecek sched = true; 433 1.2.4.2 tls } 434 1.2.4.2 tls if (sc->sc_pbytes >= sc->sc_pblksize) { 435 1.2.4.2 tls sc->sc_pbytes -= sc->sc_pblksize; 436 1.2.4.4 jdolecek sched = true; 437 1.2.4.4 jdolecek } 438 1.2.4.4 jdolecek 439 1.2.4.4 jdolecek if (sched && sc->sc_pint) { 440 1.2.4.2 tls intr(intrarg); 441 1.2.4.4 jdolecek sc->sc_abytes += sc->sc_pblksize; 442 1.2.4.4 jdolecek cv_signal(&sc->sc_datacv); 443 1.2.4.2 tls } 444 1.2.4.3 tls mutex_exit(&sc->sc_intr_lock); 445 1.2.4.2 tls } 446 1.2.4.2 tls break; 447 1.2.4.2 tls default: 448 1.2.4.2 tls break; 449 1.2.4.2 tls } 450 1.2.4.2 tls } 451 1.2.4.2 tls 452 1.2.4.2 tls static void 453 1.2.4.4 jdolecek vcaudio_worker(void *priv) 454 1.2.4.2 tls { 455 1.2.4.2 tls struct vcaudio_softc *sc = priv; 456 1.2.4.2 tls VC_AUDIO_MSG_T msg; 457 1.2.4.2 tls void (*intr)(void *); 458 1.2.4.2 tls void *intrarg; 459 1.2.4.2 tls void *block; 460 1.2.4.2 tls int error, resid, off, nb, count; 461 1.2.4.2 tls 462 1.2.4.2 tls mutex_enter(&sc->sc_intr_lock); 463 1.2.4.2 tls 464 1.2.4.4 jdolecek while (true) { 465 1.2.4.4 jdolecek intr = sc->sc_pint; 466 1.2.4.4 jdolecek intrarg = sc->sc_pintarg; 467 1.2.4.4 jdolecek 468 1.2.4.4 jdolecek if (intr == NULL || intrarg == NULL) { 469 1.2.4.4 jdolecek cv_wait_sig(&sc->sc_datacv, &sc->sc_intr_lock); 470 1.2.4.4 jdolecek continue; 471 1.2.4.4 jdolecek } 472 1.2.4.2 tls 473 1.2.4.4 jdolecek KASSERT(sc->sc_pblksize != 0); 474 1.2.4.2 tls 475 1.2.4.4 jdolecek if (sc->sc_abytes < sc->sc_pblksize) { 476 1.2.4.4 jdolecek cv_wait_sig(&sc->sc_datacv, &sc->sc_intr_lock); 477 1.2.4.4 jdolecek continue; 478 1.2.4.2 tls } 479 1.2.4.4 jdolecek count = sc->sc_pblksize; 480 1.2.4.2 tls 481 1.2.4.2 tls memset(&msg, 0, sizeof(msg)); 482 1.2.4.4 jdolecek msg.type = VC_AUDIO_MSG_TYPE_WRITE; 483 1.2.4.4 jdolecek msg.u.write.max_packet = VCAUDIO_MSGSIZE; 484 1.2.4.4 jdolecek msg.u.write.count = count; 485 1.2.4.4 jdolecek msg.u.write.callback = intr; 486 1.2.4.4 jdolecek msg.u.write.cookie = intrarg; 487 1.2.4.4 jdolecek msg.u.write.silence = 0; 488 1.2.4.4 jdolecek 489 1.2.4.4 jdolecek block = (uint8_t *)sc->sc_pstart + sc->sc_ppos; 490 1.2.4.4 jdolecek resid = count; 491 1.2.4.4 jdolecek off = 0; 492 1.2.4.2 tls 493 1.2.4.4 jdolecek vchi_service_use(sc->sc_service); 494 1.2.4.2 tls 495 1.2.4.2 tls error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg), 496 1.2.4.2 tls VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL); 497 1.2.4.2 tls if (error) { 498 1.2.4.2 tls printf("%s: failed to write (%d)\n", __func__, error); 499 1.2.4.2 tls goto done; 500 1.2.4.2 tls } 501 1.2.4.2 tls 502 1.2.4.4 jdolecek while (resid > 0) { 503 1.2.4.4 jdolecek nb = min(resid, msg.u.write.max_packet); 504 1.2.4.4 jdolecek error = vchi_msg_queue(sc->sc_service, 505 1.2.4.4 jdolecek (char *)block + off, nb, 506 1.2.4.4 jdolecek VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL); 507 1.2.4.4 jdolecek if (error) { 508 1.2.4.4 jdolecek /* XXX What to do here? */ 509 1.2.4.4 jdolecek device_printf(sc->sc_dev, 510 1.2.4.4 jdolecek "failed to queue data (%d)\n", error); 511 1.2.4.4 jdolecek goto done; 512 1.2.4.4 jdolecek } 513 1.2.4.4 jdolecek off += nb; 514 1.2.4.4 jdolecek resid -= nb; 515 1.2.4.2 tls } 516 1.2.4.2 tls 517 1.2.4.4 jdolecek sc->sc_abytes -= count; 518 1.2.4.4 jdolecek sc->sc_ppos += count; 519 1.2.4.4 jdolecek if ((uint8_t *)sc->sc_pstart + sc->sc_ppos >= 520 1.2.4.4 jdolecek (uint8_t *)sc->sc_pend) 521 1.2.4.4 jdolecek sc->sc_ppos = 0; 522 1.2.4.4 jdolecek 523 1.2.4.4 jdolecek if (!sc->sc_started) { 524 1.2.4.4 jdolecek ++sc->sc_pblkcnt; 525 1.2.4.4 jdolecek 526 1.2.4.4 jdolecek if (sc->sc_pblkcnt == VCAUDIO_PREFILLCOUNT) { 527 1.2.4.4 jdolecek 528 1.2.4.4 jdolecek memset(&msg, 0, sizeof(msg)); 529 1.2.4.4 jdolecek msg.type = VC_AUDIO_MSG_TYPE_START; 530 1.2.4.4 jdolecek error = vchi_msg_queue(sc->sc_service, &msg, 531 1.2.4.4 jdolecek sizeof(msg), VCHI_FLAGS_BLOCK_UNTIL_QUEUED, 532 1.2.4.4 jdolecek NULL); 533 1.2.4.4 jdolecek if (error) { 534 1.2.4.4 jdolecek device_printf(sc->sc_dev, 535 1.2.4.4 jdolecek "failed to start (%d)\n", error); 536 1.2.4.4 jdolecek goto done; 537 1.2.4.4 jdolecek } 538 1.2.4.4 jdolecek sc->sc_started = true; 539 1.2.4.4 jdolecek sc->sc_pbytes = 0; 540 1.2.4.4 jdolecek } else { 541 1.2.4.4 jdolecek intr(intrarg); 542 1.2.4.4 jdolecek sc->sc_abytes += sc->sc_pblksize; 543 1.2.4.4 jdolecek } 544 1.2.4.4 jdolecek } 545 1.2.4.2 tls 546 1.2.4.2 tls done: 547 1.2.4.4 jdolecek vchi_service_release(sc->sc_service); 548 1.2.4.4 jdolecek } 549 1.2.4.2 tls } 550 1.2.4.2 tls 551 1.2.4.2 tls static int 552 1.2.4.2 tls vcaudio_msg_sync(struct vcaudio_softc *sc, VC_AUDIO_MSG_T *msg, size_t msglen) 553 1.2.4.2 tls { 554 1.2.4.2 tls int error = 0; 555 1.2.4.2 tls 556 1.2.4.3 tls mutex_enter(&sc->sc_msglock); 557 1.2.4.3 tls 558 1.2.4.2 tls sc->sc_success = -1; 559 1.2.4.3 tls sc->sc_msgdone = false; 560 1.2.4.3 tls 561 1.2.4.2 tls error = vchi_msg_queue(sc->sc_service, msg, msglen, 562 1.2.4.2 tls VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL); 563 1.2.4.2 tls if (error) { 564 1.2.4.2 tls printf("%s: failed to queue message (%d)\n", __func__, error); 565 1.2.4.2 tls goto done; 566 1.2.4.2 tls } 567 1.2.4.3 tls 568 1.2.4.3 tls while (!sc->sc_msgdone) { 569 1.2.4.3 tls error = cv_wait_sig(&sc->sc_msgcv, &sc->sc_msglock); 570 1.2.4.2 tls if (error) 571 1.2.4.2 tls break; 572 1.2.4.2 tls } 573 1.2.4.3 tls if (sc->sc_success != 0) 574 1.2.4.2 tls error = EIO; 575 1.2.4.2 tls done: 576 1.2.4.3 tls mutex_exit(&sc->sc_msglock); 577 1.2.4.2 tls 578 1.2.4.2 tls return error; 579 1.2.4.2 tls } 580 1.2.4.2 tls 581 1.2.4.2 tls static int 582 1.2.4.2 tls vcaudio_open(void *priv, int flags) 583 1.2.4.2 tls { 584 1.2.4.2 tls return 0; 585 1.2.4.2 tls } 586 1.2.4.2 tls 587 1.2.4.2 tls static void 588 1.2.4.2 tls vcaudio_close(void *priv) 589 1.2.4.2 tls { 590 1.2.4.2 tls } 591 1.2.4.2 tls 592 1.2.4.2 tls static int 593 1.2.4.2 tls vcaudio_query_encoding(void *priv, struct audio_encoding *ae) 594 1.2.4.2 tls { 595 1.2.4.2 tls struct vcaudio_softc *sc = priv; 596 1.2.4.2 tls 597 1.2.4.2 tls return auconv_query_encoding(sc->sc_encodings, ae); 598 1.2.4.2 tls } 599 1.2.4.2 tls 600 1.2.4.2 tls static int 601 1.2.4.2 tls vcaudio_set_params(void *priv, int setmode, int usemode, 602 1.2.4.2 tls audio_params_t *play, audio_params_t *rec, 603 1.2.4.2 tls stream_filter_list_t *pfil, stream_filter_list_t *rfil) 604 1.2.4.2 tls { 605 1.2.4.2 tls struct vcaudio_softc *sc = priv; 606 1.2.4.2 tls int index; 607 1.2.4.2 tls 608 1.2.4.2 tls if (play && (setmode & AUMODE_PLAY)) { 609 1.2.4.2 tls index = auconv_set_converter(&sc->sc_format, 1, 610 1.2.4.2 tls AUMODE_PLAY, play, true, pfil); 611 1.2.4.2 tls if (index < 0) 612 1.2.4.2 tls return EINVAL; 613 1.2.4.4 jdolecek if (pfil->req_size > 0) 614 1.2.4.4 jdolecek play = &pfil->filters[0].param; 615 1.2.4.4 jdolecek pfil->prepend(pfil, vcaudio_swvol_filter, play); 616 1.2.4.2 tls } 617 1.2.4.2 tls 618 1.2.4.2 tls return 0; 619 1.2.4.2 tls } 620 1.2.4.2 tls 621 1.2.4.2 tls static int 622 1.2.4.2 tls vcaudio_halt_output(void *priv) 623 1.2.4.2 tls { 624 1.2.4.2 tls struct vcaudio_softc *sc = priv; 625 1.2.4.2 tls VC_AUDIO_MSG_T msg; 626 1.2.4.2 tls int error = 0; 627 1.2.4.2 tls 628 1.2.4.4 jdolecek KASSERT(mutex_owned(&sc->sc_intr_lock)); 629 1.2.4.4 jdolecek 630 1.2.4.2 tls vchi_service_use(sc->sc_service); 631 1.2.4.2 tls memset(&msg, 0, sizeof(msg)); 632 1.2.4.2 tls msg.type = VC_AUDIO_MSG_TYPE_STOP; 633 1.2.4.4 jdolecek msg.u.stop.draining = 0; 634 1.2.4.2 tls error = vchi_msg_queue(sc->sc_service, &msg, sizeof(msg), 635 1.2.4.2 tls VCHI_FLAGS_BLOCK_UNTIL_QUEUED, NULL); 636 1.2.4.2 tls if (error) { 637 1.2.4.2 tls device_printf(sc->sc_dev, "couldn't send STOP message (%d)\n", 638 1.2.4.2 tls error); 639 1.2.4.2 tls } 640 1.2.4.2 tls vchi_service_release(sc->sc_service); 641 1.2.4.2 tls 642 1.2.4.2 tls sc->sc_pint = NULL; 643 1.2.4.2 tls sc->sc_pintarg = NULL; 644 1.2.4.2 tls sc->sc_started = false; 645 1.2.4.2 tls 646 1.2.4.2 tls #ifdef VCAUDIO_DEBUG 647 1.2.4.2 tls device_printf(sc->sc_dev, "halting output\n"); 648 1.2.4.2 tls #endif 649 1.2.4.2 tls 650 1.2.4.2 tls return error; 651 1.2.4.2 tls } 652 1.2.4.2 tls 653 1.2.4.2 tls static int 654 1.2.4.2 tls vcaudio_halt_input(void *priv) 655 1.2.4.2 tls { 656 1.2.4.2 tls return EINVAL; 657 1.2.4.2 tls } 658 1.2.4.2 tls 659 1.2.4.2 tls static int 660 1.2.4.4 jdolecek vcaudio_set_volume(struct vcaudio_softc *sc, enum vcaudio_dest dest, 661 1.2.4.4 jdolecek int hwvol) 662 1.2.4.2 tls { 663 1.2.4.2 tls VC_AUDIO_MSG_T msg; 664 1.2.4.2 tls int error; 665 1.2.4.2 tls 666 1.2.4.4 jdolecek sc->sc_hwvol[dest] = hwvol; 667 1.2.4.4 jdolecek if (dest != sc->sc_dest) 668 1.2.4.4 jdolecek return 0; 669 1.2.4.4 jdolecek 670 1.2.4.4 jdolecek vchi_service_use(sc->sc_service); 671 1.2.4.4 jdolecek 672 1.2.4.4 jdolecek memset(&msg, 0, sizeof(msg)); 673 1.2.4.4 jdolecek msg.type = VC_AUDIO_MSG_TYPE_CONTROL; 674 1.2.4.4 jdolecek msg.u.control.volume = vol2vc(hwvol); 675 1.2.4.4 jdolecek msg.u.control.dest = dest; 676 1.2.4.4 jdolecek 677 1.2.4.4 jdolecek error = vcaudio_msg_sync(sc, &msg, sizeof(msg)); 678 1.2.4.4 jdolecek if (error) { 679 1.2.4.4 jdolecek device_printf(sc->sc_dev, 680 1.2.4.4 jdolecek "couldn't send CONTROL message (%d)\n", error); 681 1.2.4.4 jdolecek } 682 1.2.4.4 jdolecek 683 1.2.4.4 jdolecek vchi_service_release(sc->sc_service); 684 1.2.4.4 jdolecek 685 1.2.4.4 jdolecek return error; 686 1.2.4.4 jdolecek } 687 1.2.4.4 jdolecek 688 1.2.4.4 jdolecek static int 689 1.2.4.4 jdolecek vcaudio_set_port(void *priv, mixer_ctrl_t *mc) 690 1.2.4.4 jdolecek { 691 1.2.4.4 jdolecek struct vcaudio_softc *sc = priv; 692 1.2.4.4 jdolecek 693 1.2.4.2 tls switch (mc->dev) { 694 1.2.4.2 tls case VCAUDIO_OUTPUT_MASTER_VOLUME: 695 1.2.4.2 tls case VCAUDIO_INPUT_DAC_VOLUME: 696 1.2.4.4 jdolecek sc->sc_swvol = mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]; 697 1.2.4.4 jdolecek return 0; 698 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_AUTO_VOLUME: 699 1.2.4.4 jdolecek return vcaudio_set_volume(sc, VCAUDIO_DEST_AUTO, 700 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]); 701 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_HEADPHONE_VOLUME: 702 1.2.4.4 jdolecek return vcaudio_set_volume(sc, VCAUDIO_DEST_HP, 703 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]); 704 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_HDMI_VOLUME: 705 1.2.4.4 jdolecek return vcaudio_set_volume(sc, VCAUDIO_DEST_HDMI, 706 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT]); 707 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_SELECT: 708 1.2.4.4 jdolecek if (mc->un.ord < 0 || mc->un.ord > 2) 709 1.2.4.4 jdolecek return EINVAL; 710 1.2.4.4 jdolecek sc->sc_dest = mc->un.ord; 711 1.2.4.4 jdolecek return vcaudio_set_volume(sc, mc->un.ord, 712 1.2.4.4 jdolecek sc->sc_hwvol[mc->un.ord]); 713 1.2.4.2 tls } 714 1.2.4.2 tls return ENXIO; 715 1.2.4.2 tls } 716 1.2.4.2 tls 717 1.2.4.2 tls static int 718 1.2.4.2 tls vcaudio_get_port(void *priv, mixer_ctrl_t *mc) 719 1.2.4.2 tls { 720 1.2.4.2 tls struct vcaudio_softc *sc = priv; 721 1.2.4.2 tls 722 1.2.4.2 tls switch (mc->dev) { 723 1.2.4.2 tls case VCAUDIO_OUTPUT_MASTER_VOLUME: 724 1.2.4.2 tls case VCAUDIO_INPUT_DAC_VOLUME: 725 1.2.4.2 tls mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = 726 1.2.4.2 tls mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = 727 1.2.4.4 jdolecek sc->sc_swvol; 728 1.2.4.4 jdolecek return 0; 729 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_AUTO_VOLUME: 730 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = 731 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = 732 1.2.4.4 jdolecek sc->sc_hwvol[VCAUDIO_DEST_AUTO]; 733 1.2.4.4 jdolecek return 0; 734 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_HEADPHONE_VOLUME: 735 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = 736 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = 737 1.2.4.4 jdolecek sc->sc_hwvol[VCAUDIO_DEST_HP]; 738 1.2.4.4 jdolecek return 0; 739 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_HDMI_VOLUME: 740 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_LEFT] = 741 1.2.4.4 jdolecek mc->un.value.level[AUDIO_MIXER_LEVEL_RIGHT] = 742 1.2.4.4 jdolecek sc->sc_hwvol[VCAUDIO_DEST_HDMI]; 743 1.2.4.4 jdolecek return 0; 744 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_SELECT: 745 1.2.4.4 jdolecek mc->un.ord = sc->sc_dest; 746 1.2.4.2 tls return 0; 747 1.2.4.2 tls } 748 1.2.4.2 tls return ENXIO; 749 1.2.4.2 tls } 750 1.2.4.2 tls 751 1.2.4.2 tls static int 752 1.2.4.2 tls vcaudio_query_devinfo(void *priv, mixer_devinfo_t *di) 753 1.2.4.2 tls { 754 1.2.4.2 tls switch (di->index) { 755 1.2.4.2 tls case VCAUDIO_OUTPUT_CLASS: 756 1.2.4.2 tls di->mixer_class = VCAUDIO_OUTPUT_CLASS; 757 1.2.4.2 tls strcpy(di->label.name, AudioCoutputs); 758 1.2.4.2 tls di->type = AUDIO_MIXER_CLASS; 759 1.2.4.2 tls di->next = di->prev = AUDIO_MIXER_LAST; 760 1.2.4.2 tls return 0; 761 1.2.4.2 tls case VCAUDIO_INPUT_CLASS: 762 1.2.4.2 tls di->mixer_class = VCAUDIO_INPUT_CLASS; 763 1.2.4.2 tls strcpy(di->label.name, AudioCinputs); 764 1.2.4.2 tls di->type = AUDIO_MIXER_CLASS; 765 1.2.4.2 tls di->next = di->prev = AUDIO_MIXER_LAST; 766 1.2.4.2 tls return 0; 767 1.2.4.2 tls case VCAUDIO_OUTPUT_MASTER_VOLUME: 768 1.2.4.2 tls di->mixer_class = VCAUDIO_OUTPUT_CLASS; 769 1.2.4.2 tls strcpy(di->label.name, AudioNmaster); 770 1.2.4.2 tls di->type = AUDIO_MIXER_VALUE; 771 1.2.4.2 tls di->next = di->prev = AUDIO_MIXER_LAST; 772 1.2.4.2 tls di->un.v.num_channels = 2; 773 1.2.4.2 tls strcpy(di->un.v.units.name, AudioNvolume); 774 1.2.4.2 tls return 0; 775 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_AUTO_VOLUME: 776 1.2.4.4 jdolecek di->mixer_class = VCAUDIO_OUTPUT_CLASS; 777 1.2.4.4 jdolecek strcpy(di->label.name, "auto"); 778 1.2.4.4 jdolecek di->type = AUDIO_MIXER_VALUE; 779 1.2.4.4 jdolecek di->next = di->prev = AUDIO_MIXER_LAST; 780 1.2.4.4 jdolecek di->un.v.num_channels = 2; 781 1.2.4.4 jdolecek di->un.v.delta = 13; 782 1.2.4.4 jdolecek strcpy(di->un.v.units.name, AudioNvolume); 783 1.2.4.4 jdolecek return 0; 784 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_HEADPHONE_VOLUME: 785 1.2.4.4 jdolecek di->mixer_class = VCAUDIO_OUTPUT_CLASS; 786 1.2.4.4 jdolecek strcpy(di->label.name, AudioNheadphone); 787 1.2.4.4 jdolecek di->type = AUDIO_MIXER_VALUE; 788 1.2.4.4 jdolecek di->next = di->prev = AUDIO_MIXER_LAST; 789 1.2.4.4 jdolecek di->un.v.num_channels = 2; 790 1.2.4.4 jdolecek di->un.v.delta = 13; 791 1.2.4.4 jdolecek strcpy(di->un.v.units.name, AudioNvolume); 792 1.2.4.4 jdolecek return 0; 793 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_HDMI_VOLUME: 794 1.2.4.4 jdolecek di->mixer_class = VCAUDIO_OUTPUT_CLASS; 795 1.2.4.4 jdolecek strcpy(di->label.name, "hdmi"); 796 1.2.4.4 jdolecek di->type = AUDIO_MIXER_VALUE; 797 1.2.4.4 jdolecek di->next = di->prev = AUDIO_MIXER_LAST; 798 1.2.4.4 jdolecek di->un.v.num_channels = 2; 799 1.2.4.4 jdolecek di->un.v.delta = 13; 800 1.2.4.4 jdolecek strcpy(di->un.v.units.name, AudioNvolume); 801 1.2.4.4 jdolecek return 0; 802 1.2.4.2 tls case VCAUDIO_INPUT_DAC_VOLUME: 803 1.2.4.2 tls di->mixer_class = VCAUDIO_INPUT_CLASS; 804 1.2.4.2 tls strcpy(di->label.name, AudioNdac); 805 1.2.4.2 tls di->type = AUDIO_MIXER_VALUE; 806 1.2.4.2 tls di->next = di->prev = AUDIO_MIXER_LAST; 807 1.2.4.2 tls di->un.v.num_channels = 2; 808 1.2.4.2 tls strcpy(di->un.v.units.name, AudioNvolume); 809 1.2.4.2 tls return 0; 810 1.2.4.4 jdolecek case VCAUDIO_OUTPUT_SELECT: 811 1.2.4.4 jdolecek di->mixer_class = VCAUDIO_OUTPUT_CLASS; 812 1.2.4.4 jdolecek strcpy(di->label.name, AudioNselect); 813 1.2.4.4 jdolecek di->type = AUDIO_MIXER_ENUM; 814 1.2.4.4 jdolecek di->next = di->prev = AUDIO_MIXER_LAST; 815 1.2.4.4 jdolecek di->un.e.num_mem = 3; 816 1.2.4.4 jdolecek di->un.e.member[0].ord = 0; 817 1.2.4.4 jdolecek strcpy(di->un.e.member[0].label.name, "auto"); 818 1.2.4.4 jdolecek di->un.e.member[1].ord = 1; 819 1.2.4.4 jdolecek strcpy(di->un.e.member[1].label.name, AudioNheadphone); 820 1.2.4.4 jdolecek di->un.e.member[2].ord = 2; 821 1.2.4.4 jdolecek strcpy(di->un.e.member[2].label.name, "hdmi"); 822 1.2.4.4 jdolecek return 0; 823 1.2.4.2 tls } 824 1.2.4.2 tls 825 1.2.4.2 tls return ENXIO; 826 1.2.4.2 tls } 827 1.2.4.2 tls 828 1.2.4.2 tls static int 829 1.2.4.2 tls vcaudio_getdev(void *priv, struct audio_device *audiodev) 830 1.2.4.2 tls { 831 1.2.4.4 jdolecek struct vcaudio_softc *sc = priv; 832 1.2.4.4 jdolecek 833 1.2.4.4 jdolecek snprintf(audiodev->name, sizeof(audiodev->name), "vchiq auds"); 834 1.2.4.4 jdolecek snprintf(audiodev->version, sizeof(audiodev->version), 835 1.2.4.4 jdolecek "%d", sc->sc_peer_version); 836 1.2.4.2 tls snprintf(audiodev->config, sizeof(audiodev->config), "vcaudio"); 837 1.2.4.4 jdolecek 838 1.2.4.2 tls return 0; 839 1.2.4.2 tls } 840 1.2.4.2 tls 841 1.2.4.2 tls static int 842 1.2.4.2 tls vcaudio_get_props(void *priv) 843 1.2.4.2 tls { 844 1.2.4.2 tls return AUDIO_PROP_PLAYBACK|AUDIO_PROP_CAPTURE|AUDIO_PROP_INDEPENDENT; 845 1.2.4.2 tls } 846 1.2.4.2 tls 847 1.2.4.2 tls static int 848 1.2.4.2 tls vcaudio_round_blocksize(void *priv, int bs, int mode, 849 1.2.4.2 tls const audio_params_t *params) 850 1.2.4.2 tls { 851 1.2.4.4 jdolecek return VCAUDIO_BLOCKSIZE; 852 1.2.4.2 tls } 853 1.2.4.2 tls 854 1.2.4.2 tls static size_t 855 1.2.4.2 tls vcaudio_round_buffersize(void *priv, int direction, size_t bufsize) 856 1.2.4.2 tls { 857 1.2.4.2 tls 858 1.2.4.4 jdolecek return VCAUDIO_BUFFERSIZE; 859 1.2.4.2 tls } 860 1.2.4.2 tls 861 1.2.4.2 tls static int 862 1.2.4.2 tls vcaudio_trigger_output(void *priv, void *start, void *end, int blksize, 863 1.2.4.2 tls void (*intr)(void *), void *intrarg, const audio_params_t *params) 864 1.2.4.2 tls { 865 1.2.4.2 tls struct vcaudio_softc *sc = priv; 866 1.2.4.2 tls 867 1.2.4.4 jdolecek ASSERT_SLEEPABLE(); 868 1.2.4.4 jdolecek KASSERT(mutex_owned(&sc->sc_intr_lock)); 869 1.2.4.4 jdolecek 870 1.2.4.2 tls sc->sc_pparam = *params; 871 1.2.4.2 tls sc->sc_pint = intr; 872 1.2.4.2 tls sc->sc_pintarg = intrarg; 873 1.2.4.2 tls sc->sc_ppos = 0; 874 1.2.4.2 tls sc->sc_pstart = start; 875 1.2.4.2 tls sc->sc_pend = end; 876 1.2.4.2 tls sc->sc_pblksize = blksize; 877 1.2.4.4 jdolecek sc->sc_pblkcnt = 0; 878 1.2.4.4 jdolecek sc->sc_pbytes = 0; 879 1.2.4.4 jdolecek sc->sc_abytes = blksize; 880 1.2.4.4 jdolecek 881 1.2.4.4 jdolecek cv_signal(&sc->sc_datacv); 882 1.2.4.2 tls 883 1.2.4.2 tls return 0; 884 1.2.4.2 tls } 885 1.2.4.2 tls 886 1.2.4.2 tls static int 887 1.2.4.2 tls vcaudio_trigger_input(void *priv, void *start, void *end, int blksize, 888 1.2.4.2 tls void (*intr)(void *), void *intrarg, const audio_params_t *params) 889 1.2.4.2 tls { 890 1.2.4.2 tls return EINVAL; 891 1.2.4.2 tls } 892 1.2.4.2 tls 893 1.2.4.2 tls static void 894 1.2.4.2 tls vcaudio_get_locks(void *priv, kmutex_t **intr, kmutex_t **thread) 895 1.2.4.2 tls { 896 1.2.4.2 tls struct vcaudio_softc *sc = priv; 897 1.2.4.2 tls 898 1.2.4.2 tls *intr = &sc->sc_intr_lock; 899 1.2.4.2 tls *thread = &sc->sc_lock; 900 1.2.4.2 tls } 901 1.2.4.4 jdolecek 902 1.2.4.4 jdolecek static stream_filter_t * 903 1.2.4.4 jdolecek vcaudio_swvol_filter(struct audio_softc *asc, 904 1.2.4.4 jdolecek const audio_params_t *from, const audio_params_t *to) 905 1.2.4.4 jdolecek { 906 1.2.4.4 jdolecek auvolconv_filter_t *this; 907 1.2.4.4 jdolecek device_t dev = audio_get_device(asc); 908 1.2.4.4 jdolecek struct vcaudio_softc *sc = device_private(dev); 909 1.2.4.4 jdolecek 910 1.2.4.4 jdolecek this = kmem_alloc(sizeof(auvolconv_filter_t), KM_SLEEP); 911 1.2.4.4 jdolecek this->base.base.fetch_to = auvolconv_slinear16_le_fetch_to; 912 1.2.4.4 jdolecek this->base.dtor = vcaudio_swvol_dtor; 913 1.2.4.4 jdolecek this->base.set_fetcher = stream_filter_set_fetcher; 914 1.2.4.4 jdolecek this->base.set_inputbuffer = stream_filter_set_inputbuffer; 915 1.2.4.4 jdolecek this->vol = &sc->sc_swvol; 916 1.2.4.4 jdolecek 917 1.2.4.4 jdolecek return (stream_filter_t *)this; 918 1.2.4.4 jdolecek } 919 1.2.4.4 jdolecek 920 1.2.4.4 jdolecek static void 921 1.2.4.4 jdolecek vcaudio_swvol_dtor(stream_filter_t *this) 922 1.2.4.4 jdolecek { 923 1.2.4.4 jdolecek if (this) 924 1.2.4.4 jdolecek kmem_free(this, sizeof(auvolconv_filter_t)); 925 1.2.4.4 jdolecek } 926
Indexes created Mon Oct 20 20:10:13 GMT 2025