xref: /kernel/linux/linux-5.10/sound/usb/line6/driver.c (revision 8c2ecf20)
18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Line 6 Linux USB driver
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2004-2010 Markus Grabner (grabner@icg.tugraz.at)
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include <linux/kernel.h>
98c2ecf20Sopenharmony_ci#include <linux/module.h>
108c2ecf20Sopenharmony_ci#include <linux/export.h>
118c2ecf20Sopenharmony_ci#include <linux/slab.h>
128c2ecf20Sopenharmony_ci#include <linux/usb.h>
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include <sound/core.h>
158c2ecf20Sopenharmony_ci#include <sound/initval.h>
168c2ecf20Sopenharmony_ci#include <sound/hwdep.h>
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci#include "capture.h"
198c2ecf20Sopenharmony_ci#include "driver.h"
208c2ecf20Sopenharmony_ci#include "midi.h"
218c2ecf20Sopenharmony_ci#include "playback.h"
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_ci#define DRIVER_AUTHOR  "Markus Grabner <grabner@icg.tugraz.at>"
248c2ecf20Sopenharmony_ci#define DRIVER_DESC    "Line 6 USB Driver"
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci/*
278c2ecf20Sopenharmony_ci	This is Line 6's MIDI manufacturer ID.
288c2ecf20Sopenharmony_ci*/
298c2ecf20Sopenharmony_ciconst unsigned char line6_midi_id[3] = {
308c2ecf20Sopenharmony_ci	0x00, 0x01, 0x0c
318c2ecf20Sopenharmony_ci};
328c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_midi_id);
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci/*
358c2ecf20Sopenharmony_ci	Code to request version of POD, Variax interface
368c2ecf20Sopenharmony_ci	(and maybe other devices).
378c2ecf20Sopenharmony_ci*/
388c2ecf20Sopenharmony_cistatic const char line6_request_version[] = {
398c2ecf20Sopenharmony_ci	0xf0, 0x7e, 0x7f, 0x06, 0x01, 0xf7
408c2ecf20Sopenharmony_ci};
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci/*
438c2ecf20Sopenharmony_ci	 Class for asynchronous messages.
448c2ecf20Sopenharmony_ci*/
458c2ecf20Sopenharmony_cistruct message {
468c2ecf20Sopenharmony_ci	struct usb_line6 *line6;
478c2ecf20Sopenharmony_ci	const char *buffer;
488c2ecf20Sopenharmony_ci	int size;
498c2ecf20Sopenharmony_ci	int done;
508c2ecf20Sopenharmony_ci};
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci/*
538c2ecf20Sopenharmony_ci	Forward declarations.
548c2ecf20Sopenharmony_ci*/
558c2ecf20Sopenharmony_cistatic void line6_data_received(struct urb *urb);
568c2ecf20Sopenharmony_cistatic int line6_send_raw_message_async_part(struct message *msg,
578c2ecf20Sopenharmony_ci					     struct urb *urb);
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci/*
608c2ecf20Sopenharmony_ci	Start to listen on endpoint.
618c2ecf20Sopenharmony_ci*/
628c2ecf20Sopenharmony_cistatic int line6_start_listen(struct usb_line6 *line6)
638c2ecf20Sopenharmony_ci{
648c2ecf20Sopenharmony_ci	int err;
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
678c2ecf20Sopenharmony_ci		usb_fill_int_urb(line6->urb_listen, line6->usbdev,
688c2ecf20Sopenharmony_ci			usb_rcvintpipe(line6->usbdev, line6->properties->ep_ctrl_r),
698c2ecf20Sopenharmony_ci			line6->buffer_listen, LINE6_BUFSIZE_LISTEN,
708c2ecf20Sopenharmony_ci			line6_data_received, line6, line6->interval);
718c2ecf20Sopenharmony_ci	} else {
728c2ecf20Sopenharmony_ci		usb_fill_bulk_urb(line6->urb_listen, line6->usbdev,
738c2ecf20Sopenharmony_ci			usb_rcvbulkpipe(line6->usbdev, line6->properties->ep_ctrl_r),
748c2ecf20Sopenharmony_ci			line6->buffer_listen, LINE6_BUFSIZE_LISTEN,
758c2ecf20Sopenharmony_ci			line6_data_received, line6);
768c2ecf20Sopenharmony_ci	}
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ci	/* sanity checks of EP before actually submitting */
798c2ecf20Sopenharmony_ci	if (usb_urb_ep_type_check(line6->urb_listen)) {
808c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "invalid control EP\n");
818c2ecf20Sopenharmony_ci		return -EINVAL;
828c2ecf20Sopenharmony_ci	}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	line6->urb_listen->actual_length = 0;
858c2ecf20Sopenharmony_ci	err = usb_submit_urb(line6->urb_listen, GFP_ATOMIC);
868c2ecf20Sopenharmony_ci	return err;
878c2ecf20Sopenharmony_ci}
888c2ecf20Sopenharmony_ci
898c2ecf20Sopenharmony_ci/*
908c2ecf20Sopenharmony_ci	Stop listening on endpoint.
918c2ecf20Sopenharmony_ci*/
928c2ecf20Sopenharmony_cistatic void line6_stop_listen(struct usb_line6 *line6)
938c2ecf20Sopenharmony_ci{
948c2ecf20Sopenharmony_ci	usb_kill_urb(line6->urb_listen);
958c2ecf20Sopenharmony_ci}
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci/*
988c2ecf20Sopenharmony_ci	Send raw message in pieces of wMaxPacketSize bytes.
998c2ecf20Sopenharmony_ci*/
1008c2ecf20Sopenharmony_ciint line6_send_raw_message(struct usb_line6 *line6, const char *buffer,
1018c2ecf20Sopenharmony_ci				  int size)
1028c2ecf20Sopenharmony_ci{
1038c2ecf20Sopenharmony_ci	int i, done = 0;
1048c2ecf20Sopenharmony_ci	const struct line6_properties *properties = line6->properties;
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci	for (i = 0; i < size; i += line6->max_packet_size) {
1078c2ecf20Sopenharmony_ci		int partial;
1088c2ecf20Sopenharmony_ci		const char *frag_buf = buffer + i;
1098c2ecf20Sopenharmony_ci		int frag_size = min(line6->max_packet_size, size - i);
1108c2ecf20Sopenharmony_ci		int retval;
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci		if (properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
1138c2ecf20Sopenharmony_ci			retval = usb_interrupt_msg(line6->usbdev,
1148c2ecf20Sopenharmony_ci						usb_sndintpipe(line6->usbdev, properties->ep_ctrl_w),
1158c2ecf20Sopenharmony_ci						(char *)frag_buf, frag_size,
1168c2ecf20Sopenharmony_ci						&partial, LINE6_TIMEOUT);
1178c2ecf20Sopenharmony_ci		} else {
1188c2ecf20Sopenharmony_ci			retval = usb_bulk_msg(line6->usbdev,
1198c2ecf20Sopenharmony_ci						usb_sndbulkpipe(line6->usbdev, properties->ep_ctrl_w),
1208c2ecf20Sopenharmony_ci						(char *)frag_buf, frag_size,
1218c2ecf20Sopenharmony_ci						&partial, LINE6_TIMEOUT);
1228c2ecf20Sopenharmony_ci		}
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci		if (retval) {
1258c2ecf20Sopenharmony_ci			dev_err(line6->ifcdev,
1268c2ecf20Sopenharmony_ci				"usb_bulk_msg failed (%d)\n", retval);
1278c2ecf20Sopenharmony_ci			break;
1288c2ecf20Sopenharmony_ci		}
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_ci		done += frag_size;
1318c2ecf20Sopenharmony_ci	}
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci	return done;
1348c2ecf20Sopenharmony_ci}
1358c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_send_raw_message);
1368c2ecf20Sopenharmony_ci
1378c2ecf20Sopenharmony_ci/*
1388c2ecf20Sopenharmony_ci	Notification of completion of asynchronous request transmission.
1398c2ecf20Sopenharmony_ci*/
1408c2ecf20Sopenharmony_cistatic void line6_async_request_sent(struct urb *urb)
1418c2ecf20Sopenharmony_ci{
1428c2ecf20Sopenharmony_ci	struct message *msg = (struct message *)urb->context;
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci	if (msg->done >= msg->size) {
1458c2ecf20Sopenharmony_ci		usb_free_urb(urb);
1468c2ecf20Sopenharmony_ci		kfree(msg);
1478c2ecf20Sopenharmony_ci	} else
1488c2ecf20Sopenharmony_ci		line6_send_raw_message_async_part(msg, urb);
1498c2ecf20Sopenharmony_ci}
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_ci/*
1528c2ecf20Sopenharmony_ci	Asynchronously send part of a raw message.
1538c2ecf20Sopenharmony_ci*/
1548c2ecf20Sopenharmony_cistatic int line6_send_raw_message_async_part(struct message *msg,
1558c2ecf20Sopenharmony_ci					     struct urb *urb)
1568c2ecf20Sopenharmony_ci{
1578c2ecf20Sopenharmony_ci	int retval;
1588c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = msg->line6;
1598c2ecf20Sopenharmony_ci	int done = msg->done;
1608c2ecf20Sopenharmony_ci	int bytes = min(msg->size - done, line6->max_packet_size);
1618c2ecf20Sopenharmony_ci
1628c2ecf20Sopenharmony_ci	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
1638c2ecf20Sopenharmony_ci		usb_fill_int_urb(urb, line6->usbdev,
1648c2ecf20Sopenharmony_ci			usb_sndintpipe(line6->usbdev, line6->properties->ep_ctrl_w),
1658c2ecf20Sopenharmony_ci			(char *)msg->buffer + done, bytes,
1668c2ecf20Sopenharmony_ci			line6_async_request_sent, msg, line6->interval);
1678c2ecf20Sopenharmony_ci	} else {
1688c2ecf20Sopenharmony_ci		usb_fill_bulk_urb(urb, line6->usbdev,
1698c2ecf20Sopenharmony_ci			usb_sndbulkpipe(line6->usbdev, line6->properties->ep_ctrl_w),
1708c2ecf20Sopenharmony_ci			(char *)msg->buffer + done, bytes,
1718c2ecf20Sopenharmony_ci			line6_async_request_sent, msg);
1728c2ecf20Sopenharmony_ci	}
1738c2ecf20Sopenharmony_ci
1748c2ecf20Sopenharmony_ci	msg->done += bytes;
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	/* sanity checks of EP before actually submitting */
1778c2ecf20Sopenharmony_ci	retval = usb_urb_ep_type_check(urb);
1788c2ecf20Sopenharmony_ci	if (retval < 0)
1798c2ecf20Sopenharmony_ci		goto error;
1808c2ecf20Sopenharmony_ci
1818c2ecf20Sopenharmony_ci	retval = usb_submit_urb(urb, GFP_ATOMIC);
1828c2ecf20Sopenharmony_ci	if (retval < 0)
1838c2ecf20Sopenharmony_ci		goto error;
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_ci	return 0;
1868c2ecf20Sopenharmony_ci
1878c2ecf20Sopenharmony_ci error:
1888c2ecf20Sopenharmony_ci	dev_err(line6->ifcdev, "%s: usb_submit_urb failed (%d)\n",
1898c2ecf20Sopenharmony_ci		__func__, retval);
1908c2ecf20Sopenharmony_ci	usb_free_urb(urb);
1918c2ecf20Sopenharmony_ci	kfree(msg);
1928c2ecf20Sopenharmony_ci	return retval;
1938c2ecf20Sopenharmony_ci}
1948c2ecf20Sopenharmony_ci
1958c2ecf20Sopenharmony_ci/*
1968c2ecf20Sopenharmony_ci	Asynchronously send raw message.
1978c2ecf20Sopenharmony_ci*/
1988c2ecf20Sopenharmony_ciint line6_send_raw_message_async(struct usb_line6 *line6, const char *buffer,
1998c2ecf20Sopenharmony_ci				 int size)
2008c2ecf20Sopenharmony_ci{
2018c2ecf20Sopenharmony_ci	struct message *msg;
2028c2ecf20Sopenharmony_ci	struct urb *urb;
2038c2ecf20Sopenharmony_ci
2048c2ecf20Sopenharmony_ci	/* create message: */
2058c2ecf20Sopenharmony_ci	msg = kmalloc(sizeof(struct message), GFP_ATOMIC);
2068c2ecf20Sopenharmony_ci	if (msg == NULL)
2078c2ecf20Sopenharmony_ci		return -ENOMEM;
2088c2ecf20Sopenharmony_ci
2098c2ecf20Sopenharmony_ci	/* create URB: */
2108c2ecf20Sopenharmony_ci	urb = usb_alloc_urb(0, GFP_ATOMIC);
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	if (urb == NULL) {
2138c2ecf20Sopenharmony_ci		kfree(msg);
2148c2ecf20Sopenharmony_ci		return -ENOMEM;
2158c2ecf20Sopenharmony_ci	}
2168c2ecf20Sopenharmony_ci
2178c2ecf20Sopenharmony_ci	/* set message data: */
2188c2ecf20Sopenharmony_ci	msg->line6 = line6;
2198c2ecf20Sopenharmony_ci	msg->buffer = buffer;
2208c2ecf20Sopenharmony_ci	msg->size = size;
2218c2ecf20Sopenharmony_ci	msg->done = 0;
2228c2ecf20Sopenharmony_ci
2238c2ecf20Sopenharmony_ci	/* start sending: */
2248c2ecf20Sopenharmony_ci	return line6_send_raw_message_async_part(msg, urb);
2258c2ecf20Sopenharmony_ci}
2268c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_send_raw_message_async);
2278c2ecf20Sopenharmony_ci
2288c2ecf20Sopenharmony_ci/*
2298c2ecf20Sopenharmony_ci	Send asynchronous device version request.
2308c2ecf20Sopenharmony_ci*/
2318c2ecf20Sopenharmony_ciint line6_version_request_async(struct usb_line6 *line6)
2328c2ecf20Sopenharmony_ci{
2338c2ecf20Sopenharmony_ci	char *buffer;
2348c2ecf20Sopenharmony_ci	int retval;
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci	buffer = kmemdup(line6_request_version,
2378c2ecf20Sopenharmony_ci			sizeof(line6_request_version), GFP_ATOMIC);
2388c2ecf20Sopenharmony_ci	if (buffer == NULL)
2398c2ecf20Sopenharmony_ci		return -ENOMEM;
2408c2ecf20Sopenharmony_ci
2418c2ecf20Sopenharmony_ci	retval = line6_send_raw_message_async(line6, buffer,
2428c2ecf20Sopenharmony_ci					      sizeof(line6_request_version));
2438c2ecf20Sopenharmony_ci	kfree(buffer);
2448c2ecf20Sopenharmony_ci	return retval;
2458c2ecf20Sopenharmony_ci}
2468c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_version_request_async);
2478c2ecf20Sopenharmony_ci
2488c2ecf20Sopenharmony_ci/*
2498c2ecf20Sopenharmony_ci	Send sysex message in pieces of wMaxPacketSize bytes.
2508c2ecf20Sopenharmony_ci*/
2518c2ecf20Sopenharmony_ciint line6_send_sysex_message(struct usb_line6 *line6, const char *buffer,
2528c2ecf20Sopenharmony_ci			     int size)
2538c2ecf20Sopenharmony_ci{
2548c2ecf20Sopenharmony_ci	return line6_send_raw_message(line6, buffer,
2558c2ecf20Sopenharmony_ci				      size + SYSEX_EXTRA_SIZE) -
2568c2ecf20Sopenharmony_ci	    SYSEX_EXTRA_SIZE;
2578c2ecf20Sopenharmony_ci}
2588c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_send_sysex_message);
2598c2ecf20Sopenharmony_ci
2608c2ecf20Sopenharmony_ci/*
2618c2ecf20Sopenharmony_ci	Allocate buffer for sysex message and prepare header.
2628c2ecf20Sopenharmony_ci	@param code sysex message code
2638c2ecf20Sopenharmony_ci	@param size number of bytes between code and sysex end
2648c2ecf20Sopenharmony_ci*/
2658c2ecf20Sopenharmony_cichar *line6_alloc_sysex_buffer(struct usb_line6 *line6, int code1, int code2,
2668c2ecf20Sopenharmony_ci			       int size)
2678c2ecf20Sopenharmony_ci{
2688c2ecf20Sopenharmony_ci	char *buffer = kmalloc(size + SYSEX_EXTRA_SIZE, GFP_ATOMIC);
2698c2ecf20Sopenharmony_ci
2708c2ecf20Sopenharmony_ci	if (!buffer)
2718c2ecf20Sopenharmony_ci		return NULL;
2728c2ecf20Sopenharmony_ci
2738c2ecf20Sopenharmony_ci	buffer[0] = LINE6_SYSEX_BEGIN;
2748c2ecf20Sopenharmony_ci	memcpy(buffer + 1, line6_midi_id, sizeof(line6_midi_id));
2758c2ecf20Sopenharmony_ci	buffer[sizeof(line6_midi_id) + 1] = code1;
2768c2ecf20Sopenharmony_ci	buffer[sizeof(line6_midi_id) + 2] = code2;
2778c2ecf20Sopenharmony_ci	buffer[sizeof(line6_midi_id) + 3 + size] = LINE6_SYSEX_END;
2788c2ecf20Sopenharmony_ci	return buffer;
2798c2ecf20Sopenharmony_ci}
2808c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_alloc_sysex_buffer);
2818c2ecf20Sopenharmony_ci
2828c2ecf20Sopenharmony_ci/*
2838c2ecf20Sopenharmony_ci	Notification of data received from the Line 6 device.
2848c2ecf20Sopenharmony_ci*/
2858c2ecf20Sopenharmony_cistatic void line6_data_received(struct urb *urb)
2868c2ecf20Sopenharmony_ci{
2878c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = (struct usb_line6 *)urb->context;
2888c2ecf20Sopenharmony_ci	struct midi_buffer *mb = &line6->line6midi->midibuf_in;
2898c2ecf20Sopenharmony_ci	int done;
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	if (urb->status == -ESHUTDOWN)
2928c2ecf20Sopenharmony_ci		return;
2938c2ecf20Sopenharmony_ci
2948c2ecf20Sopenharmony_ci	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
2958c2ecf20Sopenharmony_ci		done =
2968c2ecf20Sopenharmony_ci			line6_midibuf_write(mb, urb->transfer_buffer, urb->actual_length);
2978c2ecf20Sopenharmony_ci
2988c2ecf20Sopenharmony_ci		if (done < urb->actual_length) {
2998c2ecf20Sopenharmony_ci			line6_midibuf_ignore(mb, done);
3008c2ecf20Sopenharmony_ci			dev_dbg(line6->ifcdev, "%d %d buffer overflow - message skipped\n",
3018c2ecf20Sopenharmony_ci				done, urb->actual_length);
3028c2ecf20Sopenharmony_ci		}
3038c2ecf20Sopenharmony_ci
3048c2ecf20Sopenharmony_ci		for (;;) {
3058c2ecf20Sopenharmony_ci			done =
3068c2ecf20Sopenharmony_ci				line6_midibuf_read(mb, line6->buffer_message,
3078c2ecf20Sopenharmony_ci						   LINE6_MIDI_MESSAGE_MAXLEN,
3088c2ecf20Sopenharmony_ci						   LINE6_MIDIBUF_READ_RX);
3098c2ecf20Sopenharmony_ci
3108c2ecf20Sopenharmony_ci			if (done <= 0)
3118c2ecf20Sopenharmony_ci				break;
3128c2ecf20Sopenharmony_ci
3138c2ecf20Sopenharmony_ci			line6->message_length = done;
3148c2ecf20Sopenharmony_ci			line6_midi_receive(line6, line6->buffer_message, done);
3158c2ecf20Sopenharmony_ci
3168c2ecf20Sopenharmony_ci			if (line6->process_message)
3178c2ecf20Sopenharmony_ci				line6->process_message(line6);
3188c2ecf20Sopenharmony_ci		}
3198c2ecf20Sopenharmony_ci	} else {
3208c2ecf20Sopenharmony_ci		line6->buffer_message = urb->transfer_buffer;
3218c2ecf20Sopenharmony_ci		line6->message_length = urb->actual_length;
3228c2ecf20Sopenharmony_ci		if (line6->process_message)
3238c2ecf20Sopenharmony_ci			line6->process_message(line6);
3248c2ecf20Sopenharmony_ci		line6->buffer_message = NULL;
3258c2ecf20Sopenharmony_ci	}
3268c2ecf20Sopenharmony_ci
3278c2ecf20Sopenharmony_ci	line6_start_listen(line6);
3288c2ecf20Sopenharmony_ci}
3298c2ecf20Sopenharmony_ci
3308c2ecf20Sopenharmony_ci#define LINE6_READ_WRITE_STATUS_DELAY 2  /* milliseconds */
3318c2ecf20Sopenharmony_ci#define LINE6_READ_WRITE_MAX_RETRIES 50
3328c2ecf20Sopenharmony_ci
3338c2ecf20Sopenharmony_ci/*
3348c2ecf20Sopenharmony_ci	Read data from device.
3358c2ecf20Sopenharmony_ci*/
3368c2ecf20Sopenharmony_ciint line6_read_data(struct usb_line6 *line6, unsigned address, void *data,
3378c2ecf20Sopenharmony_ci		    unsigned datalen)
3388c2ecf20Sopenharmony_ci{
3398c2ecf20Sopenharmony_ci	struct usb_device *usbdev = line6->usbdev;
3408c2ecf20Sopenharmony_ci	int ret;
3418c2ecf20Sopenharmony_ci	u8 len;
3428c2ecf20Sopenharmony_ci	unsigned count;
3438c2ecf20Sopenharmony_ci
3448c2ecf20Sopenharmony_ci	if (address > 0xffff || datalen > 0xff)
3458c2ecf20Sopenharmony_ci		return -EINVAL;
3468c2ecf20Sopenharmony_ci
3478c2ecf20Sopenharmony_ci	/* query the serial number: */
3488c2ecf20Sopenharmony_ci	ret = usb_control_msg_send(usbdev, 0, 0x67,
3498c2ecf20Sopenharmony_ci				   USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
3508c2ecf20Sopenharmony_ci				   (datalen << 8) | 0x21, address, NULL, 0,
3518c2ecf20Sopenharmony_ci				   LINE6_TIMEOUT, GFP_KERNEL);
3528c2ecf20Sopenharmony_ci	if (ret) {
3538c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "read request failed (error %d)\n", ret);
3548c2ecf20Sopenharmony_ci		goto exit;
3558c2ecf20Sopenharmony_ci	}
3568c2ecf20Sopenharmony_ci
3578c2ecf20Sopenharmony_ci	/* Wait for data length. We'll get 0xff until length arrives. */
3588c2ecf20Sopenharmony_ci	for (count = 0; count < LINE6_READ_WRITE_MAX_RETRIES; count++) {
3598c2ecf20Sopenharmony_ci		mdelay(LINE6_READ_WRITE_STATUS_DELAY);
3608c2ecf20Sopenharmony_ci
3618c2ecf20Sopenharmony_ci		ret = usb_control_msg_recv(usbdev, 0, 0x67,
3628c2ecf20Sopenharmony_ci					   USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
3638c2ecf20Sopenharmony_ci					   0x0012, 0x0000, &len, 1,
3648c2ecf20Sopenharmony_ci					   LINE6_TIMEOUT, GFP_KERNEL);
3658c2ecf20Sopenharmony_ci		if (ret) {
3668c2ecf20Sopenharmony_ci			dev_err(line6->ifcdev,
3678c2ecf20Sopenharmony_ci				"receive length failed (error %d)\n", ret);
3688c2ecf20Sopenharmony_ci			goto exit;
3698c2ecf20Sopenharmony_ci		}
3708c2ecf20Sopenharmony_ci
3718c2ecf20Sopenharmony_ci		if (len != 0xff)
3728c2ecf20Sopenharmony_ci			break;
3738c2ecf20Sopenharmony_ci	}
3748c2ecf20Sopenharmony_ci
3758c2ecf20Sopenharmony_ci	ret = -EIO;
3768c2ecf20Sopenharmony_ci	if (len == 0xff) {
3778c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "read failed after %d retries\n",
3788c2ecf20Sopenharmony_ci			count);
3798c2ecf20Sopenharmony_ci		goto exit;
3808c2ecf20Sopenharmony_ci	} else if (len != datalen) {
3818c2ecf20Sopenharmony_ci		/* should be equal or something went wrong */
3828c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev,
3838c2ecf20Sopenharmony_ci			"length mismatch (expected %d, got %d)\n",
3848c2ecf20Sopenharmony_ci			(int)datalen, len);
3858c2ecf20Sopenharmony_ci		goto exit;
3868c2ecf20Sopenharmony_ci	}
3878c2ecf20Sopenharmony_ci
3888c2ecf20Sopenharmony_ci	/* receive the result: */
3898c2ecf20Sopenharmony_ci	ret = usb_control_msg_recv(usbdev, 0, 0x67,
3908c2ecf20Sopenharmony_ci				   USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
3918c2ecf20Sopenharmony_ci				   0x0013, 0x0000, data, datalen, LINE6_TIMEOUT,
3928c2ecf20Sopenharmony_ci				   GFP_KERNEL);
3938c2ecf20Sopenharmony_ci	if (ret)
3948c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "read failed (error %d)\n", ret);
3958c2ecf20Sopenharmony_ci
3968c2ecf20Sopenharmony_ciexit:
3978c2ecf20Sopenharmony_ci	return ret;
3988c2ecf20Sopenharmony_ci}
3998c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_read_data);
4008c2ecf20Sopenharmony_ci
4018c2ecf20Sopenharmony_ci/*
4028c2ecf20Sopenharmony_ci	Write data to device.
4038c2ecf20Sopenharmony_ci*/
4048c2ecf20Sopenharmony_ciint line6_write_data(struct usb_line6 *line6, unsigned address, void *data,
4058c2ecf20Sopenharmony_ci		     unsigned datalen)
4068c2ecf20Sopenharmony_ci{
4078c2ecf20Sopenharmony_ci	struct usb_device *usbdev = line6->usbdev;
4088c2ecf20Sopenharmony_ci	int ret;
4098c2ecf20Sopenharmony_ci	unsigned char *status;
4108c2ecf20Sopenharmony_ci	int count;
4118c2ecf20Sopenharmony_ci
4128c2ecf20Sopenharmony_ci	if (address > 0xffff || datalen > 0xffff)
4138c2ecf20Sopenharmony_ci		return -EINVAL;
4148c2ecf20Sopenharmony_ci
4158c2ecf20Sopenharmony_ci	status = kmalloc(1, GFP_KERNEL);
4168c2ecf20Sopenharmony_ci	if (!status)
4178c2ecf20Sopenharmony_ci		return -ENOMEM;
4188c2ecf20Sopenharmony_ci
4198c2ecf20Sopenharmony_ci	ret = usb_control_msg_send(usbdev, 0, 0x67,
4208c2ecf20Sopenharmony_ci				   USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
4218c2ecf20Sopenharmony_ci				   0x0022, address, data, datalen, LINE6_TIMEOUT,
4228c2ecf20Sopenharmony_ci				   GFP_KERNEL);
4238c2ecf20Sopenharmony_ci	if (ret) {
4248c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev,
4258c2ecf20Sopenharmony_ci			"write request failed (error %d)\n", ret);
4268c2ecf20Sopenharmony_ci		goto exit;
4278c2ecf20Sopenharmony_ci	}
4288c2ecf20Sopenharmony_ci
4298c2ecf20Sopenharmony_ci	for (count = 0; count < LINE6_READ_WRITE_MAX_RETRIES; count++) {
4308c2ecf20Sopenharmony_ci		mdelay(LINE6_READ_WRITE_STATUS_DELAY);
4318c2ecf20Sopenharmony_ci
4328c2ecf20Sopenharmony_ci		ret = usb_control_msg_recv(usbdev, 0, 0x67,
4338c2ecf20Sopenharmony_ci					   USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
4348c2ecf20Sopenharmony_ci					   0x0012, 0x0000, status, 1, LINE6_TIMEOUT,
4358c2ecf20Sopenharmony_ci					   GFP_KERNEL);
4368c2ecf20Sopenharmony_ci		if (ret) {
4378c2ecf20Sopenharmony_ci			dev_err(line6->ifcdev,
4388c2ecf20Sopenharmony_ci				"receiving status failed (error %d)\n", ret);
4398c2ecf20Sopenharmony_ci			goto exit;
4408c2ecf20Sopenharmony_ci		}
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_ci		if (*status != 0xff)
4438c2ecf20Sopenharmony_ci			break;
4448c2ecf20Sopenharmony_ci	}
4458c2ecf20Sopenharmony_ci
4468c2ecf20Sopenharmony_ci	if (*status == 0xff) {
4478c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "write failed after %d retries\n",
4488c2ecf20Sopenharmony_ci			count);
4498c2ecf20Sopenharmony_ci		ret = -EIO;
4508c2ecf20Sopenharmony_ci	} else if (*status != 0) {
4518c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "write failed (error %d)\n", ret);
4528c2ecf20Sopenharmony_ci		ret = -EIO;
4538c2ecf20Sopenharmony_ci	}
4548c2ecf20Sopenharmony_ciexit:
4558c2ecf20Sopenharmony_ci	kfree(status);
4568c2ecf20Sopenharmony_ci	return ret;
4578c2ecf20Sopenharmony_ci}
4588c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_write_data);
4598c2ecf20Sopenharmony_ci
4608c2ecf20Sopenharmony_ci/*
4618c2ecf20Sopenharmony_ci	Read Line 6 device serial number.
4628c2ecf20Sopenharmony_ci	(POD, TonePort, GuitarPort)
4638c2ecf20Sopenharmony_ci*/
4648c2ecf20Sopenharmony_ciint line6_read_serial_number(struct usb_line6 *line6, u32 *serial_number)
4658c2ecf20Sopenharmony_ci{
4668c2ecf20Sopenharmony_ci	return line6_read_data(line6, 0x80d0, serial_number,
4678c2ecf20Sopenharmony_ci			       sizeof(*serial_number));
4688c2ecf20Sopenharmony_ci}
4698c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_read_serial_number);
4708c2ecf20Sopenharmony_ci
4718c2ecf20Sopenharmony_ci/*
4728c2ecf20Sopenharmony_ci	Card destructor.
4738c2ecf20Sopenharmony_ci*/
4748c2ecf20Sopenharmony_cistatic void line6_destruct(struct snd_card *card)
4758c2ecf20Sopenharmony_ci{
4768c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = card->private_data;
4778c2ecf20Sopenharmony_ci	struct usb_device *usbdev = line6->usbdev;
4788c2ecf20Sopenharmony_ci
4798c2ecf20Sopenharmony_ci	/* Free buffer memory first. We cannot depend on the existence of private
4808c2ecf20Sopenharmony_ci	 * data from the (podhd) module, it may be gone already during this call
4818c2ecf20Sopenharmony_ci	 */
4828c2ecf20Sopenharmony_ci	kfree(line6->buffer_message);
4838c2ecf20Sopenharmony_ci
4848c2ecf20Sopenharmony_ci	kfree(line6->buffer_listen);
4858c2ecf20Sopenharmony_ci
4868c2ecf20Sopenharmony_ci	/* then free URBs: */
4878c2ecf20Sopenharmony_ci	usb_free_urb(line6->urb_listen);
4888c2ecf20Sopenharmony_ci	line6->urb_listen = NULL;
4898c2ecf20Sopenharmony_ci
4908c2ecf20Sopenharmony_ci	/* decrement reference counters: */
4918c2ecf20Sopenharmony_ci	usb_put_dev(usbdev);
4928c2ecf20Sopenharmony_ci}
4938c2ecf20Sopenharmony_ci
4948c2ecf20Sopenharmony_cistatic void line6_get_usb_properties(struct usb_line6 *line6)
4958c2ecf20Sopenharmony_ci{
4968c2ecf20Sopenharmony_ci	struct usb_device *usbdev = line6->usbdev;
4978c2ecf20Sopenharmony_ci	const struct line6_properties *properties = line6->properties;
4988c2ecf20Sopenharmony_ci	int pipe;
4998c2ecf20Sopenharmony_ci	struct usb_host_endpoint *ep = NULL;
5008c2ecf20Sopenharmony_ci
5018c2ecf20Sopenharmony_ci	if (properties->capabilities & LINE6_CAP_CONTROL) {
5028c2ecf20Sopenharmony_ci		if (properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
5038c2ecf20Sopenharmony_ci			pipe = usb_rcvintpipe(line6->usbdev,
5048c2ecf20Sopenharmony_ci				line6->properties->ep_ctrl_r);
5058c2ecf20Sopenharmony_ci		} else {
5068c2ecf20Sopenharmony_ci			pipe = usb_rcvbulkpipe(line6->usbdev,
5078c2ecf20Sopenharmony_ci				line6->properties->ep_ctrl_r);
5088c2ecf20Sopenharmony_ci		}
5098c2ecf20Sopenharmony_ci		ep = usbdev->ep_in[usb_pipeendpoint(pipe)];
5108c2ecf20Sopenharmony_ci	}
5118c2ecf20Sopenharmony_ci
5128c2ecf20Sopenharmony_ci	/* Control data transfer properties */
5138c2ecf20Sopenharmony_ci	if (ep) {
5148c2ecf20Sopenharmony_ci		line6->interval = ep->desc.bInterval;
5158c2ecf20Sopenharmony_ci		line6->max_packet_size = le16_to_cpu(ep->desc.wMaxPacketSize);
5168c2ecf20Sopenharmony_ci	} else {
5178c2ecf20Sopenharmony_ci		if (properties->capabilities & LINE6_CAP_CONTROL) {
5188c2ecf20Sopenharmony_ci			dev_err(line6->ifcdev,
5198c2ecf20Sopenharmony_ci				"endpoint not available, using fallback values");
5208c2ecf20Sopenharmony_ci		}
5218c2ecf20Sopenharmony_ci		line6->interval = LINE6_FALLBACK_INTERVAL;
5228c2ecf20Sopenharmony_ci		line6->max_packet_size = LINE6_FALLBACK_MAXPACKETSIZE;
5238c2ecf20Sopenharmony_ci	}
5248c2ecf20Sopenharmony_ci
5258c2ecf20Sopenharmony_ci	/* Isochronous transfer properties */
5268c2ecf20Sopenharmony_ci	if (usbdev->speed == USB_SPEED_LOW) {
5278c2ecf20Sopenharmony_ci		line6->intervals_per_second = USB_LOW_INTERVALS_PER_SECOND;
5288c2ecf20Sopenharmony_ci		line6->iso_buffers = USB_LOW_ISO_BUFFERS;
5298c2ecf20Sopenharmony_ci	} else {
5308c2ecf20Sopenharmony_ci		line6->intervals_per_second = USB_HIGH_INTERVALS_PER_SECOND;
5318c2ecf20Sopenharmony_ci		line6->iso_buffers = USB_HIGH_ISO_BUFFERS;
5328c2ecf20Sopenharmony_ci	}
5338c2ecf20Sopenharmony_ci}
5348c2ecf20Sopenharmony_ci
5358c2ecf20Sopenharmony_ci/* Enable buffering of incoming messages, flush the buffer */
5368c2ecf20Sopenharmony_cistatic int line6_hwdep_open(struct snd_hwdep *hw, struct file *file)
5378c2ecf20Sopenharmony_ci{
5388c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = hw->private_data;
5398c2ecf20Sopenharmony_ci
5408c2ecf20Sopenharmony_ci	/* NOTE: hwdep layer provides atomicity here */
5418c2ecf20Sopenharmony_ci
5428c2ecf20Sopenharmony_ci	line6->messages.active = 1;
5438c2ecf20Sopenharmony_ci	line6->messages.nonblock = file->f_flags & O_NONBLOCK ? 1 : 0;
5448c2ecf20Sopenharmony_ci
5458c2ecf20Sopenharmony_ci	return 0;
5468c2ecf20Sopenharmony_ci}
5478c2ecf20Sopenharmony_ci
5488c2ecf20Sopenharmony_ci/* Stop buffering */
5498c2ecf20Sopenharmony_cistatic int line6_hwdep_release(struct snd_hwdep *hw, struct file *file)
5508c2ecf20Sopenharmony_ci{
5518c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = hw->private_data;
5528c2ecf20Sopenharmony_ci
5538c2ecf20Sopenharmony_ci	line6->messages.active = 0;
5548c2ecf20Sopenharmony_ci
5558c2ecf20Sopenharmony_ci	return 0;
5568c2ecf20Sopenharmony_ci}
5578c2ecf20Sopenharmony_ci
5588c2ecf20Sopenharmony_ci/* Read from circular buffer, return to user */
5598c2ecf20Sopenharmony_cistatic long
5608c2ecf20Sopenharmony_ciline6_hwdep_read(struct snd_hwdep *hwdep, char __user *buf, long count,
5618c2ecf20Sopenharmony_ci					loff_t *offset)
5628c2ecf20Sopenharmony_ci{
5638c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = hwdep->private_data;
5648c2ecf20Sopenharmony_ci	long rv = 0;
5658c2ecf20Sopenharmony_ci	unsigned int out_count;
5668c2ecf20Sopenharmony_ci
5678c2ecf20Sopenharmony_ci	if (mutex_lock_interruptible(&line6->messages.read_lock))
5688c2ecf20Sopenharmony_ci		return -ERESTARTSYS;
5698c2ecf20Sopenharmony_ci
5708c2ecf20Sopenharmony_ci	while (kfifo_len(&line6->messages.fifo) == 0) {
5718c2ecf20Sopenharmony_ci		mutex_unlock(&line6->messages.read_lock);
5728c2ecf20Sopenharmony_ci
5738c2ecf20Sopenharmony_ci		if (line6->messages.nonblock)
5748c2ecf20Sopenharmony_ci			return -EAGAIN;
5758c2ecf20Sopenharmony_ci
5768c2ecf20Sopenharmony_ci		rv = wait_event_interruptible(
5778c2ecf20Sopenharmony_ci			line6->messages.wait_queue,
5788c2ecf20Sopenharmony_ci			kfifo_len(&line6->messages.fifo) != 0);
5798c2ecf20Sopenharmony_ci		if (rv < 0)
5808c2ecf20Sopenharmony_ci			return rv;
5818c2ecf20Sopenharmony_ci
5828c2ecf20Sopenharmony_ci		if (mutex_lock_interruptible(&line6->messages.read_lock))
5838c2ecf20Sopenharmony_ci			return -ERESTARTSYS;
5848c2ecf20Sopenharmony_ci	}
5858c2ecf20Sopenharmony_ci
5868c2ecf20Sopenharmony_ci	if (kfifo_peek_len(&line6->messages.fifo) > count) {
5878c2ecf20Sopenharmony_ci		/* Buffer too small; allow re-read of the current item... */
5888c2ecf20Sopenharmony_ci		rv = -EINVAL;
5898c2ecf20Sopenharmony_ci	} else {
5908c2ecf20Sopenharmony_ci		rv = kfifo_to_user(&line6->messages.fifo, buf, count, &out_count);
5918c2ecf20Sopenharmony_ci		if (rv == 0)
5928c2ecf20Sopenharmony_ci			rv = out_count;
5938c2ecf20Sopenharmony_ci	}
5948c2ecf20Sopenharmony_ci
5958c2ecf20Sopenharmony_ci	mutex_unlock(&line6->messages.read_lock);
5968c2ecf20Sopenharmony_ci	return rv;
5978c2ecf20Sopenharmony_ci}
5988c2ecf20Sopenharmony_ci
5998c2ecf20Sopenharmony_ci/* Write directly (no buffering) to device by user*/
6008c2ecf20Sopenharmony_cistatic long
6018c2ecf20Sopenharmony_ciline6_hwdep_write(struct snd_hwdep *hwdep, const char __user *data, long count,
6028c2ecf20Sopenharmony_ci					loff_t *offset)
6038c2ecf20Sopenharmony_ci{
6048c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = hwdep->private_data;
6058c2ecf20Sopenharmony_ci	int rv;
6068c2ecf20Sopenharmony_ci	char *data_copy;
6078c2ecf20Sopenharmony_ci
6088c2ecf20Sopenharmony_ci	if (count > line6->max_packet_size * LINE6_RAW_MESSAGES_MAXCOUNT) {
6098c2ecf20Sopenharmony_ci		/* This is an arbitrary limit - still better than nothing... */
6108c2ecf20Sopenharmony_ci		return -EINVAL;
6118c2ecf20Sopenharmony_ci	}
6128c2ecf20Sopenharmony_ci
6138c2ecf20Sopenharmony_ci	data_copy = memdup_user(data, count);
6148c2ecf20Sopenharmony_ci	if (IS_ERR(data_copy))
6158c2ecf20Sopenharmony_ci		return PTR_ERR(data_copy);
6168c2ecf20Sopenharmony_ci
6178c2ecf20Sopenharmony_ci	rv = line6_send_raw_message(line6, data_copy, count);
6188c2ecf20Sopenharmony_ci
6198c2ecf20Sopenharmony_ci	kfree(data_copy);
6208c2ecf20Sopenharmony_ci	return rv;
6218c2ecf20Sopenharmony_ci}
6228c2ecf20Sopenharmony_ci
6238c2ecf20Sopenharmony_cistatic __poll_t
6248c2ecf20Sopenharmony_ciline6_hwdep_poll(struct snd_hwdep *hwdep, struct file *file, poll_table *wait)
6258c2ecf20Sopenharmony_ci{
6268c2ecf20Sopenharmony_ci	__poll_t rv;
6278c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = hwdep->private_data;
6288c2ecf20Sopenharmony_ci
6298c2ecf20Sopenharmony_ci	poll_wait(file, &line6->messages.wait_queue, wait);
6308c2ecf20Sopenharmony_ci
6318c2ecf20Sopenharmony_ci	mutex_lock(&line6->messages.read_lock);
6328c2ecf20Sopenharmony_ci	rv = kfifo_len(&line6->messages.fifo) == 0 ? 0 : EPOLLIN | EPOLLRDNORM;
6338c2ecf20Sopenharmony_ci	mutex_unlock(&line6->messages.read_lock);
6348c2ecf20Sopenharmony_ci
6358c2ecf20Sopenharmony_ci	return rv;
6368c2ecf20Sopenharmony_ci}
6378c2ecf20Sopenharmony_ci
6388c2ecf20Sopenharmony_cistatic const struct snd_hwdep_ops hwdep_ops = {
6398c2ecf20Sopenharmony_ci	.open    = line6_hwdep_open,
6408c2ecf20Sopenharmony_ci	.release = line6_hwdep_release,
6418c2ecf20Sopenharmony_ci	.read    = line6_hwdep_read,
6428c2ecf20Sopenharmony_ci	.write   = line6_hwdep_write,
6438c2ecf20Sopenharmony_ci	.poll    = line6_hwdep_poll,
6448c2ecf20Sopenharmony_ci};
6458c2ecf20Sopenharmony_ci
6468c2ecf20Sopenharmony_ci/* Insert into circular buffer */
6478c2ecf20Sopenharmony_cistatic void line6_hwdep_push_message(struct usb_line6 *line6)
6488c2ecf20Sopenharmony_ci{
6498c2ecf20Sopenharmony_ci	if (!line6->messages.active)
6508c2ecf20Sopenharmony_ci		return;
6518c2ecf20Sopenharmony_ci
6528c2ecf20Sopenharmony_ci	if (kfifo_avail(&line6->messages.fifo) >= line6->message_length) {
6538c2ecf20Sopenharmony_ci		/* No race condition here, there's only one writer */
6548c2ecf20Sopenharmony_ci		kfifo_in(&line6->messages.fifo,
6558c2ecf20Sopenharmony_ci			line6->buffer_message, line6->message_length);
6568c2ecf20Sopenharmony_ci	} /* else TODO: signal overflow */
6578c2ecf20Sopenharmony_ci
6588c2ecf20Sopenharmony_ci	wake_up_interruptible(&line6->messages.wait_queue);
6598c2ecf20Sopenharmony_ci}
6608c2ecf20Sopenharmony_ci
6618c2ecf20Sopenharmony_cistatic int line6_hwdep_init(struct usb_line6 *line6)
6628c2ecf20Sopenharmony_ci{
6638c2ecf20Sopenharmony_ci	int err;
6648c2ecf20Sopenharmony_ci	struct snd_hwdep *hwdep;
6658c2ecf20Sopenharmony_ci
6668c2ecf20Sopenharmony_ci	/* TODO: usb_driver_claim_interface(); */
6678c2ecf20Sopenharmony_ci	line6->process_message = line6_hwdep_push_message;
6688c2ecf20Sopenharmony_ci	line6->messages.active = 0;
6698c2ecf20Sopenharmony_ci	init_waitqueue_head(&line6->messages.wait_queue);
6708c2ecf20Sopenharmony_ci	mutex_init(&line6->messages.read_lock);
6718c2ecf20Sopenharmony_ci	INIT_KFIFO(line6->messages.fifo);
6728c2ecf20Sopenharmony_ci
6738c2ecf20Sopenharmony_ci	err = snd_hwdep_new(line6->card, "config", 0, &hwdep);
6748c2ecf20Sopenharmony_ci	if (err < 0)
6758c2ecf20Sopenharmony_ci		goto end;
6768c2ecf20Sopenharmony_ci	strcpy(hwdep->name, "config");
6778c2ecf20Sopenharmony_ci	hwdep->iface = SNDRV_HWDEP_IFACE_LINE6;
6788c2ecf20Sopenharmony_ci	hwdep->ops = hwdep_ops;
6798c2ecf20Sopenharmony_ci	hwdep->private_data = line6;
6808c2ecf20Sopenharmony_ci	hwdep->exclusive = true;
6818c2ecf20Sopenharmony_ci
6828c2ecf20Sopenharmony_ciend:
6838c2ecf20Sopenharmony_ci	return err;
6848c2ecf20Sopenharmony_ci}
6858c2ecf20Sopenharmony_ci
6868c2ecf20Sopenharmony_cistatic int line6_init_cap_control(struct usb_line6 *line6)
6878c2ecf20Sopenharmony_ci{
6888c2ecf20Sopenharmony_ci	int ret;
6898c2ecf20Sopenharmony_ci
6908c2ecf20Sopenharmony_ci	/* initialize USB buffers: */
6918c2ecf20Sopenharmony_ci	line6->buffer_listen = kmalloc(LINE6_BUFSIZE_LISTEN, GFP_KERNEL);
6928c2ecf20Sopenharmony_ci	if (!line6->buffer_listen)
6938c2ecf20Sopenharmony_ci		return -ENOMEM;
6948c2ecf20Sopenharmony_ci
6958c2ecf20Sopenharmony_ci	line6->urb_listen = usb_alloc_urb(0, GFP_KERNEL);
6968c2ecf20Sopenharmony_ci	if (!line6->urb_listen)
6978c2ecf20Sopenharmony_ci		return -ENOMEM;
6988c2ecf20Sopenharmony_ci
6998c2ecf20Sopenharmony_ci	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
7008c2ecf20Sopenharmony_ci		line6->buffer_message = kmalloc(LINE6_MIDI_MESSAGE_MAXLEN, GFP_KERNEL);
7018c2ecf20Sopenharmony_ci		if (!line6->buffer_message)
7028c2ecf20Sopenharmony_ci			return -ENOMEM;
7038c2ecf20Sopenharmony_ci
7048c2ecf20Sopenharmony_ci		ret = line6_init_midi(line6);
7058c2ecf20Sopenharmony_ci		if (ret < 0)
7068c2ecf20Sopenharmony_ci			return ret;
7078c2ecf20Sopenharmony_ci	} else {
7088c2ecf20Sopenharmony_ci		ret = line6_hwdep_init(line6);
7098c2ecf20Sopenharmony_ci		if (ret < 0)
7108c2ecf20Sopenharmony_ci			return ret;
7118c2ecf20Sopenharmony_ci	}
7128c2ecf20Sopenharmony_ci
7138c2ecf20Sopenharmony_ci	ret = line6_start_listen(line6);
7148c2ecf20Sopenharmony_ci	if (ret < 0) {
7158c2ecf20Sopenharmony_ci		dev_err(line6->ifcdev, "cannot start listening: %d\n", ret);
7168c2ecf20Sopenharmony_ci		return ret;
7178c2ecf20Sopenharmony_ci	}
7188c2ecf20Sopenharmony_ci
7198c2ecf20Sopenharmony_ci	return 0;
7208c2ecf20Sopenharmony_ci}
7218c2ecf20Sopenharmony_ci
7228c2ecf20Sopenharmony_cistatic void line6_startup_work(struct work_struct *work)
7238c2ecf20Sopenharmony_ci{
7248c2ecf20Sopenharmony_ci	struct usb_line6 *line6 =
7258c2ecf20Sopenharmony_ci		container_of(work, struct usb_line6, startup_work.work);
7268c2ecf20Sopenharmony_ci
7278c2ecf20Sopenharmony_ci	if (line6->startup)
7288c2ecf20Sopenharmony_ci		line6->startup(line6);
7298c2ecf20Sopenharmony_ci}
7308c2ecf20Sopenharmony_ci
7318c2ecf20Sopenharmony_ci/*
7328c2ecf20Sopenharmony_ci	Probe USB device.
7338c2ecf20Sopenharmony_ci*/
7348c2ecf20Sopenharmony_ciint line6_probe(struct usb_interface *interface,
7358c2ecf20Sopenharmony_ci		const struct usb_device_id *id,
7368c2ecf20Sopenharmony_ci		const char *driver_name,
7378c2ecf20Sopenharmony_ci		const struct line6_properties *properties,
7388c2ecf20Sopenharmony_ci		int (*private_init)(struct usb_line6 *, const struct usb_device_id *id),
7398c2ecf20Sopenharmony_ci		size_t data_size)
7408c2ecf20Sopenharmony_ci{
7418c2ecf20Sopenharmony_ci	struct usb_device *usbdev = interface_to_usbdev(interface);
7428c2ecf20Sopenharmony_ci	struct snd_card *card;
7438c2ecf20Sopenharmony_ci	struct usb_line6 *line6;
7448c2ecf20Sopenharmony_ci	int interface_number;
7458c2ecf20Sopenharmony_ci	int ret;
7468c2ecf20Sopenharmony_ci
7478c2ecf20Sopenharmony_ci	if (WARN_ON(data_size < sizeof(*line6)))
7488c2ecf20Sopenharmony_ci		return -EINVAL;
7498c2ecf20Sopenharmony_ci
7508c2ecf20Sopenharmony_ci	/* we don't handle multiple configurations */
7518c2ecf20Sopenharmony_ci	if (usbdev->descriptor.bNumConfigurations != 1)
7528c2ecf20Sopenharmony_ci		return -ENODEV;
7538c2ecf20Sopenharmony_ci
7548c2ecf20Sopenharmony_ci	ret = snd_card_new(&interface->dev,
7558c2ecf20Sopenharmony_ci			   SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
7568c2ecf20Sopenharmony_ci			   THIS_MODULE, data_size, &card);
7578c2ecf20Sopenharmony_ci	if (ret < 0)
7588c2ecf20Sopenharmony_ci		return ret;
7598c2ecf20Sopenharmony_ci
7608c2ecf20Sopenharmony_ci	/* store basic data: */
7618c2ecf20Sopenharmony_ci	line6 = card->private_data;
7628c2ecf20Sopenharmony_ci	line6->card = card;
7638c2ecf20Sopenharmony_ci	line6->properties = properties;
7648c2ecf20Sopenharmony_ci	line6->usbdev = usbdev;
7658c2ecf20Sopenharmony_ci	line6->ifcdev = &interface->dev;
7668c2ecf20Sopenharmony_ci	INIT_DELAYED_WORK(&line6->startup_work, line6_startup_work);
7678c2ecf20Sopenharmony_ci
7688c2ecf20Sopenharmony_ci	strcpy(card->id, properties->id);
7698c2ecf20Sopenharmony_ci	strcpy(card->driver, driver_name);
7708c2ecf20Sopenharmony_ci	strcpy(card->shortname, properties->name);
7718c2ecf20Sopenharmony_ci	sprintf(card->longname, "Line 6 %s at USB %s", properties->name,
7728c2ecf20Sopenharmony_ci		dev_name(line6->ifcdev));
7738c2ecf20Sopenharmony_ci	card->private_free = line6_destruct;
7748c2ecf20Sopenharmony_ci
7758c2ecf20Sopenharmony_ci	usb_set_intfdata(interface, line6);
7768c2ecf20Sopenharmony_ci
7778c2ecf20Sopenharmony_ci	/* increment reference counters: */
7788c2ecf20Sopenharmony_ci	usb_get_dev(usbdev);
7798c2ecf20Sopenharmony_ci
7808c2ecf20Sopenharmony_ci	/* initialize device info: */
7818c2ecf20Sopenharmony_ci	dev_info(&interface->dev, "Line 6 %s found\n", properties->name);
7828c2ecf20Sopenharmony_ci
7838c2ecf20Sopenharmony_ci	/* query interface number */
7848c2ecf20Sopenharmony_ci	interface_number = interface->cur_altsetting->desc.bInterfaceNumber;
7858c2ecf20Sopenharmony_ci
7868c2ecf20Sopenharmony_ci	/* TODO reserves the bus bandwidth even without actual transfer */
7878c2ecf20Sopenharmony_ci	ret = usb_set_interface(usbdev, interface_number,
7888c2ecf20Sopenharmony_ci				properties->altsetting);
7898c2ecf20Sopenharmony_ci	if (ret < 0) {
7908c2ecf20Sopenharmony_ci		dev_err(&interface->dev, "set_interface failed\n");
7918c2ecf20Sopenharmony_ci		goto error;
7928c2ecf20Sopenharmony_ci	}
7938c2ecf20Sopenharmony_ci
7948c2ecf20Sopenharmony_ci	line6_get_usb_properties(line6);
7958c2ecf20Sopenharmony_ci
7968c2ecf20Sopenharmony_ci	if (properties->capabilities & LINE6_CAP_CONTROL) {
7978c2ecf20Sopenharmony_ci		ret = line6_init_cap_control(line6);
7988c2ecf20Sopenharmony_ci		if (ret < 0)
7998c2ecf20Sopenharmony_ci			goto error;
8008c2ecf20Sopenharmony_ci	}
8018c2ecf20Sopenharmony_ci
8028c2ecf20Sopenharmony_ci	/* initialize device data based on device: */
8038c2ecf20Sopenharmony_ci	ret = private_init(line6, id);
8048c2ecf20Sopenharmony_ci	if (ret < 0)
8058c2ecf20Sopenharmony_ci		goto error;
8068c2ecf20Sopenharmony_ci
8078c2ecf20Sopenharmony_ci	/* creation of additional special files should go here */
8088c2ecf20Sopenharmony_ci
8098c2ecf20Sopenharmony_ci	dev_info(&interface->dev, "Line 6 %s now attached\n",
8108c2ecf20Sopenharmony_ci		 properties->name);
8118c2ecf20Sopenharmony_ci
8128c2ecf20Sopenharmony_ci	return 0;
8138c2ecf20Sopenharmony_ci
8148c2ecf20Sopenharmony_ci error:
8158c2ecf20Sopenharmony_ci	/* we can call disconnect callback here because no close-sync is
8168c2ecf20Sopenharmony_ci	 * needed yet at this point
8178c2ecf20Sopenharmony_ci	 */
8188c2ecf20Sopenharmony_ci	line6_disconnect(interface);
8198c2ecf20Sopenharmony_ci	return ret;
8208c2ecf20Sopenharmony_ci}
8218c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_probe);
8228c2ecf20Sopenharmony_ci
8238c2ecf20Sopenharmony_ci/*
8248c2ecf20Sopenharmony_ci	Line 6 device disconnected.
8258c2ecf20Sopenharmony_ci*/
8268c2ecf20Sopenharmony_civoid line6_disconnect(struct usb_interface *interface)
8278c2ecf20Sopenharmony_ci{
8288c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = usb_get_intfdata(interface);
8298c2ecf20Sopenharmony_ci	struct usb_device *usbdev = interface_to_usbdev(interface);
8308c2ecf20Sopenharmony_ci
8318c2ecf20Sopenharmony_ci	if (!line6)
8328c2ecf20Sopenharmony_ci		return;
8338c2ecf20Sopenharmony_ci
8348c2ecf20Sopenharmony_ci	if (WARN_ON(usbdev != line6->usbdev))
8358c2ecf20Sopenharmony_ci		return;
8368c2ecf20Sopenharmony_ci
8378c2ecf20Sopenharmony_ci	cancel_delayed_work_sync(&line6->startup_work);
8388c2ecf20Sopenharmony_ci
8398c2ecf20Sopenharmony_ci	if (line6->urb_listen != NULL)
8408c2ecf20Sopenharmony_ci		line6_stop_listen(line6);
8418c2ecf20Sopenharmony_ci
8428c2ecf20Sopenharmony_ci	snd_card_disconnect(line6->card);
8438c2ecf20Sopenharmony_ci	if (line6->line6pcm)
8448c2ecf20Sopenharmony_ci		line6_pcm_disconnect(line6->line6pcm);
8458c2ecf20Sopenharmony_ci	if (line6->disconnect)
8468c2ecf20Sopenharmony_ci		line6->disconnect(line6);
8478c2ecf20Sopenharmony_ci
8488c2ecf20Sopenharmony_ci	dev_info(&interface->dev, "Line 6 %s now disconnected\n",
8498c2ecf20Sopenharmony_ci		 line6->properties->name);
8508c2ecf20Sopenharmony_ci
8518c2ecf20Sopenharmony_ci	/* make sure the device isn't destructed twice: */
8528c2ecf20Sopenharmony_ci	usb_set_intfdata(interface, NULL);
8538c2ecf20Sopenharmony_ci
8548c2ecf20Sopenharmony_ci	snd_card_free_when_closed(line6->card);
8558c2ecf20Sopenharmony_ci}
8568c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_disconnect);
8578c2ecf20Sopenharmony_ci
8588c2ecf20Sopenharmony_ci#ifdef CONFIG_PM
8598c2ecf20Sopenharmony_ci
8608c2ecf20Sopenharmony_ci/*
8618c2ecf20Sopenharmony_ci	Suspend Line 6 device.
8628c2ecf20Sopenharmony_ci*/
8638c2ecf20Sopenharmony_ciint line6_suspend(struct usb_interface *interface, pm_message_t message)
8648c2ecf20Sopenharmony_ci{
8658c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = usb_get_intfdata(interface);
8668c2ecf20Sopenharmony_ci	struct snd_line6_pcm *line6pcm = line6->line6pcm;
8678c2ecf20Sopenharmony_ci
8688c2ecf20Sopenharmony_ci	snd_power_change_state(line6->card, SNDRV_CTL_POWER_D3hot);
8698c2ecf20Sopenharmony_ci
8708c2ecf20Sopenharmony_ci	if (line6->properties->capabilities & LINE6_CAP_CONTROL)
8718c2ecf20Sopenharmony_ci		line6_stop_listen(line6);
8728c2ecf20Sopenharmony_ci
8738c2ecf20Sopenharmony_ci	if (line6pcm != NULL)
8748c2ecf20Sopenharmony_ci		line6pcm->flags = 0;
8758c2ecf20Sopenharmony_ci
8768c2ecf20Sopenharmony_ci	return 0;
8778c2ecf20Sopenharmony_ci}
8788c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_suspend);
8798c2ecf20Sopenharmony_ci
8808c2ecf20Sopenharmony_ci/*
8818c2ecf20Sopenharmony_ci	Resume Line 6 device.
8828c2ecf20Sopenharmony_ci*/
8838c2ecf20Sopenharmony_ciint line6_resume(struct usb_interface *interface)
8848c2ecf20Sopenharmony_ci{
8858c2ecf20Sopenharmony_ci	struct usb_line6 *line6 = usb_get_intfdata(interface);
8868c2ecf20Sopenharmony_ci
8878c2ecf20Sopenharmony_ci	if (line6->properties->capabilities & LINE6_CAP_CONTROL)
8888c2ecf20Sopenharmony_ci		line6_start_listen(line6);
8898c2ecf20Sopenharmony_ci
8908c2ecf20Sopenharmony_ci	snd_power_change_state(line6->card, SNDRV_CTL_POWER_D0);
8918c2ecf20Sopenharmony_ci	return 0;
8928c2ecf20Sopenharmony_ci}
8938c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(line6_resume);
8948c2ecf20Sopenharmony_ci
8958c2ecf20Sopenharmony_ci#endif /* CONFIG_PM */
8968c2ecf20Sopenharmony_ci
8978c2ecf20Sopenharmony_ciMODULE_AUTHOR(DRIVER_AUTHOR);
8988c2ecf20Sopenharmony_ciMODULE_DESCRIPTION(DRIVER_DESC);
8998c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
9008c2ecf20Sopenharmony_ci
901