root/sound/core/ump.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Universal MIDI Packet (UMP) support
 */

#include <linux/list.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/export.h>
#include <linux/mm.h>
#include <sound/core.h>
#include <sound/rawmidi.h>
#include <sound/ump.h>
#include <sound/ump_convert.h>

#define ump_err(ump, fmt, args...)      dev_err((ump)->core.dev, fmt, ##args)
#define ump_warn(ump, fmt, args...)     dev_warn((ump)->core.dev, fmt, ##args)
#define ump_info(ump, fmt, args...)     dev_info((ump)->core.dev, fmt, ##args)
#define ump_dbg(ump, fmt, args...)      dev_dbg((ump)->core.dev, fmt, ##args)

static int snd_ump_dev_register(struct snd_rawmidi *rmidi);
static int snd_ump_dev_unregister(struct snd_rawmidi *rmidi);
static long snd_ump_ioctl(struct snd_rawmidi *rmidi, unsigned int cmd,
                          void __user *argp);
static void snd_ump_proc_read(struct snd_info_entry *entry,
                              struct snd_info_buffer *buffer);
static int snd_ump_rawmidi_open(struct snd_rawmidi_substream *substream);
static int snd_ump_rawmidi_close(struct snd_rawmidi_substream *substream);
static void snd_ump_rawmidi_trigger(struct snd_rawmidi_substream *substream,
                                    int up);
static void snd_ump_rawmidi_drain(struct snd_rawmidi_substream *substream);

static void ump_handle_stream_msg(struct snd_ump_endpoint *ump,
                                  const u32 *buf, int size);
#if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI)
static int process_legacy_output(struct snd_ump_endpoint *ump,
                                 u32 *buffer, int count);
static void process_legacy_input(struct snd_ump_endpoint *ump, const u32 *src,
                                 int words);
static void ump_legacy_set_rawmidi_name(struct snd_ump_endpoint *ump);
static void update_legacy_names(struct snd_ump_endpoint *ump);
#else
static inline int process_legacy_output(struct snd_ump_endpoint *ump,
                                        u32 *buffer, int count)
{
        return 0;
}
static inline void process_legacy_input(struct snd_ump_endpoint *ump,
                                        const u32 *src, int words)
{
}
static inline void ump_legacy_set_rawmidi_name(struct snd_ump_endpoint *ump)
{
}
static inline void update_legacy_names(struct snd_ump_endpoint *ump)
{
}
#endif

/* copy a string safely with stripping non-printable letters */
static void safe_copy_string(void *dst, size_t max_dst_size,
                             const void *src, size_t max_src_size)
{
        const unsigned char *s = src;
        unsigned char *d = dst;

        if (!max_dst_size--)
                return;
        for (s = src; max_dst_size && *s && max_src_size--; s++) {
                if (!isascii(*s) || !isprint(*s))
                        continue;
                *d++ = *s;
                max_dst_size--;
        }
        *d = 0;
}

/* append a string safely with stripping non-printable letters */
static void safe_append_string(void *dst, size_t max_dst_size,
                               const void *src, size_t max_src_size)
{
        unsigned char *d = dst;
        size_t len = strlen(d);

        safe_copy_string(d + len, max_dst_size - len, src, max_src_size);
}

static const struct snd_rawmidi_global_ops snd_ump_rawmidi_ops = {
        .dev_register = snd_ump_dev_register,
        .dev_unregister = snd_ump_dev_unregister,
        .ioctl = snd_ump_ioctl,
        .proc_read = snd_ump_proc_read,
};

static const struct snd_rawmidi_ops snd_ump_rawmidi_input_ops = {
        .open = snd_ump_rawmidi_open,
        .close = snd_ump_rawmidi_close,
        .trigger = snd_ump_rawmidi_trigger,
};

static const struct snd_rawmidi_ops snd_ump_rawmidi_output_ops = {
        .open = snd_ump_rawmidi_open,
        .close = snd_ump_rawmidi_close,
        .trigger = snd_ump_rawmidi_trigger,
        .drain = snd_ump_rawmidi_drain,
};

static void snd_ump_endpoint_free(struct snd_rawmidi *rmidi)
{
        struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi);
        struct snd_ump_block *fb;

        while (!list_empty(&ump->block_list)) {
                fb = list_first_entry(&ump->block_list, struct snd_ump_block,
                                      list);
                list_del(&fb->list);
                if (fb->private_free)
                        fb->private_free(fb);
                kfree(fb);
        }

        if (ump->private_free)
                ump->private_free(ump);

#if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI)
        kfree(ump->out_cvts);
#endif
}

/**
 * snd_ump_endpoint_new - create a UMP Endpoint object
 * @card: the card instance
 * @id: the id string for rawmidi
 * @device: the device index for rawmidi
 * @output: 1 for enabling output
 * @input: 1 for enabling input
 * @ump_ret: the pointer to store the new UMP instance
 *
 * Creates a new UMP Endpoint object. A UMP Endpoint is tied with one rawmidi
 * instance with one input and/or one output rawmidi stream (either uni-
 * or bi-directional). A UMP Endpoint may contain one or multiple UMP Blocks
 * that consist of one or multiple UMP Groups.
 *
 * Use snd_rawmidi_set_ops() to set the operators to the new instance.
 * Unlike snd_rawmidi_new(), this function sets up the info_flags by itself
 * depending on the given @output and @input.
 *
 * The device has SNDRV_RAWMIDI_INFO_UMP flag set and a different device
 * file ("umpCxDx") than a standard MIDI 1.x device ("midiCxDx") is
 * created.
 *
 * Return: Zero if successful, or a negative error code on failure.
 */
int snd_ump_endpoint_new(struct snd_card *card, char *id, int device,
                         int output, int input,
                         struct snd_ump_endpoint **ump_ret)
{
        unsigned int info_flags = SNDRV_RAWMIDI_INFO_UMP;
        struct snd_ump_endpoint *ump;
        int err;

        if (input)
                info_flags |= SNDRV_RAWMIDI_INFO_INPUT;
        if (output)
                info_flags |= SNDRV_RAWMIDI_INFO_OUTPUT;
        if (input && output)
                info_flags |= SNDRV_RAWMIDI_INFO_DUPLEX;

