1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * oxfw_stream.c - a part of driver for OXFW970/971 based devices 4 * 5 * Copyright (c) 2014 Takashi Sakamoto 6 */ 7 8 #include "oxfw.h" 9 #include <linux/delay.h> 10 11 #define AVC_GENERIC_FRAME_MAXIMUM_BYTES 512 12 #define READY_TIMEOUT_MS 600 13 14 /* 15 * According to datasheet of Oxford Semiconductor: 16 * OXFW970: 32.0/44.1/48.0/96.0 Khz, 8 audio channels I/O 17 * OXFW971: 32.0/44.1/48.0/88.2/96.0/192.0 kHz, 16 audio channels I/O, MIDI I/O 18 */ 19 static const unsigned int oxfw_rate_table[] = { 20 [0] = 32000, 21 [1] = 44100, 22 [2] = 48000, 23 [3] = 88200, 24 [4] = 96000, 25 [5] = 192000, 26 }; 27 28 /* 29 * See Table 5.7 – Sampling frequency for Multi-bit Audio 30 * in AV/C Stream Format Information Specification 1.1 (Apr 2005, 1394TA) 31 */ 32 static const unsigned int avc_stream_rate_table[] = { 33 [0] = 0x02, 34 [1] = 0x03, 35 [2] = 0x04, 36 [3] = 0x0a, 37 [4] = 0x05, 38 [5] = 0x07, 39 }; 40 41 static int set_rate(struct snd_oxfw *oxfw, unsigned int rate) 42 { 43 int err; 44 45 err = avc_general_set_sig_fmt(oxfw->unit, rate, 46 AVC_GENERAL_PLUG_DIR_IN, 0); 47 if (err < 0) 48 goto end; 49 50 if (oxfw->has_output) 51 err = avc_general_set_sig_fmt(oxfw->unit, rate, 52 AVC_GENERAL_PLUG_DIR_OUT, 0); 53 end: 54 return err; 55 } 56 57 static int set_stream_format(struct snd_oxfw *oxfw, struct amdtp_stream *s, 58 unsigned int rate, unsigned int pcm_channels) 59 { 60 u8 **formats; 61 struct snd_oxfw_stream_formation formation; 62 enum avc_general_plug_dir dir; 63 unsigned int len; 64 int i, err; 65 66 if (s == &oxfw->tx_stream) { 67 formats = oxfw->tx_stream_formats; 68 dir = AVC_GENERAL_PLUG_DIR_OUT; 69 } else { 70 formats = oxfw->rx_stream_formats; 71 dir = AVC_GENERAL_PLUG_DIR_IN; 72 } 73 74 /* Seek stream format for requirements. */ 75 for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) { 76 err = snd_oxfw_stream_parse_format(formats[i], &formation); 77 if (err < 0) 78 return err; 79 80 if ((formation.rate == rate) && (formation.pcm == pcm_channels)) 81 break; 82 } 83 if (i == SND_OXFW_STREAM_FORMAT_ENTRIES) 84 return -EINVAL; 85 86 /* If assumed, just change rate. */ 87 if (oxfw->assumed) 88 return set_rate(oxfw, rate); 89 90 /* Calculate format length. */ 91 len = 5 + formats[i][4] * 2; 92 93 err = avc_stream_set_format(oxfw->unit, dir, 0, formats[i], len); 94 if (err < 0) 95 return err; 96 97 /* Some requests just after changing format causes freezing. */ 98 msleep(100); 99 100 return 0; 101 } 102 103 static int start_stream(struct snd_oxfw *oxfw, struct amdtp_stream *stream) 104 { 105 struct cmp_connection *conn; 106 int err; 107 108 if (stream == &oxfw->rx_stream) 109 conn = &oxfw->in_conn; 110 else 111 conn = &oxfw->out_conn; 112 113 err = cmp_connection_establish(conn); 114 if (err < 0) 115 return err; 116 117 err = amdtp_domain_add_stream(&oxfw->domain, stream, 118 conn->resources.channel, conn->speed); 119 if (err < 0) { 120 cmp_connection_break(conn); 121 return err; 122 } 123 124 return 0; 125 } 126 127 static int check_connection_used_by_others(struct snd_oxfw *oxfw, 128 struct amdtp_stream *stream) 129 { 130 struct cmp_connection *conn; 131 bool used; 132 int err; 133 134 if (stream == &oxfw->tx_stream) 135 conn = &oxfw->out_conn; 136 else 137 conn = &oxfw->in_conn; 138 139 err = cmp_connection_check_used(conn, &used); 140 if ((err >= 0) && used && !amdtp_stream_running(stream)) { 141 dev_err(&oxfw->unit->device, 142 "Connection established by others: %cPCR[%d]\n", 143 (conn->direction == CMP_OUTPUT) ? 'o' : 'i', 144 conn->pcr_index); 145 err = -EBUSY; 146 } 147 148 return err; 149 } 150 151 static int init_stream(struct snd_oxfw *oxfw, struct amdtp_stream *stream) 152 { 153 struct cmp_connection *conn; 154 enum cmp_direction c_dir; 155 enum amdtp_stream_direction s_dir; 156 unsigned int flags = 0; 157 int err; 158 159 if (!(oxfw->quirks & SND_OXFW_QUIRK_BLOCKING_TRANSMISSION)) 160 flags |= CIP_NONBLOCKING; 161 else 162 flags |= CIP_BLOCKING; 163 164 // OXFW 970/971 has no function to generate playback timing according to the sequence 165 // of value in syt field, thus the packet should include NO_INFO value in the field. 166 // However, some models just ignore data blocks in packet with NO_INFO for audio data 167 // processing. 168 if (!(oxfw->quirks & SND_OXFW_QUIRK_IGNORE_NO_INFO_PACKET)) 169 flags |= CIP_UNAWARE_SYT; 170 171 if (stream == &oxfw->tx_stream) { 172 conn = &oxfw->out_conn; 173 c_dir = CMP_OUTPUT; 174 s_dir = AMDTP_IN_STREAM; 175 176 if (oxfw->quirks & SND_OXFW_QUIRK_JUMBO_PAYLOAD) 177 flags |= CIP_JUMBO_PAYLOAD; 178 if (oxfw->quirks & SND_OXFW_QUIRK_WRONG_DBS) 179 flags |= CIP_WRONG_DBS; 180 if (oxfw->quirks & SND_OXFW_QUIRK_DBC_IS_TOTAL_PAYLOAD_QUADLETS) 181 flags |= CIP_DBC_IS_END_EVENT | CIP_DBC_IS_PAYLOAD_QUADLETS; 182 } else { 183 conn = &oxfw->in_conn; 184 c_dir = CMP_INPUT; 185 s_dir = AMDTP_OUT_STREAM; 186 } 187 188 err = cmp_connection_init(conn, oxfw->unit, c_dir, 0); 189 if (err < 0) 190 return err; 191 192 err = amdtp_am824_init(stream, oxfw->unit, s_dir, flags); 193 if (err < 0) { 194 cmp_connection_destroy(conn); 195 return err; 196 } 197 198 return 0; 199 } 200 201 static int keep_resources(struct snd_oxfw *oxfw, struct amdtp_stream *stream) 202 { 203 enum avc_general_plug_dir dir; 204 u8 **formats; 205 struct snd_oxfw_stream_formation formation; 206 struct cmp_connection *conn; 207 int i; 208 int err; 209 210 if (stream == &oxfw->rx_stream) { 211 dir = AVC_GENERAL_PLUG_DIR_IN; 212 formats = oxfw->rx_stream_formats; 213 conn = &oxfw->in_conn; 214 } else { 215 dir = AVC_GENERAL_PLUG_DIR_OUT; 216 formats = oxfw->tx_stream_formats; 217 conn = &oxfw->out_conn; 218 } 219 220 err = snd_oxfw_stream_get_current_formation(oxfw, dir, &formation); 221 if (err < 0) 222 return err; 223 224 for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) { 225 struct snd_oxfw_stream_formation fmt; 226 227 if (formats[i] == NULL) 228 break; 229 230 err = snd_oxfw_stream_parse_format(formats[i], &fmt); 231 if (err < 0) 232 return err; 233 234 if (fmt.rate == formation.rate && fmt.pcm == formation.pcm && 235 fmt.midi == formation.midi) 236 break; 237 } 238 if (i == SND_OXFW_STREAM_FORMAT_ENTRIES) 239 return -EINVAL; 240 241 // The stream should have one pcm channels at least. 242 if (formation.pcm == 0) 243 return -EINVAL; 244 245 err = amdtp_am824_set_parameters(stream, formation.rate, formation.pcm, 246 formation.midi * 8, false); 247 if (err < 0) 248 return err; 249 250 return cmp_connection_reserve(conn, amdtp_stream_get_max_payload(stream)); 251 } 252 253 int snd_oxfw_stream_reserve_duplex(struct snd_oxfw *oxfw, 254 struct amdtp_stream *stream, 255 unsigned int rate, unsigned int pcm_channels, 256 unsigned int frames_per_period, 257 unsigned int frames_per_buffer) 258 { 259 struct snd_oxfw_stream_formation formation; 260 enum avc_general_plug_dir dir; 261 int err; 262 263 // Considering JACK/FFADO streaming: 264 // TODO: This can be removed hwdep functionality becomes popular. 265 err = check_connection_used_by_others(oxfw, &oxfw->rx_stream); 266 if (err < 0) 267 return err; 268 if (oxfw->has_output) { 269 err = check_connection_used_by_others(oxfw, &oxfw->tx_stream); 270 if (err < 0) 271 return err; 272 } 273 274 if (stream == &oxfw->tx_stream) 275 dir = AVC_GENERAL_PLUG_DIR_OUT; 276 else 277 dir = AVC_GENERAL_PLUG_DIR_IN; 278 279 err = snd_oxfw_stream_get_current_formation(oxfw, dir, &formation); 280 if (err < 0) 281 return err; 282 if (rate == 0) { 283 rate = formation.rate; 284 pcm_channels = formation.pcm; 285 } 286 if (formation.rate != rate || formation.pcm != pcm_channels) { 287 amdtp_domain_stop(&oxfw->domain); 288 289 cmp_connection_break(&oxfw->in_conn); 290 cmp_connection_release(&oxfw->in_conn); 291 292 if (oxfw->has_output) { 293 cmp_connection_break(&oxfw->out_conn); 294 cmp_connection_release(&oxfw->out_conn); 295 } 296 } 297 298 if (oxfw->substreams_count == 0 || 299 formation.rate != rate || formation.pcm != pcm_channels) { 300 err = set_stream_format(oxfw, stream, rate, pcm_channels); 301 if (err < 0) { 302 dev_err(&oxfw->unit->device, 303 "fail to set stream format: %d\n", err); 304 return err; 305 } 306 307 err = keep_resources(oxfw, &oxfw->rx_stream); 308 if (err < 0) 309 return err; 310 311 if (oxfw->has_output) { 312 err = keep_resources(oxfw, &oxfw->tx_stream); 313 if (err < 0) { 314 cmp_connection_release(&oxfw->in_conn); 315 return err; 316 } 317 } 318 319 err = amdtp_domain_set_events_per_period(&oxfw->domain, 320 frames_per_period, frames_per_buffer); 321 if (err < 0) { 322 cmp_connection_release(&oxfw->in_conn); 323 if (oxfw->has_output) 324 cmp_connection_release(&oxfw->out_conn); 325 return err; 326 } 327 } 328 329 return 0; 330 } 331 332 int snd_oxfw_stream_start_duplex(struct snd_oxfw *oxfw) 333 { 334 int err; 335 336 if (oxfw->substreams_count == 0) 337 return -EIO; 338 339 if (amdtp_streaming_error(&oxfw->rx_stream) || 340 amdtp_streaming_error(&oxfw->tx_stream)) { 341 amdtp_domain_stop(&oxfw->domain); 342 343 cmp_connection_break(&oxfw->in_conn); 344 if (oxfw->has_output) 345 cmp_connection_break(&oxfw->out_conn); 346 } 347 348 if (!amdtp_stream_running(&oxfw->rx_stream)) { 349 unsigned int tx_init_skip_cycles = 0; 350 bool replay_seq = false; 351 352 err = start_stream(oxfw, &oxfw->rx_stream); 353 if (err < 0) { 354 dev_err(&oxfw->unit->device, 355 "fail to prepare rx stream: %d\n", err); 356 goto error; 357 } 358 359 if (oxfw->has_output && 360 !amdtp_stream_running(&oxfw->tx_stream)) { 361 err = start_stream(oxfw, &oxfw->tx_stream); 362 if (err < 0) { 363 dev_err(&oxfw->unit->device, 364 "fail to prepare tx stream: %d\n", err); 365 goto error; 366 } 367 368 if (oxfw->quirks & SND_OXFW_QUIRK_JUMBO_PAYLOAD) { 369 // Just after changing sampling transfer frequency, many cycles are 370 // skipped for packet transmission. 371 tx_init_skip_cycles = 400; 372 } else if (oxfw->quirks & SND_OXFW_QUIRK_VOLUNTARY_RECOVERY) { 373 // It takes a bit time for target device to adjust event frequency 374 // according to nominal event frequency in isochronous packets from 375 // ALSA oxfw driver. 376 tx_init_skip_cycles = 4000; 377 } else { 378 replay_seq = true; 379 } 380 } 381 382 // NOTE: The device ignores presentation time expressed by the value of syt field 383 // of CIP header in received packets. The sequence of the number of data blocks per 384 // packet is important for media clock recovery. 385 err = amdtp_domain_start(&oxfw->domain, tx_init_skip_cycles, replay_seq, false); 386 if (err < 0) 387 goto error; 388 389 if (!amdtp_domain_wait_ready(&oxfw->domain, READY_TIMEOUT_MS)) { 390 err = -ETIMEDOUT; 391 goto error; 392 } 393 } 394 395 return 0; 396 error: 397 amdtp_domain_stop(&oxfw->domain); 398 399 cmp_connection_break(&oxfw->in_conn); 400 if (oxfw->has_output) 401 cmp_connection_break(&oxfw->out_conn); 402 403 return err; 404 } 405 406 void snd_oxfw_stream_stop_duplex(struct snd_oxfw *oxfw) 407 { 408 if (oxfw->substreams_count == 0) { 409 amdtp_domain_stop(&oxfw->domain); 410 411 cmp_connection_break(&oxfw->in_conn); 412 cmp_connection_release(&oxfw->in_conn); 413 414 if (oxfw->has_output) { 415 cmp_connection_break(&oxfw->out_conn); 416 cmp_connection_release(&oxfw->out_conn); 417 } 418 } 419 } 420 421 static void destroy_stream(struct snd_oxfw *oxfw, struct amdtp_stream *stream) 422 { 423 struct cmp_connection *conn; 424 425 if (stream == &oxfw->tx_stream) 426 conn = &oxfw->out_conn; 427 else 428 conn = &oxfw->in_conn; 429 430 amdtp_stream_destroy(stream); 431 cmp_connection_destroy(conn); 432 } 433 434 int snd_oxfw_stream_init_duplex(struct snd_oxfw *oxfw) 435 { 436 int err; 437 438 err = init_stream(oxfw, &oxfw->rx_stream); 439 if (err < 0) 440 return err; 441 442 if (oxfw->has_output) { 443 err = init_stream(oxfw, &oxfw->tx_stream); 444 if (err < 0) { 445 destroy_stream(oxfw, &oxfw->rx_stream); 446 return err; 447 } 448 } 449 450 err = amdtp_domain_init(&oxfw->domain); 451 if (err < 0) { 452 destroy_stream(oxfw, &oxfw->rx_stream); 453 if (oxfw->has_output) 454 destroy_stream(oxfw, &oxfw->tx_stream); 455 } 456 457 return err; 458 } 459 460 // This function should be called before starting the stream or after stopping 461 // the streams. 462 void snd_oxfw_stream_destroy_duplex(struct snd_oxfw *oxfw) 463 { 464 amdtp_domain_destroy(&oxfw->domain); 465 466 destroy_stream(oxfw, &oxfw->rx_stream); 467 468 if (oxfw->has_output) 469 destroy_stream(oxfw, &oxfw->tx_stream); 470 } 471 472 void snd_oxfw_stream_update_duplex(struct snd_oxfw *oxfw) 473 { 474 amdtp_domain_stop(&oxfw->domain); 475 476 cmp_connection_break(&oxfw->in_conn); 477 478 amdtp_stream_pcm_abort(&oxfw->rx_stream); 479 480 if (oxfw->has_output) { 481 cmp_connection_break(&oxfw->out_conn); 482 483 amdtp_stream_pcm_abort(&oxfw->tx_stream); 484 } 485 } 486 487 int snd_oxfw_stream_get_current_formation(struct snd_oxfw *oxfw, 488 enum avc_general_plug_dir dir, 489 struct snd_oxfw_stream_formation *formation) 490 { 491 int err; 492 493 if (!(oxfw->quirks & SND_OXFW_QUIRK_STREAM_FORMAT_INFO_UNSUPPORTED)) { 494 u8 *format; 495 unsigned int len; 496 497 len = AVC_GENERIC_FRAME_MAXIMUM_BYTES; 498 format = kmalloc(len, GFP_KERNEL); 499 if (format == NULL) 500 return -ENOMEM; 501 502 err = avc_stream_get_format_single(oxfw->unit, dir, 0, format, &len); 503 if (err >= 0) { 504 if (len < 3) 505 err = -EIO; 506 else 507 err = snd_oxfw_stream_parse_format(format, formation); 508 } 509 510 kfree(format); 511 } else { 512 // Miglia Harmony Audio does not support Extended Stream Format Information 513 // command. Use the duplicated hard-coded format, instead. 514 unsigned int rate; 515 u8 *const *formats; 516 int i; 517 518 err = avc_general_get_sig_fmt(oxfw->unit, &rate, dir, 0); 519 if (err < 0) 520 return err; 521 522 if (dir == AVC_GENERAL_PLUG_DIR_IN) 523 formats = oxfw->rx_stream_formats; 524 else 525 formats = oxfw->tx_stream_formats; 526 527 for (i = 0; (i < SND_OXFW_STREAM_FORMAT_ENTRIES); ++i) { 528 if (!formats[i]) 529 continue; 530 531 err = snd_oxfw_stream_parse_format(formats[i], formation); 532 if (err < 0) 533 continue; 534 535 if (formation->rate == rate) 536 break; 537 } 538 if (i == SND_OXFW_STREAM_FORMAT_ENTRIES) 539 return -EIO; 540 } 541 542 return err; 543 } 544 545 /* 546 * See Table 6.16 - AM824 Stream Format 547 * Figure 6.19 - format_information field for AM824 Compound 548 * in AV/C Stream Format Information Specification 1.1 (Apr 2005, 1394TA) 549 * Also 'Clause 12 AM824 sequence adaption layers' in IEC 61883-6:2005 550 */ 551 int snd_oxfw_stream_parse_format(const u8 *format, 552 struct snd_oxfw_stream_formation *formation) 553 { 554 unsigned int i, e, channels, type; 555 556 memset(formation, 0, sizeof(struct snd_oxfw_stream_formation)); 557 558 /* 559 * this module can support a hierarchy combination that: 560 * Root: Audio and Music (0x90) 561 * Level 1: AM824 Compound (0x40) 562 */ 563 if ((format[0] != 0x90) || (format[1] != 0x40)) 564 return -ENXIO; 565 566 /* check the sampling rate */ 567 for (i = 0; i < ARRAY_SIZE(avc_stream_rate_table); i++) { 568 if (format[2] == avc_stream_rate_table[i]) 569 break; 570 } 571 if (i == ARRAY_SIZE(avc_stream_rate_table)) 572 return -ENXIO; 573 574 formation->rate = oxfw_rate_table[i]; 575 576 for (e = 0; e < format[4]; e++) { 577 channels = format[5 + e * 2]; 578 type = format[6 + e * 2]; 579 580 switch (type) { 581 /* IEC 60958 Conformant, currently handled as MBLA */ 582 case 0x00: 583 /* Multi Bit Linear Audio (Raw) */ 584 case 0x06: 585 formation->pcm += channels; 586 break; 587 /* MIDI Conformant */ 588 case 0x0d: 589 formation->midi = channels; 590 break; 591 /* IEC 61937-3 to 7 */ 592 case 0x01: 593 case 0x02: 594 case 0x03: 595 case 0x04: 596 case 0x05: 597 /* Multi Bit Linear Audio */ 598 case 0x07: /* DVD-Audio */ 599 case 0x0c: /* High Precision */ 600 /* One Bit Audio */ 601 case 0x08: /* (Plain) Raw */ 602 case 0x09: /* (Plain) SACD */ 603 case 0x0a: /* (Encoded) Raw */ 604 case 0x0b: /* (Encoded) SACD */ 605 /* SMPTE Time-Code conformant */ 606 case 0x0e: 607 /* Sample Count */ 608 case 0x0f: 609 /* Anciliary Data */ 610 case 0x10: 611 /* Synchronization Stream (Stereo Raw audio) */ 612 case 0x40: 613 /* Don't care */ 614 case 0xff: 615 default: 616 return -ENXIO; /* not supported */ 617 } 618 } 619 620 if (formation->pcm > AM824_MAX_CHANNELS_FOR_PCM || 621 formation->midi > AM824_MAX_CHANNELS_FOR_MIDI) 622 return -ENXIO; 623 624 return 0; 625 } 626 627 static int 628 assume_stream_formats(struct snd_oxfw *oxfw, enum avc_general_plug_dir dir, 629 unsigned int pid, u8 *buf, unsigned int *len, 630 u8 **formats) 631 { 632 struct snd_oxfw_stream_formation formation; 633 unsigned int i, eid; 634 int err; 635 636 // get format at current sampling rate. 637 if (!(oxfw->quirks & SND_OXFW_QUIRK_STREAM_FORMAT_INFO_UNSUPPORTED)) { 638 err = avc_stream_get_format_single(oxfw->unit, dir, pid, buf, len); 639 if (err < 0) { 640 dev_err(&oxfw->unit->device, 641 "fail to get current stream format for isoc %s plug %d:%d\n", 642 (dir == AVC_GENERAL_PLUG_DIR_IN) ? "in" : "out", 643 pid, err); 644 goto end; 645 } 646 } else { 647 // Miglia Harmony Audio does not support Extended Stream Format Information 648 // command. Use the hard-coded format, instead. 649 buf[0] = 0x90; 650 buf[1] = 0x40; 651 buf[2] = avc_stream_rate_table[0]; 652 buf[3] = 0x00; 653 buf[4] = 0x01; 654 655 if (dir == AVC_GENERAL_PLUG_DIR_IN) 656 buf[5] = 0x08; 657 else 658 buf[5] = 0x02; 659 660 buf[6] = 0x06; 661 662 *len = 7; 663 } 664 665 /* parse and set stream format */ 666 eid = 0; 667 err = snd_oxfw_stream_parse_format(buf, &formation); 668 if (err < 0) 669 goto end; 670 671 formats[eid] = devm_kmemdup(&oxfw->card->card_dev, buf, *len, 672 GFP_KERNEL); 673 if (!formats[eid]) { 674 err = -ENOMEM; 675 goto end; 676 } 677 678 /* apply the format for each available sampling rate */ 679 for (i = 0; i < ARRAY_SIZE(oxfw_rate_table); i++) { 680 if (formation.rate == oxfw_rate_table[i]) 681 continue; 682 683 err = avc_general_inquiry_sig_fmt(oxfw->unit, 684 oxfw_rate_table[i], 685 dir, pid); 686 if (err < 0) 687 continue; 688 689 eid++; 690 formats[eid] = devm_kmemdup(&oxfw->card->card_dev, buf, *len, 691 GFP_KERNEL); 692 if (formats[eid] == NULL) { 693 err = -ENOMEM; 694 goto end; 695 } 696 formats[eid][2] = avc_stream_rate_table[i]; 697 } 698 699 err = 0; 700 oxfw->assumed = true; 701 end: 702 return err; 703 } 704 705 static int fill_stream_formats(struct snd_oxfw *oxfw, 706 enum avc_general_plug_dir dir, 707 unsigned short pid) 708 { 709 u8 *buf, **formats; 710 unsigned int len, eid = 0; 711 struct snd_oxfw_stream_formation dummy; 712 int err; 713 714 buf = kmalloc(AVC_GENERIC_FRAME_MAXIMUM_BYTES, GFP_KERNEL); 715 if (buf == NULL) 716 return -ENOMEM; 717 718 if (dir == AVC_GENERAL_PLUG_DIR_OUT) 719 formats = oxfw->tx_stream_formats; 720 else 721 formats = oxfw->rx_stream_formats; 722 723 /* get first entry */ 724 len = AVC_GENERIC_FRAME_MAXIMUM_BYTES; 725 err = avc_stream_get_format_list(oxfw->unit, dir, 0, buf, &len, 0); 726 if (err == -ENXIO) { 727 /* LIST subfunction is not implemented */ 728 len = AVC_GENERIC_FRAME_MAXIMUM_BYTES; 729 err = assume_stream_formats(oxfw, dir, pid, buf, &len, 730 formats); 731 goto end; 732 } else if (err < 0) { 733 dev_err(&oxfw->unit->device, 734 "fail to get stream format %d for isoc %s plug %d:%d\n", 735 eid, (dir == AVC_GENERAL_PLUG_DIR_IN) ? "in" : "out", 736 pid, err); 737 goto end; 738 } 739 740 /* LIST subfunction is implemented */ 741 while (eid < SND_OXFW_STREAM_FORMAT_ENTRIES) { 742 /* The format is too short. */ 743 if (len < 3) { 744 err = -EIO; 745 break; 746 } 747 748 /* parse and set stream format */ 749 err = snd_oxfw_stream_parse_format(buf, &dummy); 750 if (err < 0) 751 break; 752 753 formats[eid] = devm_kmemdup(&oxfw->card->card_dev, buf, len, 754 GFP_KERNEL); 755 if (!formats[eid]) { 756 err = -ENOMEM; 757 break; 758 } 759 760 /* get next entry */ 761 len = AVC_GENERIC_FRAME_MAXIMUM_BYTES; 762 err = avc_stream_get_format_list(oxfw->unit, dir, 0, 763 buf, &len, ++eid); 764 /* No entries remained. */ 765 if (err == -EINVAL) { 766 err = 0; 767 break; 768 } else if (err < 0) { 769 dev_err(&oxfw->unit->device, 770 "fail to get stream format %d for isoc %s plug %d:%d\n", 771 eid, (dir == AVC_GENERAL_PLUG_DIR_IN) ? "in" : 772 "out", 773 pid, err); 774 break; 775 } 776 } 777 end: 778 kfree(buf); 779 return err; 780 } 781 782 int snd_oxfw_stream_discover(struct snd_oxfw *oxfw) 783 { 784 u8 plugs[AVC_PLUG_INFO_BUF_BYTES]; 785 struct snd_oxfw_stream_formation formation; 786 u8 *format; 787 unsigned int i; 788 int err; 789 790 /* the number of plugs for isoc in/out, ext in/out */ 791 err = avc_general_get_plug_info(oxfw->unit, 0x1f, 0x07, 0x00, plugs); 792 if (err < 0) { 793 dev_err(&oxfw->unit->device, 794 "fail to get info for isoc/external in/out plugs: %d\n", 795 err); 796 goto end; 797 } else if ((plugs[0] == 0) && (plugs[1] == 0)) { 798 err = -ENXIO; 799 goto end; 800 } 801 802 /* use oPCR[0] if exists */ 803 if (plugs[1] > 0) { 804 err = fill_stream_formats(oxfw, AVC_GENERAL_PLUG_DIR_OUT, 0); 805 if (err < 0) { 806 if (err != -ENXIO) 807 return err; 808 809 // The oPCR is not available for isoc communication. 810 err = 0; 811 } else { 812 for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) { 813 format = oxfw->tx_stream_formats[i]; 814 if (format == NULL) 815 continue; 816 err = snd_oxfw_stream_parse_format(format, 817 &formation); 818 if (err < 0) 819 continue; 820 821 /* Add one MIDI port. */ 822 if (formation.midi > 0) 823 oxfw->midi_input_ports = 1; 824 } 825 826 oxfw->has_output = true; 827 } 828 } 829 830 /* use iPCR[0] if exists */ 831 if (plugs[0] > 0) { 832 err = fill_stream_formats(oxfw, AVC_GENERAL_PLUG_DIR_IN, 0); 833 if (err < 0) { 834 if (err != -ENXIO) 835 return err; 836 837 // The iPCR is not available for isoc communication. 838 err = 0; 839 } else { 840 for (i = 0; i < SND_OXFW_STREAM_FORMAT_ENTRIES; i++) { 841 format = oxfw->rx_stream_formats[i]; 842 if (format == NULL) 843 continue; 844 err = snd_oxfw_stream_parse_format(format, 845 &formation); 846 if (err < 0) 847 continue; 848 849 /* Add one MIDI port. */ 850 if (formation.midi > 0) 851 oxfw->midi_output_ports = 1; 852 } 853 854 oxfw->has_input = true; 855 } 856 } 857 end: 858 return err; 859 } 860 861 void snd_oxfw_stream_lock_changed(struct snd_oxfw *oxfw) 862 { 863 oxfw->dev_lock_changed = true; 864 wake_up(&oxfw->hwdep_wait); 865 } 866 867 int snd_oxfw_stream_lock_try(struct snd_oxfw *oxfw) 868 { 869 int err; 870 871 spin_lock_irq(&oxfw->lock); 872 873 /* user land lock this */ 874 if (oxfw->dev_lock_count < 0) { 875 err = -EBUSY; 876 goto end; 877 } 878 879 /* this is the first time */ 880 if (oxfw->dev_lock_count++ == 0) 881 snd_oxfw_stream_lock_changed(oxfw); 882 err = 0; 883 end: 884 spin_unlock_irq(&oxfw->lock); 885 return err; 886 } 887 888 void snd_oxfw_stream_lock_release(struct snd_oxfw *oxfw) 889 { 890 spin_lock_irq(&oxfw->lock); 891 892 if (WARN_ON(oxfw->dev_lock_count <= 0)) 893 goto end; 894 if (--oxfw->dev_lock_count == 0) 895 snd_oxfw_stream_lock_changed(oxfw); 896 end: 897 spin_unlock_irq(&oxfw->lock); 898 } 899