1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Universal MIDI Packet (UMP) support 4 */ 5 6 #include <linux/list.h> 7 #include <linux/slab.h> 8 #include <linux/module.h> 9 #include <linux/export.h> 10 #include <linux/mm.h> 11 #include <sound/core.h> 12 #include <sound/rawmidi.h> 13 #include <sound/ump.h> 14 #include <sound/ump_convert.h> 15 16 #define ump_err(ump, fmt, args...) dev_err((ump)->core.dev, fmt, ##args) 17 #define ump_warn(ump, fmt, args...) dev_warn((ump)->core.dev, fmt, ##args) 18 #define ump_info(ump, fmt, args...) dev_info((ump)->core.dev, fmt, ##args) 19 #define ump_dbg(ump, fmt, args...) dev_dbg((ump)->core.dev, fmt, ##args) 20 21 static int snd_ump_dev_register(struct snd_rawmidi *rmidi); 22 static int snd_ump_dev_unregister(struct snd_rawmidi *rmidi); 23 static long snd_ump_ioctl(struct snd_rawmidi *rmidi, unsigned int cmd, 24 void __user *argp); 25 static void snd_ump_proc_read(struct snd_info_entry *entry, 26 struct snd_info_buffer *buffer); 27 static int snd_ump_rawmidi_open(struct snd_rawmidi_substream *substream); 28 static int snd_ump_rawmidi_close(struct snd_rawmidi_substream *substream); 29 static void snd_ump_rawmidi_trigger(struct snd_rawmidi_substream *substream, 30 int up); 31 static void snd_ump_rawmidi_drain(struct snd_rawmidi_substream *substream); 32 33 static void ump_handle_stream_msg(struct snd_ump_endpoint *ump, 34 const u32 *buf, int size); 35 #if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI) 36 static int process_legacy_output(struct snd_ump_endpoint *ump, 37 u32 *buffer, int count); 38 static void process_legacy_input(struct snd_ump_endpoint *ump, const u32 *src, 39 int words); 40 #else 41 static inline int process_legacy_output(struct snd_ump_endpoint *ump, 42 u32 *buffer, int count) 43 { 44 return 0; 45 } 46 static inline void process_legacy_input(struct snd_ump_endpoint *ump, 47 const u32 *src, int words) 48 { 49 } 50 #endif 51 52 static const struct snd_rawmidi_global_ops snd_ump_rawmidi_ops = { 53 .dev_register = snd_ump_dev_register, 54 .dev_unregister = snd_ump_dev_unregister, 55 .ioctl = snd_ump_ioctl, 56 .proc_read = snd_ump_proc_read, 57 }; 58 59 static const struct snd_rawmidi_ops snd_ump_rawmidi_input_ops = { 60 .open = snd_ump_rawmidi_open, 61 .close = snd_ump_rawmidi_close, 62 .trigger = snd_ump_rawmidi_trigger, 63 }; 64 65 static const struct snd_rawmidi_ops snd_ump_rawmidi_output_ops = { 66 .open = snd_ump_rawmidi_open, 67 .close = snd_ump_rawmidi_close, 68 .trigger = snd_ump_rawmidi_trigger, 69 .drain = snd_ump_rawmidi_drain, 70 }; 71 72 static void snd_ump_endpoint_free(struct snd_rawmidi *rmidi) 73 { 74 struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi); 75 struct snd_ump_block *fb; 76 77 while (!list_empty(&ump->block_list)) { 78 fb = list_first_entry(&ump->block_list, struct snd_ump_block, 79 list); 80 list_del(&fb->list); 81 if (fb->private_free) 82 fb->private_free(fb); 83 kfree(fb); 84 } 85 86 if (ump->private_free) 87 ump->private_free(ump); 88 89 #if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI) 90 kfree(ump->out_cvts); 91 #endif 92 } 93 94 /** 95 * snd_ump_endpoint_new - create a UMP Endpoint object 96 * @card: the card instance 97 * @id: the id string for rawmidi 98 * @device: the device index for rawmidi 99 * @output: 1 for enabling output 100 * @input: 1 for enabling input 101 * @ump_ret: the pointer to store the new UMP instance 102 * 103 * Creates a new UMP Endpoint object. A UMP Endpoint is tied with one rawmidi 104 * instance with one input and/or one output rawmidi stream (either uni- 105 * or bi-directional). A UMP Endpoint may contain one or multiple UMP Blocks 106 * that consist of one or multiple UMP Groups. 107 * 108 * Use snd_rawmidi_set_ops() to set the operators to the new instance. 109 * Unlike snd_rawmidi_new(), this function sets up the info_flags by itself 110 * depending on the given @output and @input. 111 * 112 * The device has SNDRV_RAWMIDI_INFO_UMP flag set and a different device 113 * file ("umpCxDx") than a standard MIDI 1.x device ("midiCxDx") is 114 * created. 115 * 116 * Return: Zero if successful, or a negative error code on failure. 117 */ 118 int snd_ump_endpoint_new(struct snd_card *card, char *id, int device, 119 int output, int input, 120 struct snd_ump_endpoint **ump_ret) 121 { 122 unsigned int info_flags = SNDRV_RAWMIDI_INFO_UMP; 123 struct snd_ump_endpoint *ump; 124 int err; 125 126 if (input) 127 info_flags |= SNDRV_RAWMIDI_INFO_INPUT; 128 if (output) 129 info_flags |= SNDRV_RAWMIDI_INFO_OUTPUT; 130 if (input && output) 131 info_flags |= SNDRV_RAWMIDI_INFO_DUPLEX; 132 133 ump = kzalloc(sizeof(*ump), GFP_KERNEL); 134 if (!ump) 135 return -ENOMEM; 136 INIT_LIST_HEAD(&ump->block_list); 137 mutex_init(&ump->open_mutex); 138 init_waitqueue_head(&ump->stream_wait); 139 #if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI) 140 spin_lock_init(&ump->legacy_locks[0]); 141 spin_lock_init(&ump->legacy_locks[1]); 142 #endif 143 err = snd_rawmidi_init(&ump->core, card, id, device, 144 output, input, info_flags); 145 if (err < 0) { 146 snd_rawmidi_free(&ump->core); 147 return err; 148 } 149 150 ump->info.card = card->number; 151 ump->info.device = device; 152 153 ump->core.private_free = snd_ump_endpoint_free; 154 ump->core.ops = &snd_ump_rawmidi_ops; 155 if (input) 156 snd_rawmidi_set_ops(&ump->core, SNDRV_RAWMIDI_STREAM_INPUT, 157 &snd_ump_rawmidi_input_ops); 158 if (output) 159 snd_rawmidi_set_ops(&ump->core, SNDRV_RAWMIDI_STREAM_OUTPUT, 160 &snd_ump_rawmidi_output_ops); 161 162 ump_dbg(ump, "Created a UMP EP #%d (%s)\n", device, id); 163 *ump_ret = ump; 164 return 0; 165 } 166 EXPORT_SYMBOL_GPL(snd_ump_endpoint_new); 167 168 /* 169 * Device register / unregister hooks; 170 * do nothing, placeholders for avoiding the default rawmidi handling 171 */ 172 173 #if IS_ENABLED(CONFIG_SND_SEQUENCER) 174 static void snd_ump_dev_seq_free(struct snd_seq_device *device) 175 { 176 struct snd_ump_endpoint *ump = device->private_data; 177 178 ump->seq_dev = NULL; 179 } 180 #endif 181 182 static int snd_ump_dev_register(struct snd_rawmidi *rmidi) 183 { 184 #if IS_ENABLED(CONFIG_SND_SEQUENCER) 185 struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi); 186 int err; 187 188 err = snd_seq_device_new(ump->core.card, ump->core.device, 189 SNDRV_SEQ_DEV_ID_UMP, 0, &ump->seq_dev); 190 if (err < 0) 191 return err; 192 ump->seq_dev->private_data = ump; 193 ump->seq_dev->private_free = snd_ump_dev_seq_free; 194 snd_device_register(ump->core.card, ump->seq_dev); 195 #endif 196 return 0; 197 } 198 199 static int snd_ump_dev_unregister(struct snd_rawmidi *rmidi) 200 { 201 return 0; 202 } 203 204 static struct snd_ump_block * 205 snd_ump_get_block(struct snd_ump_endpoint *ump, unsigned char id) 206 { 207 struct snd_ump_block *fb; 208 209 list_for_each_entry(fb, &ump->block_list, list) { 210 if (fb->info.block_id == id) 211 return fb; 212 } 213 return NULL; 214 } 215 216 /* 217 * rawmidi ops for UMP endpoint 218 */ 219 static int snd_ump_rawmidi_open(struct snd_rawmidi_substream *substream) 220 { 221 struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi); 222 int dir = substream->stream; 223 int err; 224 225 if (ump->substreams[dir]) 226 return -EBUSY; 227 err = ump->ops->open(ump, dir); 228 if (err < 0) 229 return err; 230 ump->substreams[dir] = substream; 231 return 0; 232 } 233 234 static int snd_ump_rawmidi_close(struct snd_rawmidi_substream *substream) 235 { 236 struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi); 237 int dir = substream->stream; 238 239 ump->substreams[dir] = NULL; 240 ump->ops->close(ump, dir); 241 return 0; 242 } 243 244 static void snd_ump_rawmidi_trigger(struct snd_rawmidi_substream *substream, 245 int up) 246 { 247 struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi); 248 int dir = substream->stream; 249 250 ump->ops->trigger(ump, dir, up); 251 } 252 253 static void snd_ump_rawmidi_drain(struct snd_rawmidi_substream *substream) 254 { 255 struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi); 256 257 if (ump->ops->drain) 258 ump->ops->drain(ump, SNDRV_RAWMIDI_STREAM_OUTPUT); 259 } 260 261 /* number of 32bit words per message type */ 262 static unsigned char ump_packet_words[0x10] = { 263 1, 1, 1, 2, 2, 4, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4 264 }; 265 266 /** 267 * snd_ump_receive_ump_val - parse the UMP packet data 268 * @ump: UMP endpoint 269 * @val: UMP packet data 270 * 271 * The data is copied onto ump->input_buf[]. 272 * When a full packet is completed, returns the number of words (from 1 to 4). 273 * OTOH, if the packet is incomplete, returns 0. 274 */ 275 int snd_ump_receive_ump_val(struct snd_ump_endpoint *ump, u32 val) 276 { 277 int words; 278 279 if (!ump->input_pending) 280 ump->input_pending = ump_packet_words[ump_message_type(val)]; 281 282 ump->input_buf[ump->input_buf_head++] = val; 283 ump->input_pending--; 284 if (!ump->input_pending) { 285 words = ump->input_buf_head; 286 ump->input_buf_head = 0; 287 return words; 288 } 289 return 0; 290 } 291 EXPORT_SYMBOL_GPL(snd_ump_receive_ump_val); 292 293 /** 294 * snd_ump_receive - transfer UMP packets from the device 295 * @ump: the UMP endpoint 296 * @buffer: the buffer pointer to transfer 297 * @count: byte size to transfer 298 * 299 * Called from the driver to submit the received UMP packets from the device 300 * to user-space. It's essentially a wrapper of rawmidi_receive(). 301 * The data to receive is in CPU-native endianness. 302 */ 303 int snd_ump_receive(struct snd_ump_endpoint *ump, const u32 *buffer, int count) 304 { 305 struct snd_rawmidi_substream *substream; 306 const u32 *p = buffer; 307 int n, words = count >> 2; 308 309 while (words--) { 310 n = snd_ump_receive_ump_val(ump, *p++); 311 if (!n) 312 continue; 313 ump_handle_stream_msg(ump, ump->input_buf, n); 314 #if IS_ENABLED(CONFIG_SND_SEQUENCER) 315 if (ump->seq_ops) 316 ump->seq_ops->input_receive(ump, ump->input_buf, n); 317 #endif 318 process_legacy_input(ump, ump->input_buf, n); 319 } 320 321 substream = ump->substreams[SNDRV_RAWMIDI_STREAM_INPUT]; 322 if (!substream) 323 return 0; 324 return snd_rawmidi_receive(substream, (const char *)buffer, count); 325 } 326 EXPORT_SYMBOL_GPL(snd_ump_receive); 327 328 /** 329 * snd_ump_transmit - transmit UMP packets 330 * @ump: the UMP endpoint 331 * @buffer: the buffer pointer to transfer 332 * @count: byte size to transfer 333 * 334 * Called from the driver to obtain the UMP packets from user-space to the 335 * device. It's essentially a wrapper of rawmidi_transmit(). 336 * The data to transmit is in CPU-native endianness. 337 */ 338 int snd_ump_transmit(struct snd_ump_endpoint *ump, u32 *buffer, int count) 339 { 340 struct snd_rawmidi_substream *substream = 341 ump->substreams[SNDRV_RAWMIDI_STREAM_OUTPUT]; 342 int err; 343 344 if (!substream) 345 return -ENODEV; 346 err = snd_rawmidi_transmit(substream, (char *)buffer, count); 347 /* received either data or an error? */ 348 if (err) 349 return err; 350 return process_legacy_output(ump, buffer, count); 351 } 352 EXPORT_SYMBOL_GPL(snd_ump_transmit); 353 354 /** 355 * snd_ump_block_new - Create a UMP block 356 * @ump: UMP object 357 * @blk: block ID number to create 358 * @direction: direction (in/out/bidirection) 359 * @first_group: the first group ID (0-based) 360 * @num_groups: the number of groups in this block 361 * @blk_ret: the pointer to store the resultant block object 362 */ 363 int snd_ump_block_new(struct snd_ump_endpoint *ump, unsigned int blk, 364 unsigned int direction, unsigned int first_group, 365 unsigned int num_groups, struct snd_ump_block **blk_ret) 366 { 367 struct snd_ump_block *fb, *p; 368 369 if (blk < 0 || blk >= SNDRV_UMP_MAX_BLOCKS) 370 return -EINVAL; 371 372 if (snd_ump_get_block(ump, blk)) 373 return -EBUSY; 374 375 fb = kzalloc(sizeof(*fb), GFP_KERNEL); 376 if (!fb) 377 return -ENOMEM; 378 379 fb->ump = ump; 380 fb->info.card = ump->info.card; 381 fb->info.device = ump->info.device; 382 fb->info.block_id = blk; 383 if (blk >= ump->info.num_blocks) 384 ump->info.num_blocks = blk + 1; 385 fb->info.direction = direction; 386 fb->info.active = 1; 387 fb->info.first_group = first_group; 388 fb->info.num_groups = num_groups; 389 /* fill the default name, may be overwritten to a better name */ 390 snprintf(fb->info.name, sizeof(fb->info.name), "Group %d-%d", 391 first_group + 1, first_group + num_groups); 392 393 /* put the entry in the ordered list */ 394 list_for_each_entry(p, &ump->block_list, list) { 395 if (p->info.block_id > blk) { 396 list_add_tail(&fb->list, &p->list); 397 goto added; 398 } 399 } 400 list_add_tail(&fb->list, &ump->block_list); 401 402 added: 403 ump_dbg(ump, "Created a UMP Block #%d (%s)\n", blk, fb->info.name); 404 *blk_ret = fb; 405 return 0; 406 } 407 EXPORT_SYMBOL_GPL(snd_ump_block_new); 408 409 static int snd_ump_ioctl_block(struct snd_ump_endpoint *ump, 410 struct snd_ump_block_info __user *argp) 411 { 412 struct snd_ump_block *fb; 413 unsigned char id; 414 415 if (get_user(id, &argp->block_id)) 416 return -EFAULT; 417 fb = snd_ump_get_block(ump, id); 418 if (!fb) 419 return -ENOENT; 420 if (copy_to_user(argp, &fb->info, sizeof(fb->info))) 421 return -EFAULT; 422 return 0; 423 } 424 425 /* 426 * Handle UMP-specific ioctls; called from snd_rawmidi_ioctl() 427 */ 428 static long snd_ump_ioctl(struct snd_rawmidi *rmidi, unsigned int cmd, 429 void __user *argp) 430 { 431 struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi); 432 433 switch (cmd) { 434 case SNDRV_UMP_IOCTL_ENDPOINT_INFO: 435 if (copy_to_user(argp, &ump->info, sizeof(ump->info))) 436 return -EFAULT; 437 return 0; 438 case SNDRV_UMP_IOCTL_BLOCK_INFO: 439 return snd_ump_ioctl_block(ump, argp); 440 default: 441 ump_dbg(ump, "rawmidi: unknown command = 0x%x\n", cmd); 442 return -ENOTTY; 443 } 444 } 445 446 static const char *ump_direction_string(int dir) 447 { 448 switch (dir) { 449 case SNDRV_UMP_DIR_INPUT: 450 return "input"; 451 case SNDRV_UMP_DIR_OUTPUT: 452 return "output"; 453 case SNDRV_UMP_DIR_BIDIRECTION: 454 return "bidirection"; 455 default: 456 return "unknown"; 457 } 458 } 459 460 static const char *ump_ui_hint_string(int dir) 461 { 462 switch (dir) { 463 case SNDRV_UMP_BLOCK_UI_HINT_RECEIVER: 464 return "receiver"; 465 case SNDRV_UMP_BLOCK_UI_HINT_SENDER: 466 return "sender"; 467 case SNDRV_UMP_BLOCK_UI_HINT_BOTH: 468 return "both"; 469 default: 470 return "unknown"; 471 } 472 } 473 474 /* Additional proc file output */ 475 static void snd_ump_proc_read(struct snd_info_entry *entry, 476 struct snd_info_buffer *buffer) 477 { 478 struct snd_rawmidi *rmidi = entry->private_data; 479 struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi); 480 struct snd_ump_block *fb; 481 482 snd_iprintf(buffer, "EP Name: %s\n", ump->info.name); 483 snd_iprintf(buffer, "EP Product ID: %s\n", ump->info.product_id); 484 snd_iprintf(buffer, "UMP Version: 0x%04x\n", ump->info.version); 485 snd_iprintf(buffer, "Protocol Caps: 0x%08x\n", ump->info.protocol_caps); 486 snd_iprintf(buffer, "Protocol: 0x%08x\n", ump->info.protocol); 487 if (ump->info.version) { 488 snd_iprintf(buffer, "Manufacturer ID: 0x%08x\n", 489 ump->info.manufacturer_id); 490 snd_iprintf(buffer, "Family ID: 0x%04x\n", ump->info.family_id); 491 snd_iprintf(buffer, "Model ID: 0x%04x\n", ump->info.model_id); 492 snd_iprintf(buffer, "SW Revision: 0x%02x%02x%02x%02x\n", 493 ump->info.sw_revision[0], 494 ump->info.sw_revision[1], 495 ump->info.sw_revision[2], 496 ump->info.sw_revision[3]); 497 } 498 snd_iprintf(buffer, "Static Blocks: %s\n", 499 (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS) ? "Yes" : "No"); 500 snd_iprintf(buffer, "Num Blocks: %d\n\n", ump->info.num_blocks); 501 502 list_for_each_entry(fb, &ump->block_list, list) { 503 snd_iprintf(buffer, "Block %d (%s)\n", fb->info.block_id, 504 fb->info.name); 505 snd_iprintf(buffer, " Direction: %s\n", 506 ump_direction_string(fb->info.direction)); 507 snd_iprintf(buffer, " Active: %s\n", 508 fb->info.active ? "Yes" : "No"); 509 snd_iprintf(buffer, " Groups: %d-%d\n", 510 fb->info.first_group + 1, 511 fb->info.first_group + fb->info.num_groups); 512 snd_iprintf(buffer, " Is MIDI1: %s%s\n", 513 (fb->info.flags & SNDRV_UMP_BLOCK_IS_MIDI1) ? "Yes" : "No", 514 (fb->info.flags & SNDRV_UMP_BLOCK_IS_LOWSPEED) ? " (Low Speed)" : ""); 515 if (ump->info.version) { 516 snd_iprintf(buffer, " MIDI-CI Version: %d\n", 517 fb->info.midi_ci_version); 518 snd_iprintf(buffer, " Sysex8 Streams: %d\n", 519 fb->info.sysex8_streams); 520 snd_iprintf(buffer, " UI Hint: %s\n", 521 ump_ui_hint_string(fb->info.ui_hint)); 522 } 523 snd_iprintf(buffer, "\n"); 524 } 525 } 526 527 /* update dir_bits and active flag for all groups in the client */ 528 void snd_ump_update_group_attrs(struct snd_ump_endpoint *ump) 529 { 530 struct snd_ump_block *fb; 531 struct snd_ump_group *group; 532 int i; 533 534 for (i = 0; i < SNDRV_UMP_MAX_GROUPS; i++) { 535 group = &ump->groups[i]; 536 *group->name = 0; 537 group->dir_bits = 0; 538 group->active = 0; 539 group->group = i; 540 group->valid = false; 541 group->is_midi1 = false; 542 } 543 544 list_for_each_entry(fb, &ump->block_list, list) { 545 if (fb->info.first_group + fb->info.num_groups > SNDRV_UMP_MAX_GROUPS) 546 break; 547 group = &ump->groups[fb->info.first_group]; 548 for (i = 0; i < fb->info.num_groups; i++, group++) { 549 group->valid = true; 550 if (fb->info.active) 551 group->active = 1; 552 if (fb->info.flags & SNDRV_UMP_BLOCK_IS_MIDI1) 553 group->is_midi1 = true; 554 switch (fb->info.direction) { 555 case SNDRV_UMP_DIR_INPUT: 556 group->dir_bits |= (1 << SNDRV_RAWMIDI_STREAM_INPUT); 557 break; 558 case SNDRV_UMP_DIR_OUTPUT: 559 group->dir_bits |= (1 << SNDRV_RAWMIDI_STREAM_OUTPUT); 560 break; 561 case SNDRV_UMP_DIR_BIDIRECTION: 562 group->dir_bits |= (1 << SNDRV_RAWMIDI_STREAM_INPUT) | 563 (1 << SNDRV_RAWMIDI_STREAM_OUTPUT); 564 break; 565 } 566 if (!*fb->info.name) 567 continue; 568 if (!*group->name) { 569 /* store the first matching name */ 570 strscpy(group->name, fb->info.name, 571 sizeof(group->name)); 572 } else { 573 /* when overlapping, concat names */ 574 strlcat(group->name, ", ", sizeof(group->name)); 575 strlcat(group->name, fb->info.name, 576 sizeof(group->name)); 577 } 578 } 579 } 580 } 581 EXPORT_SYMBOL_GPL(snd_ump_update_group_attrs); 582 583 /* 584 * UMP endpoint and function block handling 585 */ 586 587 /* open / close UMP streams for the internal stream msg communication */ 588 static int ump_request_open(struct snd_ump_endpoint *ump) 589 { 590 return snd_rawmidi_kernel_open(&ump->core, 0, 591 SNDRV_RAWMIDI_LFLG_OUTPUT, 592 &ump->stream_rfile); 593 } 594 595 static void ump_request_close(struct snd_ump_endpoint *ump) 596 { 597 snd_rawmidi_kernel_release(&ump->stream_rfile); 598 } 599 600 /* request a command and wait for the given response; 601 * @req1 and @req2 are u32 commands 602 * @reply is the expected UMP stream status 603 */ 604 static int ump_req_msg(struct snd_ump_endpoint *ump, u32 req1, u32 req2, 605 u32 reply) 606 { 607 u32 buf[4]; 608 609 ump_dbg(ump, "%s: request %08x %08x, wait-for %08x\n", 610 __func__, req1, req2, reply); 611 memset(buf, 0, sizeof(buf)); 612 buf[0] = req1; 613 buf[1] = req2; 614 ump->stream_finished = 0; 615 ump->stream_wait_for = reply; 616 snd_rawmidi_kernel_write(ump->stream_rfile.output, 617 (unsigned char *)&buf, 16); 618 wait_event_timeout(ump->stream_wait, ump->stream_finished, 619 msecs_to_jiffies(500)); 620 if (!READ_ONCE(ump->stream_finished)) { 621 ump_dbg(ump, "%s: request timed out\n", __func__); 622 return -ETIMEDOUT; 623 } 624 ump->stream_finished = 0; 625 ump_dbg(ump, "%s: reply: %08x %08x %08x %08x\n", 626 __func__, buf[0], buf[1], buf[2], buf[3]); 627 return 0; 628 } 629 630 /* append the received letters via UMP packet to the given string buffer; 631 * return 1 if the full string is received or 0 to continue 632 */ 633 static int ump_append_string(struct snd_ump_endpoint *ump, char *dest, 634 int maxsize, const u32 *buf, int offset) 635 { 636 unsigned char format; 637 int c; 638 639 format = ump_stream_message_format(buf[0]); 640 if (format == UMP_STREAM_MSG_FORMAT_SINGLE || 641 format == UMP_STREAM_MSG_FORMAT_START) { 642 c = 0; 643 } else { 644 c = strlen(dest); 645 if (c >= maxsize - 1) 646 return 1; 647 } 648 649 for (; offset < 16; offset++) { 650 dest[c] = buf[offset / 4] >> (3 - (offset % 4)) * 8; 651 if (!dest[c]) 652 break; 653 if (++c >= maxsize - 1) 654 break; 655 } 656 dest[c] = 0; 657 return (format == UMP_STREAM_MSG_FORMAT_SINGLE || 658 format == UMP_STREAM_MSG_FORMAT_END); 659 } 660 661 /* Choose the default protocol */ 662 static void choose_default_protocol(struct snd_ump_endpoint *ump) 663 { 664 if (ump->info.protocol & SNDRV_UMP_EP_INFO_PROTO_MIDI_MASK) 665 return; 666 if (ump->info.protocol_caps & SNDRV_UMP_EP_INFO_PROTO_MIDI2) 667 ump->info.protocol |= SNDRV_UMP_EP_INFO_PROTO_MIDI2; 668 else 669 ump->info.protocol |= SNDRV_UMP_EP_INFO_PROTO_MIDI1; 670 } 671 672 /* handle EP info stream message; update the UMP attributes */ 673 static int ump_handle_ep_info_msg(struct snd_ump_endpoint *ump, 674 const union snd_ump_stream_msg *buf) 675 { 676 ump->info.version = (buf->ep_info.ump_version_major << 8) | 677 buf->ep_info.ump_version_minor; 678 ump->info.num_blocks = buf->ep_info.num_function_blocks; 679 if (ump->info.num_blocks > SNDRV_UMP_MAX_BLOCKS) { 680 ump_info(ump, "Invalid function blocks %d, fallback to 1\n", 681 ump->info.num_blocks); 682 ump->info.num_blocks = 1; 683 } 684 685 if (buf->ep_info.static_function_block) 686 ump->info.flags |= SNDRV_UMP_EP_INFO_STATIC_BLOCKS; 687 688 ump->info.protocol_caps = (buf->ep_info.protocol << 8) | 689 buf->ep_info.jrts; 690 691 ump_dbg(ump, "EP info: version=%x, num_blocks=%x, proto_caps=%x\n", 692 ump->info.version, ump->info.num_blocks, ump->info.protocol_caps); 693 694 ump->info.protocol &= ump->info.protocol_caps; 695 choose_default_protocol(ump); 696 697 return 1; /* finished */ 698 } 699 700 /* handle EP device info stream message; update the UMP attributes */ 701 static int ump_handle_device_info_msg(struct snd_ump_endpoint *ump, 702 const union snd_ump_stream_msg *buf) 703 { 704 ump->info.manufacturer_id = buf->device_info.manufacture_id & 0x7f7f7f; 705 ump->info.family_id = (buf->device_info.family_msb << 8) | 706 buf->device_info.family_lsb; 707 ump->info.model_id = (buf->device_info.model_msb << 8) | 708 buf->device_info.model_lsb; 709 ump->info.sw_revision[0] = (buf->device_info.sw_revision >> 24) & 0x7f; 710 ump->info.sw_revision[1] = (buf->device_info.sw_revision >> 16) & 0x7f; 711 ump->info.sw_revision[2] = (buf->device_info.sw_revision >> 8) & 0x7f; 712 ump->info.sw_revision[3] = buf->device_info.sw_revision & 0x7f; 713 ump_dbg(ump, "EP devinfo: manid=%08x, family=%04x, model=%04x, sw=%02x%02x%02x%02x\n", 714 ump->info.manufacturer_id, 715 ump->info.family_id, 716 ump->info.model_id, 717 ump->info.sw_revision[0], 718 ump->info.sw_revision[1], 719 ump->info.sw_revision[2], 720 ump->info.sw_revision[3]); 721 return 1; /* finished */ 722 } 723 724 /* handle EP name stream message; update the UMP name string */ 725 static int ump_handle_ep_name_msg(struct snd_ump_endpoint *ump, 726 const union snd_ump_stream_msg *buf) 727 { 728 return ump_append_string(ump, ump->info.name, sizeof(ump->info.name), 729 buf->raw, 2); 730 } 731 732 /* handle EP product id stream message; update the UMP product_id string */ 733 static int ump_handle_product_id_msg(struct snd_ump_endpoint *ump, 734 const union snd_ump_stream_msg *buf) 735 { 736 return ump_append_string(ump, ump->info.product_id, 737 sizeof(ump->info.product_id), 738 buf->raw, 2); 739 } 740 741 /* notify the protocol change to sequencer */ 742 static void seq_notify_protocol(struct snd_ump_endpoint *ump) 743 { 744 #if IS_ENABLED(CONFIG_SND_SEQUENCER) 745 if (ump->seq_ops && ump->seq_ops->switch_protocol) 746 ump->seq_ops->switch_protocol(ump); 747 #endif /* CONFIG_SND_SEQUENCER */ 748 } 749 750 /** 751 * snd_ump_switch_protocol - switch MIDI protocol 752 * @ump: UMP endpoint 753 * @protocol: protocol to switch to 754 * 755 * Returns 1 if the protocol is actually switched, 0 if unchanged 756 */ 757 int snd_ump_switch_protocol(struct snd_ump_endpoint *ump, unsigned int protocol) 758 { 759 unsigned int type; 760 761 protocol &= ump->info.protocol_caps; 762 if (protocol == ump->info.protocol) 763 return 0; 764 765 type = protocol & SNDRV_UMP_EP_INFO_PROTO_MIDI_MASK; 766 if (type != SNDRV_UMP_EP_INFO_PROTO_MIDI1 && 767 type != SNDRV_UMP_EP_INFO_PROTO_MIDI2) 768 return 0; 769 770 ump->info.protocol = protocol; 771 ump_dbg(ump, "New protocol = %x (caps = %x)\n", 772 protocol, ump->info.protocol_caps); 773 seq_notify_protocol(ump); 774 return 1; 775 } 776 EXPORT_SYMBOL_GPL(snd_ump_switch_protocol); 777 778 /* handle EP stream config message; update the UMP protocol */ 779 static int ump_handle_stream_cfg_msg(struct snd_ump_endpoint *ump, 780 const union snd_ump_stream_msg *buf) 781 { 782 unsigned int protocol = 783 (buf->stream_cfg.protocol << 8) | buf->stream_cfg.jrts; 784 785 snd_ump_switch_protocol(ump, protocol); 786 return 1; /* finished */ 787 } 788 789 /* Extract Function Block info from UMP packet */ 790 static void fill_fb_info(struct snd_ump_endpoint *ump, 791 struct snd_ump_block_info *info, 792 const union snd_ump_stream_msg *buf) 793 { 794 info->direction = buf->fb_info.direction; 795 info->ui_hint = buf->fb_info.ui_hint; 796 info->first_group = buf->fb_info.first_group; 797 info->num_groups = buf->fb_info.num_groups; 798 info->flags = buf->fb_info.midi_10; 799 info->active = buf->fb_info.active; 800 info->midi_ci_version = buf->fb_info.midi_ci_version; 801 info->sysex8_streams = buf->fb_info.sysex8_streams; 802 803 ump_dbg(ump, "FB %d: dir=%d, active=%d, first_gp=%d, num_gp=%d, midici=%d, sysex8=%d, flags=0x%x\n", 804 info->block_id, info->direction, info->active, 805 info->first_group, info->num_groups, info->midi_ci_version, 806 info->sysex8_streams, info->flags); 807 808 if ((info->flags & SNDRV_UMP_BLOCK_IS_MIDI1) && info->num_groups != 1) { 809 info->num_groups = 1; 810 ump_dbg(ump, "FB %d: corrected groups to 1 for MIDI1\n", 811 info->block_id); 812 } 813 } 814 815 /* check whether the FB info gets updated by the current message */ 816 static bool is_fb_info_updated(struct snd_ump_endpoint *ump, 817 struct snd_ump_block *fb, 818 const union snd_ump_stream_msg *buf) 819 { 820 char tmpbuf[offsetof(struct snd_ump_block_info, name)]; 821 822 if (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS) { 823 ump_info(ump, "Skipping static FB info update (blk#%d)\n", 824 fb->info.block_id); 825 return 0; 826 } 827 828 memcpy(tmpbuf, &fb->info, sizeof(tmpbuf)); 829 fill_fb_info(ump, (struct snd_ump_block_info *)tmpbuf, buf); 830 return memcmp(&fb->info, tmpbuf, sizeof(tmpbuf)) != 0; 831 } 832 833 /* notify the FB info/name change to sequencer */ 834 static void seq_notify_fb_change(struct snd_ump_endpoint *ump, 835 struct snd_ump_block *fb) 836 { 837 #if IS_ENABLED(CONFIG_SND_SEQUENCER) 838 if (ump->seq_ops && ump->seq_ops->notify_fb_change) 839 ump->seq_ops->notify_fb_change(ump, fb); 840 #endif 841 } 842 843 /* handle FB info message; update FB info if the block is present */ 844 static int ump_handle_fb_info_msg(struct snd_ump_endpoint *ump, 845 const union snd_ump_stream_msg *buf) 846 { 847 unsigned char blk; 848 struct snd_ump_block *fb; 849 850 blk = buf->fb_info.function_block_id; 851 fb = snd_ump_get_block(ump, blk); 852 853 /* complain only if updated after parsing */ 854 if (!fb && ump->parsed) { 855 ump_info(ump, "Function Block Info Update for non-existing block %d\n", 856 blk); 857 return -ENODEV; 858 } 859 860 /* When updated after the initial parse, check the FB info update */ 861 if (ump->parsed && !is_fb_info_updated(ump, fb, buf)) 862 return 1; /* no content change */ 863 864 if (fb) { 865 fill_fb_info(ump, &fb->info, buf); 866 if (ump->parsed) { 867 snd_ump_update_group_attrs(ump); 868 seq_notify_fb_change(ump, fb); 869 } 870 } 871 872 return 1; /* finished */ 873 } 874 875 /* handle FB name message; update the FB name string */ 876 static int ump_handle_fb_name_msg(struct snd_ump_endpoint *ump, 877 const union snd_ump_stream_msg *buf) 878 { 879 unsigned char blk; 880 struct snd_ump_block *fb; 881 int ret; 882 883 blk = buf->fb_name.function_block_id; 884 fb = snd_ump_get_block(ump, blk); 885 if (!fb) 886 return -ENODEV; 887 888 if (ump->parsed && 889 (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS)) { 890 ump_dbg(ump, "Skipping static FB name update (blk#%d)\n", 891 fb->info.block_id); 892 return 0; 893 } 894 895 ret = ump_append_string(ump, fb->info.name, sizeof(fb->info.name), 896 buf->raw, 3); 897 /* notify the FB name update to sequencer, too */ 898 if (ret > 0 && ump->parsed) { 899 snd_ump_update_group_attrs(ump); 900 seq_notify_fb_change(ump, fb); 901 } 902 return ret; 903 } 904 905 static int create_block_from_fb_info(struct snd_ump_endpoint *ump, int blk) 906 { 907 struct snd_ump_block *fb; 908 unsigned char direction, first_group, num_groups; 909 const union snd_ump_stream_msg *buf = 910 (const union snd_ump_stream_msg *)ump->input_buf; 911 u32 msg; 912 int err; 913 914 /* query the FB info once */ 915 msg = ump_stream_compose(UMP_STREAM_MSG_STATUS_FB_DISCOVERY, 0) | 916 (blk << 8) | UMP_STREAM_MSG_REQUEST_FB_INFO; 917 err = ump_req_msg(ump, msg, 0, UMP_STREAM_MSG_STATUS_FB_INFO); 918 if (err < 0) { 919 ump_dbg(ump, "Unable to get FB info for block %d\n", blk); 920 return err; 921 } 922 923 /* the last input must be the FB info */ 924 if (buf->fb_info.status != UMP_STREAM_MSG_STATUS_FB_INFO) { 925 ump_dbg(ump, "Inconsistent input: 0x%x\n", *buf->raw); 926 return -EINVAL; 927 } 928 929 direction = buf->fb_info.direction; 930 first_group = buf->fb_info.first_group; 931 num_groups = buf->fb_info.num_groups; 932 933 err = snd_ump_block_new(ump, blk, direction, first_group, num_groups, 934 &fb); 935 if (err < 0) 936 return err; 937 938 fill_fb_info(ump, &fb->info, buf); 939 940 msg = ump_stream_compose(UMP_STREAM_MSG_STATUS_FB_DISCOVERY, 0) | 941 (blk << 8) | UMP_STREAM_MSG_REQUEST_FB_NAME; 942 err = ump_req_msg(ump, msg, 0, UMP_STREAM_MSG_STATUS_FB_NAME); 943 if (err) 944 ump_dbg(ump, "Unable to get UMP FB name string #%d\n", blk); 945 946 return 0; 947 } 948 949 /* handle stream messages, called from snd_ump_receive() */ 950 static void ump_handle_stream_msg(struct snd_ump_endpoint *ump, 951 const u32 *buf, int size) 952 { 953 const union snd_ump_stream_msg *msg; 954 unsigned int status; 955 int ret; 956 957 /* UMP stream message suppressed (for gadget UMP)? */ 958 if (ump->no_process_stream) 959 return; 960 961 BUILD_BUG_ON(sizeof(*msg) != 16); 962 ump_dbg(ump, "Stream msg: %08x %08x %08x %08x\n", 963 buf[0], buf[1], buf[2], buf[3]); 964 965 if (size != 4 || ump_message_type(*buf) != UMP_MSG_TYPE_STREAM) 966 return; 967 968 msg = (const union snd_ump_stream_msg *)buf; 969 status = ump_stream_message_status(*buf); 970 switch (status) { 971 case UMP_STREAM_MSG_STATUS_EP_INFO: 972 ret = ump_handle_ep_info_msg(ump, msg); 973 break; 974 case UMP_STREAM_MSG_STATUS_DEVICE_INFO: 975 ret = ump_handle_device_info_msg(ump, msg); 976 break; 977 case UMP_STREAM_MSG_STATUS_EP_NAME: 978 ret = ump_handle_ep_name_msg(ump, msg); 979 break; 980 case UMP_STREAM_MSG_STATUS_PRODUCT_ID: 981 ret = ump_handle_product_id_msg(ump, msg); 982 break; 983 case UMP_STREAM_MSG_STATUS_STREAM_CFG: 984 ret = ump_handle_stream_cfg_msg(ump, msg); 985 break; 986 case UMP_STREAM_MSG_STATUS_FB_INFO: 987 ret = ump_handle_fb_info_msg(ump, msg); 988 break; 989 case UMP_STREAM_MSG_STATUS_FB_NAME: 990 ret = ump_handle_fb_name_msg(ump, msg); 991 break; 992 default: 993 return; 994 } 995 996 /* when the message has been processed fully, wake up */ 997 if (ret > 0 && ump->stream_wait_for == status) { 998 WRITE_ONCE(ump->stream_finished, 1); 999 wake_up(&ump->stream_wait); 1000 } 1001 } 1002 1003 /** 1004 * snd_ump_parse_endpoint - parse endpoint and create function blocks 1005 * @ump: UMP object 1006 * 1007 * Returns 0 for successful parse, -ENODEV if device doesn't respond 1008 * (or the query is unsupported), or other error code for serious errors. 1009 */ 1010 int snd_ump_parse_endpoint(struct snd_ump_endpoint *ump) 1011 { 1012 int blk, err; 1013 u32 msg; 1014 1015 if (!(ump->core.info_flags & SNDRV_RAWMIDI_INFO_DUPLEX)) 1016 return -ENODEV; 1017 1018 err = ump_request_open(ump); 1019 if (err < 0) { 1020 ump_dbg(ump, "Unable to open rawmidi device: %d\n", err); 1021 return err; 1022 } 1023 1024 /* Check Endpoint Information */ 1025 msg = ump_stream_compose(UMP_STREAM_MSG_STATUS_EP_DISCOVERY, 0) | 1026 0x0101; /* UMP version 1.1 */ 1027 err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_EP_INFO, 1028 UMP_STREAM_MSG_STATUS_EP_INFO); 1029 if (err < 0) { 1030 ump_dbg(ump, "Unable to get UMP EP info\n"); 1031 goto error; 1032 } 1033 1034 /* Request Endpoint Device Info */ 1035 err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_DEVICE_INFO, 1036 UMP_STREAM_MSG_STATUS_DEVICE_INFO); 1037 if (err < 0) 1038 ump_dbg(ump, "Unable to get UMP EP device info\n"); 1039 1040 /* Request Endpoint Name */ 1041 err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_EP_NAME, 1042 UMP_STREAM_MSG_STATUS_EP_NAME); 1043 if (err < 0) 1044 ump_dbg(ump, "Unable to get UMP EP name string\n"); 1045 1046 /* Request Endpoint Product ID */ 1047 err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_PRODUCT_ID, 1048 UMP_STREAM_MSG_STATUS_PRODUCT_ID); 1049 if (err < 0) 1050 ump_dbg(ump, "Unable to get UMP EP product ID string\n"); 1051 1052 /* Get the current stream configuration */ 1053 err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_STREAM_CFG, 1054 UMP_STREAM_MSG_STATUS_STREAM_CFG); 1055 if (err < 0) 1056 ump_dbg(ump, "Unable to get UMP EP stream config\n"); 1057 1058 /* If no protocol is set by some reason, assume the valid one */ 1059 choose_default_protocol(ump); 1060 1061 /* Query and create blocks from Function Blocks */ 1062 for (blk = 0; blk < ump->info.num_blocks; blk++) { 1063 err = create_block_from_fb_info(ump, blk); 1064 if (err < 0) 1065 continue; 1066 } 1067 1068 /* initialize group attributions */ 1069 snd_ump_update_group_attrs(ump); 1070 1071 error: 1072 ump->parsed = true; 1073 ump_request_close(ump); 1074 if (err == -ETIMEDOUT) 1075 err = -ENODEV; 1076 return err; 1077 } 1078 EXPORT_SYMBOL_GPL(snd_ump_parse_endpoint); 1079 1080 #if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI) 1081 /* 1082 * Legacy rawmidi support 1083 */ 1084 static int snd_ump_legacy_open(struct snd_rawmidi_substream *substream) 1085 { 1086 struct snd_ump_endpoint *ump = substream->rmidi->private_data; 1087 int dir = substream->stream; 1088 int group = ump->legacy_mapping[substream->number]; 1089 int err; 1090 1091 guard(mutex)(&ump->open_mutex); 1092 if (ump->legacy_substreams[dir][group]) 1093 return -EBUSY; 1094 if (dir == SNDRV_RAWMIDI_STREAM_OUTPUT) { 1095 if (!ump->legacy_out_opens) { 1096 err = snd_rawmidi_kernel_open(&ump->core, 0, 1097 SNDRV_RAWMIDI_LFLG_OUTPUT | 1098 SNDRV_RAWMIDI_LFLG_APPEND, 1099 &ump->legacy_out_rfile); 1100 if (err < 0) 1101 return err; 1102 } 1103 ump->legacy_out_opens++; 1104 snd_ump_convert_reset(&ump->out_cvts[group]); 1105 } 1106 guard(spinlock_irq)(&ump->legacy_locks[dir]); 1107 ump->legacy_substreams[dir][group] = substream; 1108 return 0; 1109 } 1110 1111 static int snd_ump_legacy_close(struct snd_rawmidi_substream *substream) 1112 { 1113 struct snd_ump_endpoint *ump = substream->rmidi->private_data; 1114 int dir = substream->stream; 1115 int group = ump->legacy_mapping[substream->number]; 1116 1117 guard(mutex)(&ump->open_mutex); 1118 scoped_guard(spinlock_irq, &ump->legacy_locks[dir]) 1119 ump->legacy_substreams[dir][group] = NULL; 1120 if (dir == SNDRV_RAWMIDI_STREAM_OUTPUT) { 1121 if (!--ump->legacy_out_opens) 1122 snd_rawmidi_kernel_release(&ump->legacy_out_rfile); 1123 } 1124 return 0; 1125 } 1126 1127 static void snd_ump_legacy_trigger(struct snd_rawmidi_substream *substream, 1128 int up) 1129 { 1130 struct snd_ump_endpoint *ump = substream->rmidi->private_data; 1131 int dir = substream->stream; 1132 1133 ump->ops->trigger(ump, dir, up); 1134 } 1135 1136 static void snd_ump_legacy_drain(struct snd_rawmidi_substream *substream) 1137 { 1138 struct snd_ump_endpoint *ump = substream->rmidi->private_data; 1139 1140 if (ump->ops->drain) 1141 ump->ops->drain(ump, SNDRV_RAWMIDI_STREAM_OUTPUT); 1142 } 1143 1144 static int snd_ump_legacy_dev_register(struct snd_rawmidi *rmidi) 1145 { 1146 /* dummy, just for avoiding create superfluous seq clients */ 1147 return 0; 1148 } 1149 1150 static const struct snd_rawmidi_ops snd_ump_legacy_input_ops = { 1151 .open = snd_ump_legacy_open, 1152 .close = snd_ump_legacy_close, 1153 .trigger = snd_ump_legacy_trigger, 1154 }; 1155 1156 static const struct snd_rawmidi_ops snd_ump_legacy_output_ops = { 1157 .open = snd_ump_legacy_open, 1158 .close = snd_ump_legacy_close, 1159 .trigger = snd_ump_legacy_trigger, 1160 .drain = snd_ump_legacy_drain, 1161 }; 1162 1163 static const struct snd_rawmidi_global_ops snd_ump_legacy_ops = { 1164 .dev_register = snd_ump_legacy_dev_register, 1165 }; 1166 1167 static int process_legacy_output(struct snd_ump_endpoint *ump, 1168 u32 *buffer, int count) 1169 { 1170 struct snd_rawmidi_substream *substream; 1171 struct ump_cvt_to_ump *ctx; 1172 const int dir = SNDRV_RAWMIDI_STREAM_OUTPUT; 1173 unsigned int protocol; 1174 unsigned char c; 1175 int group, size = 0; 1176 1177 if (!ump->out_cvts || !ump->legacy_out_opens) 1178 return 0; 1179 1180 guard(spinlock_irqsave)(&ump->legacy_locks[dir]); 1181 for (group = 0; group < SNDRV_UMP_MAX_GROUPS; group++) { 1182 substream = ump->legacy_substreams[dir][group]; 1183 if (!substream) 1184 continue; 1185 ctx = &ump->out_cvts[group]; 1186 protocol = ump->info.protocol; 1187 if ((protocol & SNDRV_UMP_EP_INFO_PROTO_MIDI2) && 1188 ump->groups[group].is_midi1) 1189 protocol = SNDRV_UMP_EP_INFO_PROTO_MIDI1; 1190 while (!ctx->ump_bytes && 1191 snd_rawmidi_transmit(substream, &c, 1) > 0) 1192 snd_ump_convert_to_ump(ctx, group, protocol, c); 1193 if (ctx->ump_bytes && ctx->ump_bytes <= count) { 1194 size = ctx->ump_bytes; 1195 memcpy(buffer, ctx->ump, size); 1196 ctx->ump_bytes = 0; 1197 break; 1198 } 1199 } 1200 return size; 1201 } 1202 1203 static void process_legacy_input(struct snd_ump_endpoint *ump, const u32 *src, 1204 int words) 1205 { 1206 struct snd_rawmidi_substream *substream; 1207 unsigned char buf[16]; 1208 unsigned char group; 1209 const int dir = SNDRV_RAWMIDI_STREAM_INPUT; 1210 int size; 1211 1212 size = snd_ump_convert_from_ump(src, buf, &group); 1213 if (size <= 0) 1214 return; 1215 guard(spinlock_irqsave)(&ump->legacy_locks[dir]); 1216 substream = ump->legacy_substreams[dir][group]; 1217 if (substream) 1218 snd_rawmidi_receive(substream, buf, size); 1219 } 1220 1221 /* Fill ump->legacy_mapping[] for groups to be used for legacy rawmidi */ 1222 static int fill_legacy_mapping(struct snd_ump_endpoint *ump) 1223 { 1224 struct snd_ump_block *fb; 1225 unsigned int group_maps = 0; 1226 int i, num; 1227 1228 if (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS) { 1229 list_for_each_entry(fb, &ump->block_list, list) { 1230 for (i = 0; i < fb->info.num_groups; i++) 1231 group_maps |= 1U << (fb->info.first_group + i); 1232 } 1233 if (!group_maps) 1234 ump_info(ump, "No UMP Group is found in FB\n"); 1235 } 1236 1237 /* use all groups for non-static case */ 1238 if (!group_maps) 1239 group_maps = (1U << SNDRV_UMP_MAX_GROUPS) - 1; 1240 1241 num = 0; 1242 for (i = 0; i < SNDRV_UMP_MAX_GROUPS; i++) 1243 if (group_maps & (1U << i)) 1244 ump->legacy_mapping[num++] = i; 1245 1246 return num; 1247 } 1248 1249 static void fill_substream_names(struct snd_ump_endpoint *ump, 1250 struct snd_rawmidi *rmidi, int dir) 1251 { 1252 struct snd_rawmidi_substream *s; 1253 const char *name; 1254 int idx; 1255 1256 list_for_each_entry(s, &rmidi->streams[dir].substreams, list) { 1257 idx = ump->legacy_mapping[s->number]; 1258 name = ump->groups[idx].name; 1259 if (!*name) 1260 name = ump->info.name; 1261 snprintf(s->name, sizeof(s->name), "Group %d (%.16s)", 1262 idx + 1, name); 1263 } 1264 } 1265 1266 int snd_ump_attach_legacy_rawmidi(struct snd_ump_endpoint *ump, 1267 char *id, int device) 1268 { 1269 struct snd_rawmidi *rmidi; 1270 bool input, output; 1271 int err, num; 1272 1273 ump->out_cvts = kcalloc(SNDRV_UMP_MAX_GROUPS, 1274 sizeof(*ump->out_cvts), GFP_KERNEL); 1275 if (!ump->out_cvts) 1276 return -ENOMEM; 1277 1278 num = fill_legacy_mapping(ump); 1279 1280 input = ump->core.info_flags & SNDRV_RAWMIDI_INFO_INPUT; 1281 output = ump->core.info_flags & SNDRV_RAWMIDI_INFO_OUTPUT; 1282 err = snd_rawmidi_new(ump->core.card, id, device, 1283 output ? num : 0, input ? num : 0, 1284 &rmidi); 1285 if (err < 0) { 1286 kfree(ump->out_cvts); 1287 return err; 1288 } 1289 1290 if (input) 1291 snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_INPUT, 1292 &snd_ump_legacy_input_ops); 1293 if (output) 1294 snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT, 1295 &snd_ump_legacy_output_ops); 1296 snprintf(rmidi->name, sizeof(rmidi->name), "%.68s (MIDI 1.0)", 1297 ump->info.name); 1298 rmidi->info_flags = ump->core.info_flags & ~SNDRV_RAWMIDI_INFO_UMP; 1299 rmidi->ops = &snd_ump_legacy_ops; 1300 rmidi->private_data = ump; 1301 ump->legacy_rmidi = rmidi; 1302 if (input) 1303 fill_substream_names(ump, rmidi, SNDRV_RAWMIDI_STREAM_INPUT); 1304 if (output) 1305 fill_substream_names(ump, rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT); 1306 1307 ump_dbg(ump, "Created a legacy rawmidi #%d (%s)\n", device, id); 1308 return 0; 1309 } 1310 EXPORT_SYMBOL_GPL(snd_ump_attach_legacy_rawmidi); 1311 #endif /* CONFIG_SND_UMP_LEGACY_RAWMIDI */ 1312 1313 MODULE_DESCRIPTION("Universal MIDI Packet (UMP) Core Driver"); 1314 MODULE_LICENSE("GPL"); 1315