        ump = kzalloc_obj(*ump);
        if (!ump)
                return -ENOMEM;
        INIT_LIST_HEAD(&ump->block_list);
        mutex_init(&ump->open_mutex);
        init_waitqueue_head(&ump->stream_wait);
#if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI)
        spin_lock_init(&ump->legacy_locks[0]);
        spin_lock_init(&ump->legacy_locks[1]);
#endif
        err = snd_rawmidi_init(&ump->core, card, id, device,
                               output, input, info_flags);
        if (err < 0) {
                snd_rawmidi_free(&ump->core);
                return err;
        }

        ump->info.card = card->number;
        ump->info.device = device;

        ump->core.private_free = snd_ump_endpoint_free;
        ump->core.ops = &snd_ump_rawmidi_ops;
        if (input)
                snd_rawmidi_set_ops(&ump->core, SNDRV_RAWMIDI_STREAM_INPUT,
                                    &snd_ump_rawmidi_input_ops);
        if (output)
                snd_rawmidi_set_ops(&ump->core, SNDRV_RAWMIDI_STREAM_OUTPUT,
                                    &snd_ump_rawmidi_output_ops);

        ump_dbg(ump, "Created a UMP EP #%d (%s)\n", device, id);
        *ump_ret = ump;
        return 0;
}
EXPORT_SYMBOL_GPL(snd_ump_endpoint_new);

/*
 * Device register / unregister hooks;
 *  do nothing, placeholders for avoiding the default rawmidi handling
 */

#if IS_ENABLED(CONFIG_SND_SEQUENCER)
static void snd_ump_dev_seq_free(struct snd_seq_device *device)
{
        struct snd_ump_endpoint *ump = device->private_data;

        ump->seq_dev = NULL;
}
#endif

static int snd_ump_dev_register(struct snd_rawmidi *rmidi)
{
#if IS_ENABLED(CONFIG_SND_SEQUENCER)
        struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi);
        int err;

        err = snd_seq_device_new(ump->core.card, ump->core.device,
                                 SNDRV_SEQ_DEV_ID_UMP, 0, &ump->seq_dev);
        if (err < 0)
                return err;
        ump->seq_dev->private_data = ump;
        ump->seq_dev->private_free = snd_ump_dev_seq_free;
        snd_device_register(ump->core.card, ump->seq_dev);
#endif
        return 0;
}

static int snd_ump_dev_unregister(struct snd_rawmidi *rmidi)
{
        return 0;
}

static struct snd_ump_block *
snd_ump_get_block(struct snd_ump_endpoint *ump, unsigned char id)
{
        struct snd_ump_block *fb;

        list_for_each_entry(fb, &ump->block_list, list) {
                if (fb->info.block_id == id)
                        return fb;
        }
        return NULL;
}

/*
 * rawmidi ops for UMP endpoint
 */
static int snd_ump_rawmidi_open(struct snd_rawmidi_substream *substream)
{
        struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi);
        int dir = substream->stream;
        int err;

        if (ump->substreams[dir])
                return -EBUSY;
        err = ump->ops->open(ump, dir);
        if (err < 0)
                return err;
        ump->substreams[dir] = substream;
        return 0;
}

static int snd_ump_rawmidi_close(struct snd_rawmidi_substream *substream)
{
        struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi);
        int dir = substream->stream;

        ump->substreams[dir] = NULL;
        ump->ops->close(ump, dir);
        return 0;
}

static void snd_ump_rawmidi_trigger(struct snd_rawmidi_substream *substream,
                                    int up)
{
        struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi);
        int dir = substream->stream;

        ump->ops->trigger(ump, dir, up);
}

static void snd_ump_rawmidi_drain(struct snd_rawmidi_substream *substream)
{
        struct snd_ump_endpoint *ump = rawmidi_to_ump(substream->rmidi);

        if (ump->ops->drain)
                ump->ops->drain(ump, SNDRV_RAWMIDI_STREAM_OUTPUT);
}

/* number of 32bit words per message type */
static unsigned char ump_packet_words[0x10] = {
        1, 1, 1, 2, 2, 4, 1, 1, 2, 2, 2, 3, 3, 4, 4, 4
};

/**
 * snd_ump_receive_ump_val - parse the UMP packet data
 * @ump: UMP endpoint
 * @val: UMP packet data
 *
 * The data is copied onto ump->input_buf[].
 * When a full packet is completed, returns the number of words (from 1 to 4).
 * OTOH, if the packet is incomplete, returns 0.
 */
int snd_ump_receive_ump_val(struct snd_ump_endpoint *ump, u32 val)
{
        int words;

        if (!ump->input_pending)
                ump->input_pending = ump_packet_words[ump_message_type(val)];

        ump->input_buf[ump->input_buf_head++] = val;
        ump->input_pending--;
        if (!ump->input_pending) {
                words = ump->input_buf_head;
                ump->input_buf_head = 0;
                return words;
        }
        return 0;
}
EXPORT_SYMBOL_GPL(snd_ump_receive_ump_val);

/**
 * snd_ump_receive - transfer UMP packets from the device
 * @ump: the UMP endpoint
 * @buffer: the buffer pointer to transfer
 * @count: byte size to transfer
 *
 * Called from the driver to submit the received UMP packets from the device
 * to user-space.  It's essentially a wrapper of rawmidi_receive().
 * The data to receive is in CPU-native endianness.
 */
int snd_ump_receive(struct snd_ump_endpoint *ump, const u32 *buffer, int count)
{
        struct snd_rawmidi_substream *substream;
        const u32 *p = buffer;
        int n, words = count >> 2;

        while (words--) {
                n = snd_ump_receive_ump_val(ump, *p++);
                if (!n)
                        continue;
                ump_handle_stream_msg(ump, ump->input_buf, n);
#if IS_ENABLED(CONFIG_SND_SEQUENCER)
                if (ump->seq_ops)
                        ump->seq_ops->input_receive(ump, ump->input_buf, n);
#endif
                process_legacy_input(ump, ump->input_buf, n);
        }

        substream = ump->substreams[SNDRV_RAWMIDI_STREAM_INPUT];
        if (!substream)
                return 0;
        return snd_rawmidi_receive(substream, (const char *)buffer, count);
}
EXPORT_SYMBOL_GPL(snd_ump_receive);

/**
 * snd_ump_transmit - transmit UMP packets
 * @ump: the UMP endpoint
 * @buffer: the buffer pointer to transfer
 * @count: byte size to transfer
 *
 * Called from the driver to obtain the UMP packets from user-space to the
 * device.  It's essentially a wrapper of rawmidi_transmit().
 * The data to transmit is in CPU-native endianness.
 */
