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