1 /* 2 * bebob_stream.c - a part of driver for BeBoB based devices 3 * 4 * Copyright (c) 2013-2014 Takashi Sakamoto 5 * 6 * Licensed under the terms of the GNU General Public License, version 2. 7 */ 8 9 #include "./bebob.h" 10 11 #define CALLBACK_TIMEOUT 1000 12 #define FW_ISO_RESOURCE_DELAY 1000 13 14 /* 15 * NOTE; 16 * For BeBoB streams, Both of input and output CMP connection are important. 17 * 18 * For most devices, each CMP connection starts to transmit/receive a 19 * corresponding stream. But for a few devices, both of CMP connection needs 20 * to start transmitting stream. An example is 'M-Audio Firewire 410'. 21 */ 22 23 /* 128 is an arbitrary length but it seems to be enough */ 24 #define FORMAT_MAXIMUM_LENGTH 128 25 26 const unsigned int snd_bebob_rate_table[SND_BEBOB_STRM_FMT_ENTRIES] = { 27 [0] = 32000, 28 [1] = 44100, 29 [2] = 48000, 30 [3] = 88200, 31 [4] = 96000, 32 [5] = 176400, 33 [6] = 192000, 34 }; 35 36 /* 37 * See: Table 51: Extended Stream Format Info ‘Sampling Frequency’ 38 * in Additional AVC commands (Nov 2003, BridgeCo) 39 */ 40 static const unsigned int bridgeco_freq_table[] = { 41 [0] = 0x02, 42 [1] = 0x03, 43 [2] = 0x04, 44 [3] = 0x0a, 45 [4] = 0x05, 46 [5] = 0x06, 47 [6] = 0x07, 48 }; 49 50 static unsigned int 51 get_formation_index(unsigned int rate) 52 { 53 unsigned int i; 54 55 for (i = 0; i < ARRAY_SIZE(snd_bebob_rate_table); i++) { 56 if (snd_bebob_rate_table[i] == rate) 57 return i; 58 } 59 return -EINVAL; 60 } 61 62 int 63 snd_bebob_stream_get_rate(struct snd_bebob *bebob, unsigned int *curr_rate) 64 { 65 unsigned int tx_rate, rx_rate, trials; 66 int err; 67 68 trials = 0; 69 do { 70 err = avc_general_get_sig_fmt(bebob->unit, &tx_rate, 71 AVC_GENERAL_PLUG_DIR_OUT, 0); 72 } while (err == -EAGAIN && ++trials < 3); 73 if (err < 0) 74 goto end; 75 76 trials = 0; 77 do { 78 err = avc_general_get_sig_fmt(bebob->unit, &rx_rate, 79 AVC_GENERAL_PLUG_DIR_IN, 0); 80 } while (err == -EAGAIN && ++trials < 3); 81 if (err < 0) 82 goto end; 83 84 *curr_rate = rx_rate; 85 if (rx_rate == tx_rate) 86 goto end; 87 88 /* synchronize receive stream rate to transmit stream rate */ 89 err = avc_general_set_sig_fmt(bebob->unit, rx_rate, 90 AVC_GENERAL_PLUG_DIR_IN, 0); 91 end: 92 return err; 93 } 94 95 int 96 snd_bebob_stream_set_rate(struct snd_bebob *bebob, unsigned int rate) 97 { 98 int err; 99 100 err = avc_general_set_sig_fmt(bebob->unit, rate, 101 AVC_GENERAL_PLUG_DIR_OUT, 0); 102 if (err < 0) 103 goto end; 104 105 err = avc_general_set_sig_fmt(bebob->unit, rate, 106 AVC_GENERAL_PLUG_DIR_IN, 0); 107 if (err < 0) 108 goto end; 109 110 /* 111 * Some devices need a bit time for transition. 112 * 300msec is got by some experiments. 113 */ 114 msleep(300); 115 end: 116 return err; 117 } 118 119 int 120 snd_bebob_stream_check_internal_clock(struct snd_bebob *bebob, bool *internal) 121 { 122 struct snd_bebob_clock_spec *clk_spec = bebob->spec->clock; 123 u8 addr[AVC_BRIDGECO_ADDR_BYTES], input[7]; 124 unsigned int id; 125 int err = 0; 126 127 *internal = false; 128 129 /* 1.The device has its own operation to switch source of clock */ 130 if (clk_spec) { 131 err = clk_spec->get(bebob, &id); 132 if (err < 0) { 133 dev_err(&bebob->unit->device, 134 "fail to get clock source: %d\n", err); 135 goto end; 136 } 137 138 if (id >= clk_spec->num) { 139 dev_err(&bebob->unit->device, 140 "clock source %d out of range 0..%d\n", 141 id, clk_spec->num - 1); 142 err = -EIO; 143 goto end; 144 } 145 146 if (strncmp(clk_spec->labels[id], SND_BEBOB_CLOCK_INTERNAL, 147 strlen(SND_BEBOB_CLOCK_INTERNAL)) == 0) 148 *internal = true; 149 150 goto end; 151 } 152 153 /* 154 * 2.The device don't support to switch source of clock then assumed 155 * to use internal clock always 156 */ 157 if (bebob->sync_input_plug < 0) { 158 *internal = true; 159 goto end; 160 } 161 162 /* 163 * 3.The device supports to switch source of clock by an usual way. 164 * Let's check input for 'Music Sub Unit Sync Input' plug. 165 */ 166 avc_bridgeco_fill_msu_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN, 167 bebob->sync_input_plug); 168 err = avc_bridgeco_get_plug_input(bebob->unit, addr, input); 169 if (err < 0) { 170 dev_err(&bebob->unit->device, 171 "fail to get an input for MSU in plug %d: %d\n", 172 bebob->sync_input_plug, err); 173 goto end; 174 } 175 176 /* 177 * If there are no input plugs, all of fields are 0xff. 178 * Here check the first field. This field is used for direction. 179 */ 180 if (input[0] == 0xff) { 181 *internal = true; 182 goto end; 183 } 184 185 /* 186 * If source of clock is internal CSR, Music Sub Unit Sync Input is 187 * a destination of Music Sub Unit Sync Output. 188 */ 189 *internal = ((input[0] == AVC_BRIDGECO_PLUG_DIR_OUT) && 190 (input[1] == AVC_BRIDGECO_PLUG_MODE_SUBUNIT) && 191 (input[2] == 0x0c) && 192 (input[3] == 0x00)); 193 end: 194 return err; 195 } 196 197 static unsigned int 198 map_data_channels(struct snd_bebob *bebob, struct amdtp_stream *s) 199 { 200 unsigned int sec, sections, ch, channels; 201 unsigned int pcm, midi, location; 202 unsigned int stm_pos, sec_loc, pos; 203 u8 *buf, addr[AVC_BRIDGECO_ADDR_BYTES], type; 204 enum avc_bridgeco_plug_dir dir; 205 int err; 206 207 /* 208 * The length of return value of this command cannot be expected. Here 209 * use the maximum length of FCP. 210 */ 211 buf = kzalloc(256, GFP_KERNEL); 212 if (buf == NULL) 213 return -ENOMEM; 214 215 if (s == &bebob->tx_stream) 216 dir = AVC_BRIDGECO_PLUG_DIR_OUT; 217 else 218 dir = AVC_BRIDGECO_PLUG_DIR_IN; 219 220 avc_bridgeco_fill_unit_addr(addr, dir, AVC_BRIDGECO_PLUG_UNIT_ISOC, 0); 221 err = avc_bridgeco_get_plug_ch_pos(bebob->unit, addr, buf, 256); 222 if (err < 0) { 223 dev_err(&bebob->unit->device, 224 "fail to get channel position for isoc %s plug 0: %d\n", 225 (dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" : "out", 226 err); 227 goto end; 228 } 229 pos = 0; 230 231 /* positions in I/O buffer */ 232 pcm = 0; 233 midi = 0; 234 235 /* the number of sections in AMDTP packet */ 236 sections = buf[pos++]; 237 238 for (sec = 0; sec < sections; sec++) { 239 /* type of this section */ 240 avc_bridgeco_fill_unit_addr(addr, dir, 241 AVC_BRIDGECO_PLUG_UNIT_ISOC, 0); 242 err = avc_bridgeco_get_plug_section_type(bebob->unit, addr, 243 sec, &type); 244 if (err < 0) { 245 dev_err(&bebob->unit->device, 246 "fail to get section type for isoc %s plug 0: %d\n", 247 (dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" : 248 "out", 249 err); 250 goto end; 251 } 252 /* NoType */ 253 if (type == 0xff) { 254 err = -ENOSYS; 255 goto end; 256 } 257 258 /* the number of channels in this section */ 259 channels = buf[pos++]; 260 261 for (ch = 0; ch < channels; ch++) { 262 /* position of this channel in AMDTP packet */ 263 stm_pos = buf[pos++] - 1; 264 /* location of this channel in this section */ 265 sec_loc = buf[pos++] - 1; 266 267 /* 268 * Basically the number of location is within the 269 * number of channels in this section. But some models 270 * of M-Audio don't follow this. Its location for MIDI 271 * is the position of MIDI channels in AMDTP packet. 272 */ 273 if (sec_loc >= channels) 274 sec_loc = ch; 275 276 switch (type) { 277 /* for MIDI conformant data channel */ 278 case 0x0a: 279 /* AMDTP_MAX_CHANNELS_FOR_MIDI is 1. */ 280 if ((midi > 0) && (stm_pos != midi)) { 281 err = -ENOSYS; 282 goto end; 283 } 284 s->midi_position = stm_pos; 285 midi = stm_pos; 286 break; 287 /* for PCM data channel */ 288 case 0x01: /* Headphone */ 289 case 0x02: /* Microphone */ 290 case 0x03: /* Line */ 291 case 0x04: /* SPDIF */ 292 case 0x05: /* ADAT */ 293 case 0x06: /* TDIF */ 294 case 0x07: /* MADI */ 295 /* for undefined/changeable signal */ 296 case 0x08: /* Analog */ 297 case 0x09: /* Digital */ 298 default: 299 location = pcm + sec_loc; 300 if (location >= AMDTP_MAX_CHANNELS_FOR_PCM) { 301 err = -ENOSYS; 302 goto end; 303 } 304 s->pcm_positions[location] = stm_pos; 305 break; 306 } 307 } 308 309 if (type != 0x0a) 310 pcm += channels; 311 else 312 midi += channels; 313 } 314 end: 315 kfree(buf); 316 return err; 317 } 318 319 static int 320 init_both_connections(struct snd_bebob *bebob) 321 { 322 int err; 323 324 err = cmp_connection_init(&bebob->in_conn, 325 bebob->unit, CMP_INPUT, 0); 326 if (err < 0) 327 goto end; 328 329 err = cmp_connection_init(&bebob->out_conn, 330 bebob->unit, CMP_OUTPUT, 0); 331 if (err < 0) 332 cmp_connection_destroy(&bebob->in_conn); 333 end: 334 return err; 335 } 336 337 static int 338 check_connection_used_by_others(struct snd_bebob *bebob, struct amdtp_stream *s) 339 { 340 struct cmp_connection *conn; 341 bool used; 342 int err; 343 344 if (s == &bebob->tx_stream) 345 conn = &bebob->out_conn; 346 else 347 conn = &bebob->in_conn; 348 349 err = cmp_connection_check_used(conn, &used); 350 if ((err >= 0) && used && !amdtp_stream_running(s)) { 351 dev_err(&bebob->unit->device, 352 "Connection established by others: %cPCR[%d]\n", 353 (conn->direction == CMP_OUTPUT) ? 'o' : 'i', 354 conn->pcr_index); 355 err = -EBUSY; 356 } 357 358 return err; 359 } 360 361 static int 362 make_both_connections(struct snd_bebob *bebob, unsigned int rate) 363 { 364 int index, pcm_channels, midi_channels, err = 0; 365 366 if (bebob->connected) 367 goto end; 368 369 /* confirm params for both streams */ 370 index = get_formation_index(rate); 371 pcm_channels = bebob->tx_stream_formations[index].pcm; 372 midi_channels = bebob->tx_stream_formations[index].midi; 373 amdtp_stream_set_parameters(&bebob->tx_stream, 374 rate, pcm_channels, midi_channels * 8); 375 pcm_channels = bebob->rx_stream_formations[index].pcm; 376 midi_channels = bebob->rx_stream_formations[index].midi; 377 amdtp_stream_set_parameters(&bebob->rx_stream, 378 rate, pcm_channels, midi_channels * 8); 379 380 /* establish connections for both streams */ 381 err = cmp_connection_establish(&bebob->out_conn, 382 amdtp_stream_get_max_payload(&bebob->tx_stream)); 383 if (err < 0) 384 goto end; 385 err = cmp_connection_establish(&bebob->in_conn, 386 amdtp_stream_get_max_payload(&bebob->rx_stream)); 387 if (err < 0) { 388 cmp_connection_break(&bebob->out_conn); 389 goto end; 390 } 391 392 bebob->connected = true; 393 end: 394 return err; 395 } 396 397 static void 398 break_both_connections(struct snd_bebob *bebob) 399 { 400 cmp_connection_break(&bebob->in_conn); 401 cmp_connection_break(&bebob->out_conn); 402 403 bebob->connected = false; 404 405 /* These models seems to be in transition state for a longer time. */ 406 if (bebob->maudio_special_quirk != NULL) 407 msleep(200); 408 } 409 410 static void 411 destroy_both_connections(struct snd_bebob *bebob) 412 { 413 break_both_connections(bebob); 414 415 cmp_connection_destroy(&bebob->in_conn); 416 cmp_connection_destroy(&bebob->out_conn); 417 } 418 419 static int 420 get_sync_mode(struct snd_bebob *bebob, enum cip_flags *sync_mode) 421 { 422 /* currently this module doesn't support SYT-Match mode */ 423 *sync_mode = CIP_SYNC_TO_DEVICE; 424 return 0; 425 } 426 427 static int 428 start_stream(struct snd_bebob *bebob, struct amdtp_stream *stream, 429 unsigned int rate) 430 { 431 struct cmp_connection *conn; 432 int err = 0; 433 434 if (stream == &bebob->rx_stream) 435 conn = &bebob->in_conn; 436 else 437 conn = &bebob->out_conn; 438 439 /* channel mapping */ 440 if (bebob->maudio_special_quirk == NULL) { 441 err = map_data_channels(bebob, stream); 442 if (err < 0) 443 goto end; 444 } 445 446 /* start amdtp stream */ 447 err = amdtp_stream_start(stream, 448 conn->resources.channel, 449 conn->speed); 450 end: 451 return err; 452 } 453 454 int snd_bebob_stream_init_duplex(struct snd_bebob *bebob) 455 { 456 int err; 457 458 err = init_both_connections(bebob); 459 if (err < 0) 460 goto end; 461 462 err = amdtp_stream_init(&bebob->tx_stream, bebob->unit, 463 AMDTP_IN_STREAM, CIP_BLOCKING); 464 if (err < 0) { 465 amdtp_stream_destroy(&bebob->tx_stream); 466 destroy_both_connections(bebob); 467 goto end; 468 } 469 /* See comments in next function */ 470 init_completion(&bebob->bus_reset); 471 bebob->tx_stream.flags |= CIP_SKIP_INIT_DBC_CHECK; 472 /* 473 * At high sampling rate, M-Audio special firmware transmits empty 474 * packet with the value of dbc incremented by 8 but the others are 475 * valid to IEC 61883-1. 476 */ 477 if (bebob->maudio_special_quirk) 478 bebob->tx_stream.flags |= CIP_EMPTY_HAS_WRONG_DBC; 479 480 err = amdtp_stream_init(&bebob->rx_stream, bebob->unit, 481 AMDTP_OUT_STREAM, CIP_BLOCKING); 482 if (err < 0) { 483 amdtp_stream_destroy(&bebob->tx_stream); 484 amdtp_stream_destroy(&bebob->rx_stream); 485 destroy_both_connections(bebob); 486 } 487 end: 488 return err; 489 } 490 491 int snd_bebob_stream_start_duplex(struct snd_bebob *bebob, unsigned int rate) 492 { 493 struct snd_bebob_rate_spec *rate_spec = bebob->spec->rate; 494 struct amdtp_stream *master, *slave; 495 atomic_t *slave_substreams; 496 enum cip_flags sync_mode; 497 unsigned int curr_rate; 498 bool updated = false; 499 int err = 0; 500 501 /* 502 * Normal BeBoB firmware has a quirk at bus reset to transmits packets 503 * with discontinuous value in dbc field. 504 * 505 * This 'struct completion' is used to call .update() at first to update 506 * connections/streams. Next following codes handle streaming error. 507 */ 508 if (amdtp_streaming_error(&bebob->tx_stream)) { 509 if (completion_done(&bebob->bus_reset)) 510 reinit_completion(&bebob->bus_reset); 511 512 updated = (wait_for_completion_interruptible_timeout( 513 &bebob->bus_reset, 514 msecs_to_jiffies(FW_ISO_RESOURCE_DELAY)) > 0); 515 } 516 517 mutex_lock(&bebob->mutex); 518 519 /* Need no substreams */ 520 if (atomic_read(&bebob->playback_substreams) == 0 && 521 atomic_read(&bebob->capture_substreams) == 0) 522 goto end; 523 524 err = get_sync_mode(bebob, &sync_mode); 525 if (err < 0) 526 goto end; 527 if (sync_mode == CIP_SYNC_TO_DEVICE) { 528 master = &bebob->tx_stream; 529 slave = &bebob->rx_stream; 530 slave_substreams = &bebob->playback_substreams; 531 } else { 532 master = &bebob->rx_stream; 533 slave = &bebob->tx_stream; 534 slave_substreams = &bebob->capture_substreams; 535 } 536 537 /* 538 * Considering JACK/FFADO streaming: 539 * TODO: This can be removed hwdep functionality becomes popular. 540 */ 541 err = check_connection_used_by_others(bebob, master); 542 if (err < 0) 543 goto end; 544 545 /* 546 * packet queueing error or detecting discontinuity 547 * 548 * At bus reset, connections should not be broken here. So streams need 549 * to be re-started. This is a reason to use SKIP_INIT_DBC_CHECK flag. 550 */ 551 if (amdtp_streaming_error(master)) 552 amdtp_stream_stop(master); 553 if (amdtp_streaming_error(slave)) 554 amdtp_stream_stop(slave); 555 if (!updated && 556 !amdtp_stream_running(master) && !amdtp_stream_running(slave)) 557 break_both_connections(bebob); 558 559 /* stop streams if rate is different */ 560 err = rate_spec->get(bebob, &curr_rate); 561 if (err < 0) { 562 dev_err(&bebob->unit->device, 563 "fail to get sampling rate: %d\n", err); 564 goto end; 565 } 566 if (rate == 0) 567 rate = curr_rate; 568 if (rate != curr_rate) { 569 amdtp_stream_stop(master); 570 amdtp_stream_stop(slave); 571 break_both_connections(bebob); 572 } 573 574 /* master should be always running */ 575 if (!amdtp_stream_running(master)) { 576 amdtp_stream_set_sync(sync_mode, master, slave); 577 bebob->master = master; 578 579 /* 580 * NOTE: 581 * If establishing connections at first, Yamaha GO46 582 * (and maybe Terratec X24) don't generate sound. 583 * 584 * For firmware customized by M-Audio, refer to next NOTE. 585 */ 586 if (bebob->maudio_special_quirk == NULL) { 587 err = rate_spec->set(bebob, rate); 588 if (err < 0) { 589 dev_err(&bebob->unit->device, 590 "fail to set sampling rate: %d\n", 591 err); 592 goto end; 593 } 594 } 595 596 err = make_both_connections(bebob, rate); 597 if (err < 0) 598 goto end; 599 600 err = start_stream(bebob, master, rate); 601 if (err < 0) { 602 dev_err(&bebob->unit->device, 603 "fail to run AMDTP master stream:%d\n", err); 604 break_both_connections(bebob); 605 goto end; 606 } 607 608 /* 609 * NOTE: 610 * The firmware customized by M-Audio uses these commands to 611 * start transmitting stream. This is not usual way. 612 */ 613 if (bebob->maudio_special_quirk != NULL) { 614 err = rate_spec->set(bebob, rate); 615 if (err < 0) { 616 dev_err(&bebob->unit->device, 617 "fail to ensure sampling rate: %d\n", 618 err); 619 amdtp_stream_stop(master); 620 break_both_connections(bebob); 621 goto end; 622 } 623 } 624 625 /* wait first callback */ 626 if (!amdtp_stream_wait_callback(master, CALLBACK_TIMEOUT)) { 627 amdtp_stream_stop(master); 628 break_both_connections(bebob); 629 err = -ETIMEDOUT; 630 goto end; 631 } 632 } 633 634 /* start slave if needed */ 635 if (atomic_read(slave_substreams) > 0 && !amdtp_stream_running(slave)) { 636 err = start_stream(bebob, slave, rate); 637 if (err < 0) { 638 dev_err(&bebob->unit->device, 639 "fail to run AMDTP slave stream:%d\n", err); 640 amdtp_stream_stop(master); 641 break_both_connections(bebob); 642 goto end; 643 } 644 645 /* wait first callback */ 646 if (!amdtp_stream_wait_callback(slave, CALLBACK_TIMEOUT)) { 647 amdtp_stream_stop(slave); 648 amdtp_stream_stop(master); 649 break_both_connections(bebob); 650 err = -ETIMEDOUT; 651 } 652 } 653 end: 654 mutex_unlock(&bebob->mutex); 655 return err; 656 } 657 658 void snd_bebob_stream_stop_duplex(struct snd_bebob *bebob) 659 { 660 struct amdtp_stream *master, *slave; 661 atomic_t *master_substreams, *slave_substreams; 662 663 if (bebob->master == &bebob->rx_stream) { 664 slave = &bebob->tx_stream; 665 master = &bebob->rx_stream; 666 slave_substreams = &bebob->capture_substreams; 667 master_substreams = &bebob->playback_substreams; 668 } else { 669 slave = &bebob->rx_stream; 670 master = &bebob->tx_stream; 671 slave_substreams = &bebob->playback_substreams; 672 master_substreams = &bebob->capture_substreams; 673 } 674 675 mutex_lock(&bebob->mutex); 676 677 if (atomic_read(slave_substreams) == 0) { 678 amdtp_stream_pcm_abort(slave); 679 amdtp_stream_stop(slave); 680 681 if (atomic_read(master_substreams) == 0) { 682 amdtp_stream_pcm_abort(master); 683 amdtp_stream_stop(master); 684 break_both_connections(bebob); 685 } 686 } 687 688 mutex_unlock(&bebob->mutex); 689 } 690 691 void snd_bebob_stream_update_duplex(struct snd_bebob *bebob) 692 { 693 /* vs. XRUN recovery due to discontinuity at bus reset */ 694 mutex_lock(&bebob->mutex); 695 696 if ((cmp_connection_update(&bebob->in_conn) < 0) || 697 (cmp_connection_update(&bebob->out_conn) < 0)) { 698 amdtp_stream_pcm_abort(&bebob->rx_stream); 699 amdtp_stream_pcm_abort(&bebob->tx_stream); 700 amdtp_stream_stop(&bebob->rx_stream); 701 amdtp_stream_stop(&bebob->tx_stream); 702 break_both_connections(bebob); 703 } else { 704 amdtp_stream_update(&bebob->rx_stream); 705 amdtp_stream_update(&bebob->tx_stream); 706 } 707 708 /* wake up stream_start_duplex() */ 709 if (!completion_done(&bebob->bus_reset)) 710 complete_all(&bebob->bus_reset); 711 712 mutex_unlock(&bebob->mutex); 713 } 714 715 void snd_bebob_stream_destroy_duplex(struct snd_bebob *bebob) 716 { 717 mutex_lock(&bebob->mutex); 718 719 amdtp_stream_pcm_abort(&bebob->rx_stream); 720 amdtp_stream_pcm_abort(&bebob->tx_stream); 721 722 amdtp_stream_stop(&bebob->rx_stream); 723 amdtp_stream_stop(&bebob->tx_stream); 724 725 amdtp_stream_destroy(&bebob->rx_stream); 726 amdtp_stream_destroy(&bebob->tx_stream); 727 728 destroy_both_connections(bebob); 729 730 mutex_unlock(&bebob->mutex); 731 } 732 733 /* 734 * See: Table 50: Extended Stream Format Info Format Hierarchy Level 2’ 735 * in Additional AVC commands (Nov 2003, BridgeCo) 736 * Also 'Clause 12 AM824 sequence adaption layers' in IEC 61883-6:2005 737 */ 738 static int 739 parse_stream_formation(u8 *buf, unsigned int len, 740 struct snd_bebob_stream_formation *formation) 741 { 742 unsigned int i, e, channels, format; 743 744 /* 745 * this module can support a hierarchy combination that: 746 * Root: Audio and Music (0x90) 747 * Level 1: AM824 Compound (0x40) 748 */ 749 if ((buf[0] != 0x90) || (buf[1] != 0x40)) 750 return -ENOSYS; 751 752 /* check sampling rate */ 753 for (i = 0; i < ARRAY_SIZE(bridgeco_freq_table); i++) { 754 if (buf[2] == bridgeco_freq_table[i]) 755 break; 756 } 757 if (i == ARRAY_SIZE(bridgeco_freq_table)) 758 return -ENOSYS; 759 760 /* Avoid double count by different entries for the same rate. */ 761 memset(&formation[i], 0, sizeof(struct snd_bebob_stream_formation)); 762 763 for (e = 0; e < buf[4]; e++) { 764 channels = buf[5 + e * 2]; 765 format = buf[6 + e * 2]; 766 767 switch (format) { 768 /* IEC 60958 Conformant, currently handled as MBLA */ 769 case 0x00: 770 /* Multi bit linear audio */ 771 case 0x06: /* Raw */ 772 formation[i].pcm += channels; 773 break; 774 /* MIDI Conformant */ 775 case 0x0d: 776 formation[i].midi += channels; 777 break; 778 /* IEC 61937-3 to 7 */ 779 case 0x01: 780 case 0x02: 781 case 0x03: 782 case 0x04: 783 case 0x05: 784 /* Multi bit linear audio */ 785 case 0x07: /* DVD-Audio */ 786 case 0x0c: /* High Precision */ 787 /* One Bit Audio */ 788 case 0x08: /* (Plain) Raw */ 789 case 0x09: /* (Plain) SACD */ 790 case 0x0a: /* (Encoded) Raw */ 791 case 0x0b: /* (Encoded) SACD */ 792 /* Synchronization Stream (Stereo Raw audio) */ 793 case 0x40: 794 /* Don't care */ 795 case 0xff: 796 default: 797 return -ENOSYS; /* not supported */ 798 } 799 } 800 801 if (formation[i].pcm > AMDTP_MAX_CHANNELS_FOR_PCM || 802 formation[i].midi > AMDTP_MAX_CHANNELS_FOR_MIDI) 803 return -ENOSYS; 804 805 return 0; 806 } 807 808 static int 809 fill_stream_formations(struct snd_bebob *bebob, enum avc_bridgeco_plug_dir dir, 810 unsigned short pid) 811 { 812 u8 *buf; 813 struct snd_bebob_stream_formation *formations; 814 unsigned int len, eid; 815 u8 addr[AVC_BRIDGECO_ADDR_BYTES]; 816 int err; 817 818 buf = kmalloc(FORMAT_MAXIMUM_LENGTH, GFP_KERNEL); 819 if (buf == NULL) 820 return -ENOMEM; 821 822 if (dir == AVC_BRIDGECO_PLUG_DIR_IN) 823 formations = bebob->rx_stream_formations; 824 else 825 formations = bebob->tx_stream_formations; 826 827 for (eid = 0; eid < SND_BEBOB_STRM_FMT_ENTRIES; eid++) { 828 len = FORMAT_MAXIMUM_LENGTH; 829 avc_bridgeco_fill_unit_addr(addr, dir, 830 AVC_BRIDGECO_PLUG_UNIT_ISOC, pid); 831 err = avc_bridgeco_get_plug_strm_fmt(bebob->unit, addr, buf, 832 &len, eid); 833 /* No entries remained. */ 834 if (err == -EINVAL && eid > 0) { 835 err = 0; 836 break; 837 } else if (err < 0) { 838 dev_err(&bebob->unit->device, 839 "fail to get stream format %d for isoc %s plug %d:%d\n", 840 eid, 841 (dir == AVC_BRIDGECO_PLUG_DIR_IN) ? "in" : 842 "out", 843 pid, err); 844 break; 845 } 846 847 err = parse_stream_formation(buf, len, formations); 848 if (err < 0) 849 break; 850 } 851 852 kfree(buf); 853 return err; 854 } 855 856 static int 857 seek_msu_sync_input_plug(struct snd_bebob *bebob) 858 { 859 u8 plugs[AVC_PLUG_INFO_BUF_BYTES], addr[AVC_BRIDGECO_ADDR_BYTES]; 860 unsigned int i; 861 enum avc_bridgeco_plug_type type; 862 int err; 863 864 /* Get the number of Music Sub Unit for both direction. */ 865 err = avc_general_get_plug_info(bebob->unit, 0x0c, 0x00, 0x00, plugs); 866 if (err < 0) { 867 dev_err(&bebob->unit->device, 868 "fail to get info for MSU in/out plugs: %d\n", 869 err); 870 goto end; 871 } 872 873 /* seek destination plugs for 'MSU sync input' */ 874 bebob->sync_input_plug = -1; 875 for (i = 0; i < plugs[0]; i++) { 876 avc_bridgeco_fill_msu_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN, i); 877 err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type); 878 if (err < 0) { 879 dev_err(&bebob->unit->device, 880 "fail to get type for MSU in plug %d: %d\n", 881 i, err); 882 goto end; 883 } 884 885 if (type == AVC_BRIDGECO_PLUG_TYPE_SYNC) { 886 bebob->sync_input_plug = i; 887 break; 888 } 889 } 890 end: 891 return err; 892 } 893 894 int snd_bebob_stream_discover(struct snd_bebob *bebob) 895 { 896 struct snd_bebob_clock_spec *clk_spec = bebob->spec->clock; 897 u8 plugs[AVC_PLUG_INFO_BUF_BYTES], addr[AVC_BRIDGECO_ADDR_BYTES]; 898 enum avc_bridgeco_plug_type type; 899 unsigned int i; 900 int err; 901 902 /* the number of plugs for isoc in/out, ext in/out */ 903 err = avc_general_get_plug_info(bebob->unit, 0x1f, 0x07, 0x00, plugs); 904 if (err < 0) { 905 dev_err(&bebob->unit->device, 906 "fail to get info for isoc/external in/out plugs: %d\n", 907 err); 908 goto end; 909 } 910 911 /* 912 * This module supports at least one isoc input plug and one isoc 913 * output plug. 914 */ 915 if ((plugs[0] == 0) || (plugs[1] == 0)) { 916 err = -ENOSYS; 917 goto end; 918 } 919 920 avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN, 921 AVC_BRIDGECO_PLUG_UNIT_ISOC, 0); 922 err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type); 923 if (err < 0) { 924 dev_err(&bebob->unit->device, 925 "fail to get type for isoc in plug 0: %d\n", err); 926 goto end; 927 } else if (type != AVC_BRIDGECO_PLUG_TYPE_ISOC) { 928 err = -ENOSYS; 929 goto end; 930 } 931 err = fill_stream_formations(bebob, AVC_BRIDGECO_PLUG_DIR_IN, 0); 932 if (err < 0) 933 goto end; 934 935 avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_OUT, 936 AVC_BRIDGECO_PLUG_UNIT_ISOC, 0); 937 err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type); 938 if (err < 0) { 939 dev_err(&bebob->unit->device, 940 "fail to get type for isoc out plug 0: %d\n", err); 941 goto end; 942 } else if (type != AVC_BRIDGECO_PLUG_TYPE_ISOC) { 943 err = -ENOSYS; 944 goto end; 945 } 946 err = fill_stream_formations(bebob, AVC_BRIDGECO_PLUG_DIR_OUT, 0); 947 if (err < 0) 948 goto end; 949 950 /* count external input plugs for MIDI */ 951 bebob->midi_input_ports = 0; 952 for (i = 0; i < plugs[2]; i++) { 953 avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_IN, 954 AVC_BRIDGECO_PLUG_UNIT_EXT, i); 955 err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type); 956 if (err < 0) { 957 dev_err(&bebob->unit->device, 958 "fail to get type for external in plug %d: %d\n", 959 i, err); 960 goto end; 961 } else if (type == AVC_BRIDGECO_PLUG_TYPE_MIDI) { 962 bebob->midi_input_ports++; 963 } 964 } 965 966 /* count external output plugs for MIDI */ 967 bebob->midi_output_ports = 0; 968 for (i = 0; i < plugs[3]; i++) { 969 avc_bridgeco_fill_unit_addr(addr, AVC_BRIDGECO_PLUG_DIR_OUT, 970 AVC_BRIDGECO_PLUG_UNIT_EXT, i); 971 err = avc_bridgeco_get_plug_type(bebob->unit, addr, &type); 972 if (err < 0) { 973 dev_err(&bebob->unit->device, 974 "fail to get type for external out plug %d: %d\n", 975 i, err); 976 goto end; 977 } else if (type == AVC_BRIDGECO_PLUG_TYPE_MIDI) { 978 bebob->midi_output_ports++; 979 } 980 } 981 982 /* for check source of clock later */ 983 if (!clk_spec) 984 err = seek_msu_sync_input_plug(bebob); 985 end: 986 return err; 987 } 988 989 void snd_bebob_stream_lock_changed(struct snd_bebob *bebob) 990 { 991 bebob->dev_lock_changed = true; 992 wake_up(&bebob->hwdep_wait); 993 } 994 995 int snd_bebob_stream_lock_try(struct snd_bebob *bebob) 996 { 997 int err; 998 999 spin_lock_irq(&bebob->lock); 1000 1001 /* user land lock this */ 1002 if (bebob->dev_lock_count < 0) { 1003 err = -EBUSY; 1004 goto end; 1005 } 1006 1007 /* this is the first time */ 1008 if (bebob->dev_lock_count++ == 0) 1009 snd_bebob_stream_lock_changed(bebob); 1010 err = 0; 1011 end: 1012 spin_unlock_irq(&bebob->lock); 1013 return err; 1014 } 1015 1016 void snd_bebob_stream_lock_release(struct snd_bebob *bebob) 1017 { 1018 spin_lock_irq(&bebob->lock); 1019 1020 if (WARN_ON(bebob->dev_lock_count <= 0)) 1021 goto end; 1022 if (--bebob->dev_lock_count == 0) 1023 snd_bebob_stream_lock_changed(bebob); 1024 end: 1025 spin_unlock_irq(&bebob->lock); 1026 } 1027