int snd_ump_transmit(struct snd_ump_endpoint *ump, u32 *buffer, int count)
{
        struct snd_rawmidi_substream *substream =
                ump->substreams[SNDRV_RAWMIDI_STREAM_OUTPUT];
        int err;

        if (!substream)
                return -ENODEV;
        err = snd_rawmidi_transmit(substream, (char *)buffer, count);
        /* received either data or an error? */
        if (err)
                return err;
        return process_legacy_output(ump, buffer, count);
}
EXPORT_SYMBOL_GPL(snd_ump_transmit);

/**
 * snd_ump_block_new - Create a UMP block
 * @ump: UMP object
 * @blk: block ID number to create
 * @direction: direction (in/out/bidirection)
 * @first_group: the first group ID (0-based)
 * @num_groups: the number of groups in this block
 * @blk_ret: the pointer to store the resultant block object
 */
int snd_ump_block_new(struct snd_ump_endpoint *ump, unsigned int blk,
                      unsigned int direction, unsigned int first_group,
                      unsigned int num_groups, struct snd_ump_block **blk_ret)
{
        struct snd_ump_block *fb, *p;

        if (blk >= SNDRV_UMP_MAX_BLOCKS)
                return -EINVAL;

        if (snd_ump_get_block(ump, blk))
                return -EBUSY;

        fb = kzalloc_obj(*fb);
        if (!fb)
                return -ENOMEM;

        fb->ump = ump;
        fb->info.card = ump->info.card;
        fb->info.device = ump->info.device;
        fb->info.block_id = blk;
        if (blk >= ump->info.num_blocks)
                ump->info.num_blocks = blk + 1;
        fb->info.direction = direction;
        fb->info.active = 1;
        fb->info.first_group = first_group;
        fb->info.num_groups = num_groups;
        /* fill the default name, may be overwritten to a better name */
        snprintf(fb->info.name, sizeof(fb->info.name), "Group %u-%u",
                 first_group + 1, first_group + num_groups);

        /* put the entry in the ordered list */
        list_for_each_entry(p, &ump->block_list, list) {
                if (p->info.block_id > blk) {
                        list_add_tail(&fb->list, &p->list);
                        goto added;
                }
        }
        list_add_tail(&fb->list, &ump->block_list);

 added:
        ump_dbg(ump, "Created a UMP Block #%d (%s)\n", blk, fb->info.name);
        *blk_ret = fb;
        return 0;
}
EXPORT_SYMBOL_GPL(snd_ump_block_new);

static int snd_ump_ioctl_block(struct snd_ump_endpoint *ump,
                               struct snd_ump_block_info __user *argp)
{
        struct snd_ump_block *fb;
        unsigned char id;

        if (get_user(id, &argp->block_id))
                return -EFAULT;
        fb = snd_ump_get_block(ump, id);
        if (!fb)
                return -ENOENT;
        if (copy_to_user(argp, &fb->info, sizeof(fb->info)))
                return -EFAULT;
        return 0;
}

/*
 * Handle UMP-specific ioctls; called from snd_rawmidi_ioctl()
 */
static long snd_ump_ioctl(struct snd_rawmidi *rmidi, unsigned int cmd,
                          void __user *argp)
{
        struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi);

        switch (cmd) {
        case SNDRV_UMP_IOCTL_ENDPOINT_INFO:
                if (copy_to_user(argp, &ump->info, sizeof(ump->info)))
                        return -EFAULT;
                return 0;
        case SNDRV_UMP_IOCTL_BLOCK_INFO:
                return snd_ump_ioctl_block(ump, argp);
        default:
                ump_dbg(ump, "rawmidi: unknown command = 0x%x\n", cmd);
                return -ENOTTY;
        }
}

static const char *ump_direction_string(int dir)
{
        switch (dir) {
        case SNDRV_UMP_DIR_INPUT:
                return "input";
        case SNDRV_UMP_DIR_OUTPUT:
                return "output";
        case SNDRV_UMP_DIR_BIDIRECTION:
                return "bidirection";
        default:
                return "unknown";
        }
}

static const char *ump_ui_hint_string(int dir)
{
        switch (dir) {
        case  SNDRV_UMP_BLOCK_UI_HINT_RECEIVER:
                return "receiver";
        case SNDRV_UMP_BLOCK_UI_HINT_SENDER:
                return "sender";
        case SNDRV_UMP_BLOCK_UI_HINT_BOTH:
                return "both";
        default:
                return "unknown";
        }
}

/* Additional proc file output */
static void snd_ump_proc_read(struct snd_info_entry *entry,
                              struct snd_info_buffer *buffer)
{
        struct snd_rawmidi *rmidi = entry->private_data;
        struct snd_ump_endpoint *ump = rawmidi_to_ump(rmidi);
        struct snd_ump_block *fb;

        snd_iprintf(buffer, "EP Name: %s\n", ump->info.name);
        snd_iprintf(buffer, "EP Product ID: %s\n", ump->info.product_id);
        snd_iprintf(buffer, "UMP Version: 0x%04x\n", ump->info.version);
        snd_iprintf(buffer, "Protocol Caps: 0x%08x\n", ump->info.protocol_caps);
        snd_iprintf(buffer, "Protocol: 0x%08x\n", ump->info.protocol);
        if (ump->info.version) {
                snd_iprintf(buffer, "Manufacturer ID: 0x%08x\n",
                            ump->info.manufacturer_id);
                snd_iprintf(buffer, "Family ID: 0x%04x\n", ump->info.family_id);
                snd_iprintf(buffer, "Model ID: 0x%04x\n", ump->info.model_id);
                snd_iprintf(buffer, "SW Revision: 0x%4phN\n", ump->info.sw_revision);
        }
        snd_iprintf(buffer, "Static Blocks: %s\n",
                    (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS) ? "Yes" : "No");
        snd_iprintf(buffer, "Num Blocks: %d\n\n", ump->info.num_blocks);

        list_for_each_entry(fb, &ump->block_list, list) {
                snd_iprintf(buffer, "Block %d (%s)\n", fb->info.block_id,
                            fb->info.name);
                snd_iprintf(buffer, "  Direction: %s\n",
                            ump_direction_string(fb->info.direction));
                snd_iprintf(buffer, "  Active: %s\n",
                            fb->info.active ? "Yes" : "No");
                snd_iprintf(buffer, "  Groups: %d-%d\n",
                            fb->info.first_group + 1,
                            fb->info.first_group + fb->info.num_groups);
                snd_iprintf(buffer, "  Is MIDI1: %s%s\n",
                            (fb->info.flags & SNDRV_UMP_BLOCK_IS_MIDI1) ? "Yes" : "No",
                            (fb->info.flags & SNDRV_UMP_BLOCK_IS_LOWSPEED) ? " (Low Speed)" : "");
                if (ump->info.version) {
                        snd_iprintf(buffer, "  MIDI-CI Version: %d\n",
                                    fb->info.midi_ci_version);
                        snd_iprintf(buffer, "  Sysex8 Streams: %d\n",
                                    fb->info.sysex8_streams);
                        snd_iprintf(buffer, "  UI Hint: %s\n",
                                    ump_ui_hint_string(fb->info.ui_hint));
                }
                snd_iprintf(buffer, "\n");
        }
}

