xref: /kernel/linux/linux-6.6/sound/usb/line6/midi.c (revision 62306a36)
162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Line 6 Linux USB driver
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2004-2010 Markus Grabner (grabner@icg.tugraz.at)
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/slab.h>
962306a36Sopenharmony_ci#include <linux/usb.h>
1062306a36Sopenharmony_ci#include <linux/export.h>
1162306a36Sopenharmony_ci#include <sound/core.h>
1262306a36Sopenharmony_ci#include <sound/rawmidi.h>
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_ci#include "driver.h"
1562306a36Sopenharmony_ci#include "midi.h"
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#define line6_rawmidi_substream_midi(substream) \
1862306a36Sopenharmony_ci	((struct snd_line6_midi *)((substream)->rmidi->private_data))
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_cistatic int send_midi_async(struct usb_line6 *line6, unsigned char *data,
2162306a36Sopenharmony_ci			   int length);
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci/*
2462306a36Sopenharmony_ci	Pass data received via USB to MIDI.
2562306a36Sopenharmony_ci*/
2662306a36Sopenharmony_civoid line6_midi_receive(struct usb_line6 *line6, unsigned char *data,
2762306a36Sopenharmony_ci			int length)
2862306a36Sopenharmony_ci{
2962306a36Sopenharmony_ci	if (line6->line6midi->substream_receive)
3062306a36Sopenharmony_ci		snd_rawmidi_receive(line6->line6midi->substream_receive,
3162306a36Sopenharmony_ci				    data, length);
3262306a36Sopenharmony_ci}
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci/*
3562306a36Sopenharmony_ci	Read data from MIDI buffer and transmit them via USB.
3662306a36Sopenharmony_ci*/
3762306a36Sopenharmony_cistatic void line6_midi_transmit(struct snd_rawmidi_substream *substream)
3862306a36Sopenharmony_ci{
3962306a36Sopenharmony_ci	struct usb_line6 *line6 =
4062306a36Sopenharmony_ci	    line6_rawmidi_substream_midi(substream)->line6;
4162306a36Sopenharmony_ci	struct snd_line6_midi *line6midi = line6->line6midi;
4262306a36Sopenharmony_ci	struct midi_buffer *mb = &line6midi->midibuf_out;
4362306a36Sopenharmony_ci	unsigned char chunk[LINE6_FALLBACK_MAXPACKETSIZE];
4462306a36Sopenharmony_ci	int req, done;
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci	for (;;) {
4762306a36Sopenharmony_ci		req = min3(line6_midibuf_bytes_free(mb), line6->max_packet_size,
4862306a36Sopenharmony_ci			   LINE6_FALLBACK_MAXPACKETSIZE);
4962306a36Sopenharmony_ci		done = snd_rawmidi_transmit_peek(substream, chunk, req);
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci		if (done == 0)
5262306a36Sopenharmony_ci			break;
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci		line6_midibuf_write(mb, chunk, done);
5562306a36Sopenharmony_ci		snd_rawmidi_transmit_ack(substream, done);
5662306a36Sopenharmony_ci	}
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_ci	for (;;) {
5962306a36Sopenharmony_ci		done = line6_midibuf_read(mb, chunk,
6062306a36Sopenharmony_ci					  LINE6_FALLBACK_MAXPACKETSIZE,
6162306a36Sopenharmony_ci					  LINE6_MIDIBUF_READ_TX);
6262306a36Sopenharmony_ci
6362306a36Sopenharmony_ci		if (done == 0)
6462306a36Sopenharmony_ci			break;
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci		send_midi_async(line6, chunk, done);
6762306a36Sopenharmony_ci	}
6862306a36Sopenharmony_ci}
6962306a36Sopenharmony_ci
7062306a36Sopenharmony_ci/*
7162306a36Sopenharmony_ci	Notification of completion of MIDI transmission.
7262306a36Sopenharmony_ci*/
7362306a36Sopenharmony_cistatic void midi_sent(struct urb *urb)
7462306a36Sopenharmony_ci{
7562306a36Sopenharmony_ci	unsigned long flags;
7662306a36Sopenharmony_ci	int status;
7762306a36Sopenharmony_ci	int num;
7862306a36Sopenharmony_ci	struct usb_line6 *line6 = (struct usb_line6 *)urb->context;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	status = urb->status;
8162306a36Sopenharmony_ci	kfree(urb->transfer_buffer);
8262306a36Sopenharmony_ci	usb_free_urb(urb);
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	if (status == -ESHUTDOWN)
8562306a36Sopenharmony_ci		return;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	spin_lock_irqsave(&line6->line6midi->lock, flags);
8862306a36Sopenharmony_ci	num = --line6->line6midi->num_active_send_urbs;
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	if (num == 0) {
9162306a36Sopenharmony_ci		line6_midi_transmit(line6->line6midi->substream_transmit);
9262306a36Sopenharmony_ci		num = line6->line6midi->num_active_send_urbs;
9362306a36Sopenharmony_ci	}
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	if (num == 0)
9662306a36Sopenharmony_ci		wake_up(&line6->line6midi->send_wait);
9762306a36Sopenharmony_ci
9862306a36Sopenharmony_ci	spin_unlock_irqrestore(&line6->line6midi->lock, flags);
9962306a36Sopenharmony_ci}
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci/*
10262306a36Sopenharmony_ci	Send an asynchronous MIDI message.
10362306a36Sopenharmony_ci	Assumes that line6->line6midi->lock is held
10462306a36Sopenharmony_ci	(i.e., this function is serialized).
10562306a36Sopenharmony_ci*/
10662306a36Sopenharmony_cistatic int send_midi_async(struct usb_line6 *line6, unsigned char *data,
10762306a36Sopenharmony_ci			   int length)
10862306a36Sopenharmony_ci{
10962306a36Sopenharmony_ci	struct urb *urb;
11062306a36Sopenharmony_ci	int retval;
11162306a36Sopenharmony_ci	unsigned char *transfer_buffer;
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	urb = usb_alloc_urb(0, GFP_ATOMIC);
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_ci	if (urb == NULL)
11662306a36Sopenharmony_ci		return -ENOMEM;
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	transfer_buffer = kmemdup(data, length, GFP_ATOMIC);
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	if (transfer_buffer == NULL) {
12162306a36Sopenharmony_ci		usb_free_urb(urb);
12262306a36Sopenharmony_ci		return -ENOMEM;
12362306a36Sopenharmony_ci	}
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci	usb_fill_int_urb(urb, line6->usbdev,
12662306a36Sopenharmony_ci			 usb_sndintpipe(line6->usbdev,
12762306a36Sopenharmony_ci					 line6->properties->ep_ctrl_w),
12862306a36Sopenharmony_ci			 transfer_buffer, length, midi_sent, line6,
12962306a36Sopenharmony_ci			 line6->interval);
13062306a36Sopenharmony_ci	urb->actual_length = 0;
13162306a36Sopenharmony_ci	retval = usb_urb_ep_type_check(urb);
13262306a36Sopenharmony_ci	if (retval < 0)
13362306a36Sopenharmony_ci		goto error;
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	retval = usb_submit_urb(urb, GFP_ATOMIC);
13662306a36Sopenharmony_ci	if (retval < 0)
13762306a36Sopenharmony_ci		goto error;
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	++line6->line6midi->num_active_send_urbs;
14062306a36Sopenharmony_ci	return 0;
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_ci error:
14362306a36Sopenharmony_ci	dev_err(line6->ifcdev, "usb_submit_urb failed\n");
14462306a36Sopenharmony_ci	usb_free_urb(urb);
14562306a36Sopenharmony_ci	return retval;
14662306a36Sopenharmony_ci}
14762306a36Sopenharmony_ci
14862306a36Sopenharmony_cistatic int line6_midi_output_open(struct snd_rawmidi_substream *substream)
14962306a36Sopenharmony_ci{
15062306a36Sopenharmony_ci	return 0;
15162306a36Sopenharmony_ci}
15262306a36Sopenharmony_ci
15362306a36Sopenharmony_cistatic int line6_midi_output_close(struct snd_rawmidi_substream *substream)
15462306a36Sopenharmony_ci{
15562306a36Sopenharmony_ci	return 0;
15662306a36Sopenharmony_ci}
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_cistatic void line6_midi_output_trigger(struct snd_rawmidi_substream *substream,
15962306a36Sopenharmony_ci				      int up)
16062306a36Sopenharmony_ci{
16162306a36Sopenharmony_ci	unsigned long flags;
16262306a36Sopenharmony_ci	struct usb_line6 *line6 =
16362306a36Sopenharmony_ci	    line6_rawmidi_substream_midi(substream)->line6;
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_ci	line6->line6midi->substream_transmit = substream;
16662306a36Sopenharmony_ci	spin_lock_irqsave(&line6->line6midi->lock, flags);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	if (line6->line6midi->num_active_send_urbs == 0)
16962306a36Sopenharmony_ci		line6_midi_transmit(substream);
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	spin_unlock_irqrestore(&line6->line6midi->lock, flags);
17262306a36Sopenharmony_ci}
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_cistatic void line6_midi_output_drain(struct snd_rawmidi_substream *substream)
17562306a36Sopenharmony_ci{
17662306a36Sopenharmony_ci	struct usb_line6 *line6 =
17762306a36Sopenharmony_ci	    line6_rawmidi_substream_midi(substream)->line6;
17862306a36Sopenharmony_ci	struct snd_line6_midi *midi = line6->line6midi;
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci	wait_event_interruptible(midi->send_wait,
18162306a36Sopenharmony_ci				 midi->num_active_send_urbs == 0);
18262306a36Sopenharmony_ci}
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_cistatic int line6_midi_input_open(struct snd_rawmidi_substream *substream)
18562306a36Sopenharmony_ci{
18662306a36Sopenharmony_ci	return 0;
18762306a36Sopenharmony_ci}
18862306a36Sopenharmony_ci
18962306a36Sopenharmony_cistatic int line6_midi_input_close(struct snd_rawmidi_substream *substream)
19062306a36Sopenharmony_ci{
19162306a36Sopenharmony_ci	return 0;
19262306a36Sopenharmony_ci}
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_cistatic void line6_midi_input_trigger(struct snd_rawmidi_substream *substream,
19562306a36Sopenharmony_ci				     int up)
19662306a36Sopenharmony_ci{
19762306a36Sopenharmony_ci	struct usb_line6 *line6 =
19862306a36Sopenharmony_ci	    line6_rawmidi_substream_midi(substream)->line6;
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci	if (up)
20162306a36Sopenharmony_ci		line6->line6midi->substream_receive = substream;
20262306a36Sopenharmony_ci	else
20362306a36Sopenharmony_ci		line6->line6midi->substream_receive = NULL;
20462306a36Sopenharmony_ci}
20562306a36Sopenharmony_ci
20662306a36Sopenharmony_cistatic const struct snd_rawmidi_ops line6_midi_output_ops = {
20762306a36Sopenharmony_ci	.open = line6_midi_output_open,
20862306a36Sopenharmony_ci	.close = line6_midi_output_close,
20962306a36Sopenharmony_ci	.trigger = line6_midi_output_trigger,
21062306a36Sopenharmony_ci	.drain = line6_midi_output_drain,
21162306a36Sopenharmony_ci};
21262306a36Sopenharmony_ci
21362306a36Sopenharmony_cistatic const struct snd_rawmidi_ops line6_midi_input_ops = {
21462306a36Sopenharmony_ci	.open = line6_midi_input_open,
21562306a36Sopenharmony_ci	.close = line6_midi_input_close,
21662306a36Sopenharmony_ci	.trigger = line6_midi_input_trigger,
21762306a36Sopenharmony_ci};
21862306a36Sopenharmony_ci
21962306a36Sopenharmony_ci/* Create a MIDI device */
22062306a36Sopenharmony_cistatic int snd_line6_new_midi(struct usb_line6 *line6,
22162306a36Sopenharmony_ci			      struct snd_rawmidi **rmidi_ret)
22262306a36Sopenharmony_ci{
22362306a36Sopenharmony_ci	struct snd_rawmidi *rmidi;
22462306a36Sopenharmony_ci	int err;
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci	err = snd_rawmidi_new(line6->card, "Line 6 MIDI", 0, 1, 1, rmidi_ret);
22762306a36Sopenharmony_ci	if (err < 0)
22862306a36Sopenharmony_ci		return err;
22962306a36Sopenharmony_ci
23062306a36Sopenharmony_ci	rmidi = *rmidi_ret;
23162306a36Sopenharmony_ci	strcpy(rmidi->id, line6->properties->id);
23262306a36Sopenharmony_ci	strcpy(rmidi->name, line6->properties->name);
23362306a36Sopenharmony_ci
23462306a36Sopenharmony_ci	rmidi->info_flags =
23562306a36Sopenharmony_ci	    SNDRV_RAWMIDI_INFO_OUTPUT |
23662306a36Sopenharmony_ci	    SNDRV_RAWMIDI_INFO_INPUT | SNDRV_RAWMIDI_INFO_DUPLEX;
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_ci	snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT,
23962306a36Sopenharmony_ci			    &line6_midi_output_ops);
24062306a36Sopenharmony_ci	snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_INPUT,
24162306a36Sopenharmony_ci			    &line6_midi_input_ops);
24262306a36Sopenharmony_ci	return 0;
24362306a36Sopenharmony_ci}
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci/* MIDI device destructor */
24662306a36Sopenharmony_cistatic void snd_line6_midi_free(struct snd_rawmidi *rmidi)
24762306a36Sopenharmony_ci{
24862306a36Sopenharmony_ci	struct snd_line6_midi *line6midi = rmidi->private_data;
24962306a36Sopenharmony_ci
25062306a36Sopenharmony_ci	line6_midibuf_destroy(&line6midi->midibuf_in);
25162306a36Sopenharmony_ci	line6_midibuf_destroy(&line6midi->midibuf_out);
25262306a36Sopenharmony_ci	kfree(line6midi);
25362306a36Sopenharmony_ci}
25462306a36Sopenharmony_ci
25562306a36Sopenharmony_ci/*
25662306a36Sopenharmony_ci	Initialize the Line 6 MIDI subsystem.
25762306a36Sopenharmony_ci*/
25862306a36Sopenharmony_ciint line6_init_midi(struct usb_line6 *line6)
25962306a36Sopenharmony_ci{
26062306a36Sopenharmony_ci	int err;
26162306a36Sopenharmony_ci	struct snd_rawmidi *rmidi;
26262306a36Sopenharmony_ci	struct snd_line6_midi *line6midi;
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_ci	if (!(line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI)) {
26562306a36Sopenharmony_ci		/* skip MIDI initialization and report success */
26662306a36Sopenharmony_ci		return 0;
26762306a36Sopenharmony_ci	}
26862306a36Sopenharmony_ci
26962306a36Sopenharmony_ci	err = snd_line6_new_midi(line6, &rmidi);
27062306a36Sopenharmony_ci	if (err < 0)
27162306a36Sopenharmony_ci		return err;
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_ci	line6midi = kzalloc(sizeof(struct snd_line6_midi), GFP_KERNEL);
27462306a36Sopenharmony_ci	if (!line6midi)
27562306a36Sopenharmony_ci		return -ENOMEM;
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_ci	rmidi->private_data = line6midi;
27862306a36Sopenharmony_ci	rmidi->private_free = snd_line6_midi_free;
27962306a36Sopenharmony_ci
28062306a36Sopenharmony_ci	init_waitqueue_head(&line6midi->send_wait);
28162306a36Sopenharmony_ci	spin_lock_init(&line6midi->lock);
28262306a36Sopenharmony_ci	line6midi->line6 = line6;
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_ci	err = line6_midibuf_init(&line6midi->midibuf_in, MIDI_BUFFER_SIZE, 0);
28562306a36Sopenharmony_ci	if (err < 0)
28662306a36Sopenharmony_ci		return err;
28762306a36Sopenharmony_ci
28862306a36Sopenharmony_ci	err = line6_midibuf_init(&line6midi->midibuf_out, MIDI_BUFFER_SIZE, 1);
28962306a36Sopenharmony_ci	if (err < 0)
29062306a36Sopenharmony_ci		return err;
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_ci	line6->line6midi = line6midi;
29362306a36Sopenharmony_ci	return 0;
29462306a36Sopenharmony_ci}
29562306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_init_midi);
296