/* update dir_bits and active flag for all groups in the client */
void snd_ump_update_group_attrs(struct snd_ump_endpoint *ump)
{
        struct snd_ump_block *fb;
        struct snd_ump_group *group;
        int i;

        for (i = 0; i < SNDRV_UMP_MAX_GROUPS; i++) {
                group = &ump->groups[i];
                *group->name = 0;
                group->dir_bits = 0;
                group->active = 0;
                group->group = i;
                group->valid = false;
                group->is_midi1 = false;
        }

        list_for_each_entry(fb, &ump->block_list, list) {
                if (fb->info.first_group + fb->info.num_groups > SNDRV_UMP_MAX_GROUPS)
                        break;
                group = &ump->groups[fb->info.first_group];
                for (i = 0; i < fb->info.num_groups; i++, group++) {
                        group->valid = true;
                        if (fb->info.active)
                                group->active = 1;
                        if (fb->info.flags & SNDRV_UMP_BLOCK_IS_MIDI1)
                                group->is_midi1 = true;
                        switch (fb->info.direction) {
                        case SNDRV_UMP_DIR_INPUT:
                                group->dir_bits |= (1 << SNDRV_RAWMIDI_STREAM_INPUT);
                                break;
                        case SNDRV_UMP_DIR_OUTPUT:
                                group->dir_bits |= (1 << SNDRV_RAWMIDI_STREAM_OUTPUT);
                                break;
                        case SNDRV_UMP_DIR_BIDIRECTION:
                                group->dir_bits |= (1 << SNDRV_RAWMIDI_STREAM_INPUT) |
                                        (1 << SNDRV_RAWMIDI_STREAM_OUTPUT);
                                break;
                        }
                        if (!*fb->info.name)
                                continue;
                        if (*group->name)
                                strlcat(group->name, ", ", sizeof(group->name));
                        safe_append_string(group->name, sizeof(group->name),
                                           fb->info.name, sizeof(fb->info.name));
                }
        }
}
EXPORT_SYMBOL_GPL(snd_ump_update_group_attrs);

/*
 * UMP endpoint and function block handling
 */

/* open / close UMP streams for the internal stream msg communication */
static int ump_request_open(struct snd_ump_endpoint *ump)
{
        return snd_rawmidi_kernel_open(&ump->core, 0,
                                       SNDRV_RAWMIDI_LFLG_OUTPUT,
                                       &ump->stream_rfile);
}

static void ump_request_close(struct snd_ump_endpoint *ump)
{
        snd_rawmidi_kernel_release(&ump->stream_rfile);
}

/* request a command and wait for the given response;
 * @req1 and @req2 are u32 commands
 * @reply is the expected UMP stream status
 */
static int ump_req_msg(struct snd_ump_endpoint *ump, u32 req1, u32 req2,
                       u32 reply)
{
        u32 buf[4];

        ump_dbg(ump, "%s: request %08x %08x, wait-for %08x\n",
                __func__, req1, req2, reply);
        memset(buf, 0, sizeof(buf));
        buf[0] = req1;
        buf[1] = req2;
        ump->stream_finished = 0;
        ump->stream_wait_for = reply;
        snd_rawmidi_kernel_write(ump->stream_rfile.output,
                                 (unsigned char *)&buf, 16);
        wait_event_timeout(ump->stream_wait, ump->stream_finished,
                           msecs_to_jiffies(500));
        if (!READ_ONCE(ump->stream_finished)) {
                ump_dbg(ump, "%s: request timed out\n", __func__);
                return -ETIMEDOUT;
        }
        ump->stream_finished = 0;
        ump_dbg(ump, "%s: reply: %08x %08x %08x %08x\n",
                __func__, buf[0], buf[1], buf[2], buf[3]);
        return 0;
}

/* append the received letters via UMP packet to the given string buffer;
 * return 1 if the full string is received or 0 to continue
 */
static int ump_append_string(struct snd_ump_endpoint *ump, char *dest,
                             int maxsize, const u32 *buf, int offset)
{
        unsigned char format;
        int c;

        format = ump_stream_message_format(buf[0]);
        if (format == UMP_STREAM_MSG_FORMAT_SINGLE ||
            format == UMP_STREAM_MSG_FORMAT_START) {
                c = 0;
        } else {
                c = strlen(dest);
                if (c >= maxsize - 1)
                        return 1;
        }

        for (; offset < 16; offset++) {
                dest[c] = buf[offset / 4] >> (3 - (offset % 4)) * 8;
                if (!dest[c])
                        break;
                if (++c >= maxsize - 1)
                        break;
        }
        dest[c] = 0;
        return (format == UMP_STREAM_MSG_FORMAT_SINGLE ||
                format == UMP_STREAM_MSG_FORMAT_END);
}

/* Choose the default protocol */
static void choose_default_protocol(struct snd_ump_endpoint *ump)
{
        if (ump->info.protocol & SNDRV_UMP_EP_INFO_PROTO_MIDI_MASK)
                return;
        if (ump->info.protocol_caps & SNDRV_UMP_EP_INFO_PROTO_MIDI2)
                ump->info.protocol |= SNDRV_UMP_EP_INFO_PROTO_MIDI2;
        else
                ump->info.protocol |= SNDRV_UMP_EP_INFO_PROTO_MIDI1;
}

/* notify the EP info/name change to sequencer */
static void seq_notify_ep_change(struct snd_ump_endpoint *ump)
{
#if IS_ENABLED(CONFIG_SND_SEQUENCER)
        if (ump->parsed && ump->seq_ops && ump->seq_ops->notify_ep_change)
                ump->seq_ops->notify_ep_change(ump);
#endif
}

/* handle EP info stream message; update the UMP attributes */
static int ump_handle_ep_info_msg(struct snd_ump_endpoint *ump,
                                  const union snd_ump_stream_msg *buf)
{
        ump->info.version = (buf->ep_info.ump_version_major << 8) |
                buf->ep_info.ump_version_minor;
        ump->info.num_blocks = buf->ep_info.num_function_blocks;
        if (ump->info.num_blocks > SNDRV_UMP_MAX_BLOCKS) {
                ump_info(ump, "Invalid function blocks %d, fallback to 1\n",
                         ump->info.num_blocks);
                ump->info.num_blocks = 1;
        }

        if (buf->ep_info.static_function_block)
                ump->info.flags |= SNDRV_UMP_EP_INFO_STATIC_BLOCKS;

        ump->info.protocol_caps = (buf->ep_info.protocol << 8) |
                buf->ep_info.jrts;

        ump_dbg(ump, "EP info: version=%x, num_blocks=%x, proto_caps=%x\n",
                ump->info.version, ump->info.num_blocks, ump->info.protocol_caps);

        ump->info.protocol &= ump->info.protocol_caps;
        choose_default_protocol(ump);
        seq_notify_ep_change(ump);

        return 1; /* finished */
}

/* handle EP device info stream message; update the UMP attributes */
static int ump_handle_device_info_msg(struct snd_ump_endpoint *ump,
                                      const union snd_ump_stream_msg *buf)
{
        ump->info.manufacturer_id = buf->device_info.manufacture_id & 0x7f7f7f;
        ump->info.family_id = (buf->device_info.family_msb << 8) |
                buf->device_info.family_lsb;
        ump->info.model_id = (buf->device_info.model_msb << 8) |
                buf->device_info.model_lsb;
        ump->info.sw_revision[0] = (buf->device_info.sw_revision >> 24) & 0x7f;
        ump->info.sw_revision[1] = (buf->device_info.sw_revision >> 16) & 0x7f;
        ump->info.sw_revision[2] = (buf->device_info.sw_revision >> 8) & 0x7f;
        ump->info.sw_revision[3] = buf->device_info.sw_revision & 0x7f;
        ump_dbg(ump, "EP devinfo: manid=%08x, family=%04x, model=%04x, sw=%4phN\n",
                ump->info.manufacturer_id,
                ump->info.family_id,
                ump->info.model_id,
                ump->info.sw_revision);
        seq_notify_ep_change(ump);
        return 1; /* finished */
}

/* set up the core rawmidi name from UMP EP name string */
static void ump_set_rawmidi_name(struct snd_ump_endpoint *ump)
{
        safe_copy_string(ump->core.name, sizeof(ump->core.name),
                         ump->info.name, sizeof(ump->info.name));
}

/* handle EP name stream message; update the UMP name string */
static int ump_handle_ep_name_msg(struct snd_ump_endpoint *ump,
                                  const union snd_ump_stream_msg *buf)
{
        int ret;

        ret = ump_append_string(ump, ump->info.name, sizeof(ump->info.name),
                                buf->raw, 2);
        if (ret && ump->parsed) {
                ump_set_rawmidi_name(ump);
                ump_legacy_set_rawmidi_name(ump);
                seq_notify_ep_change(ump);
        }

        return ret;
}

/* handle EP product id stream message; update the UMP product_id string */
static int ump_handle_product_id_msg(struct snd_ump_endpoint *ump,
                                     const union snd_ump_stream_msg *buf)
{
        int ret;

        ret = ump_append_string(ump, ump->info.product_id,
                                sizeof(ump->info.product_id),
                                buf->raw, 2);
        if (ret)
                seq_notify_ep_change(ump);
        return ret;
}

/* notify the protocol change to sequencer */
static void seq_notify_protocol(struct snd_ump_endpoint *ump)
{
#if IS_ENABLED(CONFIG_SND_SEQUENCER)
        if (ump->seq_ops && ump->seq_ops->switch_protocol)
                ump->seq_ops->switch_protocol(ump);
#endif /* CONFIG_SND_SEQUENCER */
}

/**
 * snd_ump_switch_protocol - switch MIDI protocol
 * @ump: UMP endpoint
 * @protocol: protocol to switch to
 *
 * Returns 1 if the protocol is actually switched, 0 if unchanged
 */
int snd_ump_switch_protocol(struct snd_ump_endpoint *ump, unsigned int protocol)
{
        unsigned int type;

        protocol &= ump->info.protocol_caps;
        if (protocol == ump->info.protocol)
                return 0;

        type = protocol & SNDRV_UMP_EP_INFO_PROTO_MIDI_MASK;
        if (type != SNDRV_UMP_EP_INFO_PROTO_MIDI1 &&
            type != SNDRV_UMP_EP_INFO_PROTO_MIDI2)
                return 0;

        ump->info.protocol = protocol;
        ump_dbg(ump, "New protocol = %x (caps = %x)\n",
                protocol, ump->info.protocol_caps);
        seq_notify_protocol(ump);
        return 1;
}
EXPORT_SYMBOL_GPL(snd_ump_switch_protocol);

/* handle EP stream config message; update the UMP protocol */
static int ump_handle_stream_cfg_msg(struct snd_ump_endpoint *ump,
                                     const union snd_ump_stream_msg *buf)
{
        unsigned int protocol =
                (buf->stream_cfg.protocol << 8) | buf->stream_cfg.jrts;

        snd_ump_switch_protocol(ump, protocol);
        return 1; /* finished */
}

/* Extract Function Block info from UMP packet */
static void fill_fb_info(struct snd_ump_endpoint *ump,
                         struct snd_ump_block_info *info,
                         const union snd_ump_stream_msg *buf)
{
        info->direction = buf->fb_info.direction;
        info->ui_hint = buf->fb_info.ui_hint;
        info->first_group = buf->fb_info.first_group;
        info->num_groups = buf->fb_info.num_groups;
        if (buf->fb_info.midi_10 < 2)
                info->flags = buf->fb_info.midi_10;
        else
                info->flags = SNDRV_UMP_BLOCK_IS_MIDI1 | SNDRV_UMP_BLOCK_IS_LOWSPEED;
        info->active = buf->fb_info.active;
        info->midi_ci_version = buf->fb_info.midi_ci_version;
        info->sysex8_streams = buf->fb_info.sysex8_streams;

        ump_dbg(ump, "FB %d: dir=%d, active=%d, first_gp=%d, num_gp=%d, midici=%d, sysex8=%d, flags=0x%x\n",
                info->block_id, info->direction, info->active,
                info->first_group, info->num_groups, info->midi_ci_version,
                info->sysex8_streams, info->flags);

        if ((info->flags & SNDRV_UMP_BLOCK_IS_MIDI1) && info->num_groups != 1) {
                info->num_groups = 1;
                ump_dbg(ump, "FB %d: corrected groups to 1 for MIDI1\n",
                        info->block_id);
        }
}

/* check whether the FB info gets updated by the current message */
static bool is_fb_info_updated(struct snd_ump_endpoint *ump,
                               struct snd_ump_block *fb,
                               const union snd_ump_stream_msg *buf)
{
        char tmpbuf[offsetof(struct snd_ump_block_info, name)];

        if (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS) {
                ump_info(ump, "Skipping static FB info update (blk#%d)\n",
                         fb->info.block_id);
                return 0;
        }

        memcpy(tmpbuf, &fb->info, sizeof(tmpbuf));
        fill_fb_info(ump, (struct snd_ump_block_info *)tmpbuf, buf);
        return memcmp(&fb->info, tmpbuf, sizeof(tmpbuf)) != 0;
}

/* notify the FB info/name change to sequencer */
static void seq_notify_fb_change(struct snd_ump_endpoint *ump,
                                 struct snd_ump_block *fb)
{
#if IS_ENABLED(CONFIG_SND_SEQUENCER)
        if (ump->seq_ops && ump->seq_ops->notify_fb_change)
                ump->seq_ops->notify_fb_change(ump, fb);
#endif
}

/* handle FB info message; update FB info if the block is present */
static int ump_handle_fb_info_msg(struct snd_ump_endpoint *ump,
                                  const union snd_ump_stream_msg *buf)
{
        unsigned char blk;
        struct snd_ump_block *fb;

        blk = buf->fb_info.function_block_id;
        fb = snd_ump_get_block(ump, blk);

        /* complain only if updated after parsing */
        if (!fb && ump->parsed) {
                ump_info(ump, "Function Block Info Update for non-existing block %d\n",
                         blk);
                return -ENODEV;
        }

        /* When updated after the initial parse, check the FB info update */
        if (ump->parsed && !is_fb_info_updated(ump, fb, buf))
                return 1; /* no content change */

        if (fb) {
                fill_fb_info(ump, &fb->info, buf);
                if (ump->parsed) {
                        snd_ump_update_group_attrs(ump);
                        update_legacy_names(ump);
                        seq_notify_fb_change(ump, fb);
                }
        }

        return 1; /* finished */
}

/* handle FB name message; update the FB name string */
static int ump_handle_fb_name_msg(struct snd_ump_endpoint *ump,
                                  const union snd_ump_stream_msg *buf)
{
        unsigned char blk;
        struct snd_ump_block *fb;
        int ret;

        blk = buf->fb_name.function_block_id;
        fb = snd_ump_get_block(ump, blk);
        if (!fb)
                return -ENODEV;

        if (ump->parsed &&
            (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS)) {
                ump_dbg(ump, "Skipping static FB name update (blk#%d)\n",
                        fb->info.block_id);
                return 0;
        }

        ret = ump_append_string(ump, fb->info.name, sizeof(fb->info.name),
                                buf->raw, 3);
        /* notify the FB name update to sequencer, too */
        if (ret > 0 && ump->parsed) {
                snd_ump_update_group_attrs(ump);
                update_legacy_names(ump);
                seq_notify_fb_change(ump, fb);
        }
        return ret;
}

static int create_block_from_fb_info(struct snd_ump_endpoint *ump, int blk)
{
        struct snd_ump_block *fb;
        unsigned char direction, first_group, num_groups;
        const union snd_ump_stream_msg *buf =
                (const union snd_ump_stream_msg *)ump->input_buf;
        u32 msg;
        int err;

        /* query the FB info once */
        msg = ump_stream_compose(UMP_STREAM_MSG_STATUS_FB_DISCOVERY, 0) |
                (blk << 8) | UMP_STREAM_MSG_REQUEST_FB_INFO;
        err = ump_req_msg(ump, msg, 0, UMP_STREAM_MSG_STATUS_FB_INFO);
        if (err < 0) {
                ump_dbg(ump, "Unable to get FB info for block %d\n", blk);
                return err;
        }

        /* the last input must be the FB info */
        if (buf->fb_info.status != UMP_STREAM_MSG_STATUS_FB_INFO) {
                ump_dbg(ump, "Inconsistent input: 0x%x\n", *buf->raw);
                return -EINVAL;
        }

        direction = buf->fb_info.direction;
        first_group = buf->fb_info.first_group;
        num_groups = buf->fb_info.num_groups;

        err = snd_ump_block_new(ump, blk, direction, first_group, num_groups,
                                &fb);
        if (err < 0)
                return err;

        fill_fb_info(ump, &fb->info, buf);

        msg = ump_stream_compose(UMP_STREAM_MSG_STATUS_FB_DISCOVERY, 0) |
                (blk << 8) | UMP_STREAM_MSG_REQUEST_FB_NAME;
        err = ump_req_msg(ump, msg, 0, UMP_STREAM_MSG_STATUS_FB_NAME);
        if (err)
                ump_dbg(ump, "Unable to get UMP FB name string #%d\n", blk);

        return 0;
}

/* handle stream messages, called from snd_ump_receive() */
static void ump_handle_stream_msg(struct snd_ump_endpoint *ump,
                                  const u32 *buf, int size)
{
        const union snd_ump_stream_msg *msg;
        unsigned int status;
        int ret;

        /* UMP stream message suppressed (for gadget UMP)? */
        if (ump->no_process_stream)
                return;

        BUILD_BUG_ON(sizeof(*msg) != 16);
        ump_dbg(ump, "Stream msg: %08x %08x %08x %08x\n",
                buf[0], buf[1], buf[2], buf[3]);

        if (size != 4 || ump_message_type(*buf) != UMP_MSG_TYPE_STREAM)
                return;

        msg = (const union snd_ump_stream_msg *)buf;
        status = ump_stream_message_status(*buf);
        switch (status) {
        case UMP_STREAM_MSG_STATUS_EP_INFO:
                ret = ump_handle_ep_info_msg(ump, msg);
                break;
        case UMP_STREAM_MSG_STATUS_DEVICE_INFO:
                ret = ump_handle_device_info_msg(ump, msg);
                break;
        case UMP_STREAM_MSG_STATUS_EP_NAME:
                ret = ump_handle_ep_name_msg(ump, msg);
                break;
        case UMP_STREAM_MSG_STATUS_PRODUCT_ID:
                ret = ump_handle_product_id_msg(ump, msg);
                break;
        case UMP_STREAM_MSG_STATUS_STREAM_CFG:
                ret = ump_handle_stream_cfg_msg(ump, msg);
                break;
        case UMP_STREAM_MSG_STATUS_FB_INFO:
                ret = ump_handle_fb_info_msg(ump, msg);
                break;
        case UMP_STREAM_MSG_STATUS_FB_NAME:
                ret = ump_handle_fb_name_msg(ump, msg);
                break;
        default:
                return;
        }

        /* when the message has been processed fully, wake up */
        if (ret > 0 && ump->stream_wait_for == status) {
                WRITE_ONCE(ump->stream_finished, 1);
                wake_up(&ump->stream_wait);
        }
}

/**
 * snd_ump_parse_endpoint - parse endpoint and create function blocks
 * @ump: UMP object
 *
 * Returns 0 for successful parse, -ENODEV if device doesn't respond
 * (or the query is unsupported), or other error code for serious errors.
 */
int snd_ump_parse_endpoint(struct snd_ump_endpoint *ump)
{
        int blk, err;
        u32 msg;

        if (!(ump->core.info_flags & SNDRV_RAWMIDI_INFO_DUPLEX))
                return -ENODEV;

        err = ump_request_open(ump);
        if (err < 0) {
                ump_dbg(ump, "Unable to open rawmidi device: %d\n", err);
                return err;
        }

        /* Check Endpoint Information */
        msg = ump_stream_compose(UMP_STREAM_MSG_STATUS_EP_DISCOVERY, 0) |
                0x0101; /* UMP version 1.1 */
        err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_EP_INFO,
                          UMP_STREAM_MSG_STATUS_EP_INFO);
        if (err < 0) {
                ump_dbg(ump, "Unable to get UMP EP info\n");
                goto error;
        }

        /* Request Endpoint Device Info */
        err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_DEVICE_INFO,
                          UMP_STREAM_MSG_STATUS_DEVICE_INFO);
        if (err < 0)
                ump_dbg(ump, "Unable to get UMP EP device info\n");

        /* Request Endpoint Name */
        err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_EP_NAME,
                          UMP_STREAM_MSG_STATUS_EP_NAME);
        if (err < 0)
                ump_dbg(ump, "Unable to get UMP EP name string\n");

        ump_set_rawmidi_name(ump);

        /* Request Endpoint Product ID */
        err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_PRODUCT_ID,
                          UMP_STREAM_MSG_STATUS_PRODUCT_ID);
        if (err < 0)
                ump_dbg(ump, "Unable to get UMP EP product ID string\n");

        /* Get the current stream configuration */
        err = ump_req_msg(ump, msg, UMP_STREAM_MSG_REQUEST_STREAM_CFG,
                          UMP_STREAM_MSG_STATUS_STREAM_CFG);
        if (err < 0)
                ump_dbg(ump, "Unable to get UMP EP stream config\n");

        /* If no protocol is set by some reason, assume the valid one */
        choose_default_protocol(ump);

        /* Query and create blocks from Function Blocks */
        for (blk = 0; blk < ump->info.num_blocks; blk++) {
                err = create_block_from_fb_info(ump, blk);
                if (err < 0)
                        continue;
        }

        /* initialize group attributions */
        snd_ump_update_group_attrs(ump);

 error:
        ump->parsed = true;
        ump_request_close(ump);
        if (err == -ETIMEDOUT)
                err = -ENODEV;
        return err;
}
EXPORT_SYMBOL_GPL(snd_ump_parse_endpoint);

#if IS_ENABLED(CONFIG_SND_UMP_LEGACY_RAWMIDI)
/*
 * Legacy rawmidi support
 */
static int snd_ump_legacy_open(struct snd_rawmidi_substream *substream)
{
        struct snd_ump_endpoint *ump = substream->rmidi->private_data;
        int dir = substream->stream;
        int group = ump->legacy_mapping[substream->number];
        int err;

        guard(mutex)(&ump->open_mutex);
        if (ump->legacy_substreams[dir][group])
                return -EBUSY;
        if (!ump->groups[group].active)
                return -ENODEV;
        if (dir == SNDRV_RAWMIDI_STREAM_OUTPUT) {
                if (!ump->legacy_out_opens) {
                        err = snd_rawmidi_kernel_open(&ump->core, 0,
                                                      SNDRV_RAWMIDI_LFLG_OUTPUT |
                                                      SNDRV_RAWMIDI_LFLG_APPEND,
                                                      &ump->legacy_out_rfile);
                        if (err < 0)
                                return err;
                }
                ump->legacy_out_opens++;
                snd_ump_convert_reset(&ump->out_cvts[group]);
        }
        guard(spinlock_irq)(&ump->legacy_locks[dir]);
        ump->legacy_substreams[dir][group] = substream;
        return 0;
}

static int snd_ump_legacy_close(struct snd_rawmidi_substream *substream)
{
        struct snd_ump_endpoint *ump = substream->rmidi->private_data;
        int dir = substream->stream;
        int group = ump->legacy_mapping[substream->number];

        guard(mutex)(&ump->open_mutex);
        scoped_guard(spinlock_irq, &ump->legacy_locks[dir])
                ump->legacy_substreams[dir][group] = NULL;
        if (dir == SNDRV_RAWMIDI_STREAM_OUTPUT) {
                if (!--ump->legacy_out_opens)
                        snd_rawmidi_kernel_release(&ump->legacy_out_rfile);
        }
        return 0;
}

static void snd_ump_legacy_trigger(struct snd_rawmidi_substream *substream,
                                   int up)
{
        struct snd_ump_endpoint *ump = substream->rmidi->private_data;
        int dir = substream->stream;

        ump->ops->trigger(ump, dir, up);
}

static void snd_ump_legacy_drain(struct snd_rawmidi_substream *substream)
{
        struct snd_ump_endpoint *ump = substream->rmidi->private_data;

        if (ump->ops->drain)
                ump->ops->drain(ump, SNDRV_RAWMIDI_STREAM_OUTPUT);
}

static int snd_ump_legacy_dev_register(struct snd_rawmidi *rmidi)
{
        /* dummy, just for avoiding create superfluous seq clients */
        return 0;
}

static const struct snd_rawmidi_ops snd_ump_legacy_input_ops = {
        .open = snd_ump_legacy_open,
        .close = snd_ump_legacy_close,
        .trigger = snd_ump_legacy_trigger,
};

static const struct snd_rawmidi_ops snd_ump_legacy_output_ops = {
        .open = snd_ump_legacy_open,
        .close = snd_ump_legacy_close,
        .trigger = snd_ump_legacy_trigger,
        .drain = snd_ump_legacy_drain,
};

static const struct snd_rawmidi_global_ops snd_ump_legacy_ops = {
        .dev_register = snd_ump_legacy_dev_register,
};

static int process_legacy_output(struct snd_ump_endpoint *ump,
                                 u32 *buffer, int count)
{
        struct snd_rawmidi_substream *substream;
        struct ump_cvt_to_ump *ctx;
        const int dir = SNDRV_RAWMIDI_STREAM_OUTPUT;
        unsigned int protocol;
        unsigned char c;
        int group, size = 0;

        if (!ump->out_cvts || !ump->legacy_out_opens)
                return 0;

        guard(spinlock_irqsave)(&ump->legacy_locks[dir]);
        for (group = 0; group < SNDRV_UMP_MAX_GROUPS; group++) {
                substream = ump->legacy_substreams[dir][group];
                if (!substream)
                        continue;
                ctx = &ump->out_cvts[group];
                protocol = ump->info.protocol;
                if ((protocol & SNDRV_UMP_EP_INFO_PROTO_MIDI2) &&
                    ump->groups[group].is_midi1)
                        protocol = SNDRV_UMP_EP_INFO_PROTO_MIDI1;
                while (!ctx->ump_bytes &&
                       snd_rawmidi_transmit(substream, &c, 1) > 0)
                        snd_ump_convert_to_ump(ctx, group, protocol, c);
                if (ctx->ump_bytes && ctx->ump_bytes <= count) {
                        size = ctx->ump_bytes;
                        memcpy(buffer, ctx->ump, size);
                        ctx->ump_bytes = 0;
                        break;
                }
        }
        return size;
}

static void process_legacy_input(struct snd_ump_endpoint *ump, const u32 *src,
                                 int words)
{
        struct snd_rawmidi_substream *substream;
        unsigned char buf[16];
        unsigned char group;
        const int dir = SNDRV_RAWMIDI_STREAM_INPUT;
        int size;

        size = snd_ump_convert_from_ump(src, buf, &group);
        if (size <= 0)
                return;
        guard(spinlock_irqsave)(&ump->legacy_locks[dir]);
        substream = ump->legacy_substreams[dir][group];
        if (substream)
                snd_rawmidi_receive(substream, buf, size);
}

/* Fill ump->legacy_mapping[] for groups to be used for legacy rawmidi */
static int fill_legacy_mapping(struct snd_ump_endpoint *ump)
{
        struct snd_ump_block *fb;
        unsigned int group_maps = 0;
        int i, num;

        if (ump->info.flags & SNDRV_UMP_EP_INFO_STATIC_BLOCKS) {
                list_for_each_entry(fb, &ump->block_list, list) {
                        for (i = 0; i < fb->info.num_groups; i++)
                                group_maps |= 1U << (fb->info.first_group + i);
                }
                if (!group_maps)
                        ump_info(ump, "No UMP Group is found in FB\n");
        }

        /* use all groups for non-static case */
        if (!group_maps)
                group_maps = (1U << SNDRV_UMP_MAX_GROUPS) - 1;

        num = 0;
        for (i = 0; i < SNDRV_UMP_MAX_GROUPS; i++)
                if (group_maps & (1U << i))
                        ump->legacy_mapping[num++] = i;

        return num;
}

static void update_legacy_substreams(struct snd_ump_endpoint *ump,
                                     struct snd_rawmidi *rmidi, int dir)
{
        struct snd_rawmidi_substream *s;
        const char *name;
        int idx;

        list_for_each_entry(s, &rmidi->streams[dir].substreams, list) {
                idx = ump->legacy_mapping[s->number];
                name = ump->groups[idx].name;
                if (!*name)
                        name = ump->core.name;
                scnprintf(s->name, sizeof(s->name), "Group %d (%.16s)%s",
                          idx + 1, name,
                          ump->groups[idx].active ? "" : " [Inactive]");
                s->inactive = !ump->groups[idx].active;
        }
}

static void update_legacy_names(struct snd_ump_endpoint *ump)
{
        struct snd_rawmidi *rmidi = ump->legacy_rmidi;

        update_legacy_substreams(ump, rmidi, SNDRV_RAWMIDI_STREAM_INPUT);
        update_legacy_substreams(ump, rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT);
}

static void ump_legacy_set_rawmidi_name(struct snd_ump_endpoint *ump)
{
        struct snd_rawmidi *rmidi = ump->legacy_rmidi;

        snprintf(rmidi->name, sizeof(rmidi->name), "%.68s (MIDI 1.0)",
                 ump->core.name);
}

int snd_ump_attach_legacy_rawmidi(struct snd_ump_endpoint *ump,
                                  char *id, int device)
{
        struct snd_rawmidi *rmidi;
        bool input, output;
        int err, num;

        ump->out_cvts = kzalloc_objs(*ump->out_cvts, SNDRV_UMP_MAX_GROUPS);
        if (!ump->out_cvts)
                return -ENOMEM;

        num = fill_legacy_mapping(ump);

        input = ump->core.info_flags & SNDRV_RAWMIDI_INFO_INPUT;
        output = ump->core.info_flags & SNDRV_RAWMIDI_INFO_OUTPUT;
        err = snd_rawmidi_new(ump->core.card, id, device,
                              output ? num : 0, input ? num : 0,
                              &rmidi);
        if (err < 0) {
                kfree(ump->out_cvts);
                return err;
        }

        if (input)
                snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_INPUT,
                                    &snd_ump_legacy_input_ops);
        if (output)
                snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT,
                                    &snd_ump_legacy_output_ops);
        rmidi->info_flags = ump->core.info_flags & ~SNDRV_RAWMIDI_INFO_UMP;
        rmidi->ops = &snd_ump_legacy_ops;
        rmidi->private_data = ump;
        ump->legacy_rmidi = rmidi;
        ump_legacy_set_rawmidi_name(ump);
        update_legacy_names(ump);

        snd_rawmidi_tie_devices(rmidi, &ump->core);

        ump_dbg(ump, "Created a legacy rawmidi #%d (%s)\n", device, id);
        return 0;
}
EXPORT_SYMBOL_GPL(snd_ump_attach_legacy_rawmidi);
#endif /* CONFIG_SND_UMP_LEGACY_RAWMIDI */

MODULE_DESCRIPTION("Universal MIDI Packet (UMP) Core Driver");
MODULE_LICENSE("GPL");