| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864 | 
							- /*
 
-  * Line 6 Linux USB driver
 
-  *
 
-  * Copyright (C) 2004-2010 Markus Grabner (grabner@icg.tugraz.at)
 
-  *
 
-  *	This program is free software; you can redistribute it and/or
 
-  *	modify it under the terms of the GNU General Public License as
 
-  *	published by the Free Software Foundation, version 2.
 
-  *
 
-  */
 
- #include <linux/kernel.h>
 
- #include <linux/module.h>
 
- #include <linux/export.h>
 
- #include <linux/slab.h>
 
- #include <linux/usb.h>
 
- #include <sound/core.h>
 
- #include <sound/initval.h>
 
- #include <sound/hwdep.h>
 
- #include "capture.h"
 
- #include "driver.h"
 
- #include "midi.h"
 
- #include "playback.h"
 
- #define DRIVER_AUTHOR  "Markus Grabner <grabner@icg.tugraz.at>"
 
- #define DRIVER_DESC    "Line 6 USB Driver"
 
- /*
 
- 	This is Line 6's MIDI manufacturer ID.
 
- */
 
- const unsigned char line6_midi_id[3] = {
 
- 	0x00, 0x01, 0x0c
 
- };
 
- EXPORT_SYMBOL_GPL(line6_midi_id);
 
- /*
 
- 	Code to request version of POD, Variax interface
 
- 	(and maybe other devices).
 
- */
 
- static const char line6_request_version[] = {
 
- 	0xf0, 0x7e, 0x7f, 0x06, 0x01, 0xf7
 
- };
 
- /*
 
- 	 Class for asynchronous messages.
 
- */
 
- struct message {
 
- 	struct usb_line6 *line6;
 
- 	const char *buffer;
 
- 	int size;
 
- 	int done;
 
- };
 
- /*
 
- 	Forward declarations.
 
- */
 
- static void line6_data_received(struct urb *urb);
 
- static int line6_send_raw_message_async_part(struct message *msg,
 
- 					     struct urb *urb);
 
- /*
 
- 	Start to listen on endpoint.
 
- */
 
- static int line6_start_listen(struct usb_line6 *line6)
 
- {
 
- 	int err;
 
- 	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
 
- 		usb_fill_int_urb(line6->urb_listen, line6->usbdev,
 
- 			usb_rcvintpipe(line6->usbdev, line6->properties->ep_ctrl_r),
 
- 			line6->buffer_listen, LINE6_BUFSIZE_LISTEN,
 
- 			line6_data_received, line6, line6->interval);
 
- 	} else {
 
- 		usb_fill_bulk_urb(line6->urb_listen, line6->usbdev,
 
- 			usb_rcvbulkpipe(line6->usbdev, line6->properties->ep_ctrl_r),
 
- 			line6->buffer_listen, LINE6_BUFSIZE_LISTEN,
 
- 			line6_data_received, line6);
 
- 	}
 
- 	line6->urb_listen->actual_length = 0;
 
- 	err = usb_submit_urb(line6->urb_listen, GFP_ATOMIC);
 
- 	return err;
 
- }
 
- /*
 
- 	Stop listening on endpoint.
 
- */
 
- static void line6_stop_listen(struct usb_line6 *line6)
 
- {
 
- 	usb_kill_urb(line6->urb_listen);
 
- }
 
- /*
 
- 	Send raw message in pieces of wMaxPacketSize bytes.
 
- */
 
- static int line6_send_raw_message(struct usb_line6 *line6, const char *buffer,
 
- 				  int size)
 
- {
 
- 	int i, done = 0;
 
- 	const struct line6_properties *properties = line6->properties;
 
- 	for (i = 0; i < size; i += line6->max_packet_size) {
 
- 		int partial;
 
- 		const char *frag_buf = buffer + i;
 
- 		int frag_size = min(line6->max_packet_size, size - i);
 
- 		int retval;
 
- 		if (properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
 
- 			retval = usb_interrupt_msg(line6->usbdev,
 
- 						usb_sndintpipe(line6->usbdev, properties->ep_ctrl_w),
 
- 						(char *)frag_buf, frag_size,
 
- 						&partial, LINE6_TIMEOUT * HZ);
 
- 		} else {
 
- 			retval = usb_bulk_msg(line6->usbdev,
 
- 						usb_sndbulkpipe(line6->usbdev, properties->ep_ctrl_w),
 
- 						(char *)frag_buf, frag_size,
 
- 						&partial, LINE6_TIMEOUT * HZ);
 
- 		}
 
- 		if (retval) {
 
- 			dev_err(line6->ifcdev,
 
- 				"usb_bulk_msg failed (%d)\n", retval);
 
- 			break;
 
- 		}
 
- 		done += frag_size;
 
- 	}
 
- 	return done;
 
- }
 
- /*
 
- 	Notification of completion of asynchronous request transmission.
 
- */
 
- static void line6_async_request_sent(struct urb *urb)
 
- {
 
- 	struct message *msg = (struct message *)urb->context;
 
- 	if (msg->done >= msg->size) {
 
- 		usb_free_urb(urb);
 
- 		kfree(msg);
 
- 	} else
 
- 		line6_send_raw_message_async_part(msg, urb);
 
- }
 
- /*
 
- 	Asynchronously send part of a raw message.
 
- */
 
- static int line6_send_raw_message_async_part(struct message *msg,
 
- 					     struct urb *urb)
 
- {
 
- 	int retval;
 
- 	struct usb_line6 *line6 = msg->line6;
 
- 	int done = msg->done;
 
- 	int bytes = min(msg->size - done, line6->max_packet_size);
 
- 	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
 
- 		usb_fill_int_urb(urb, line6->usbdev,
 
- 			usb_sndintpipe(line6->usbdev, line6->properties->ep_ctrl_w),
 
- 			(char *)msg->buffer + done, bytes,
 
- 			line6_async_request_sent, msg, line6->interval);
 
- 	} else {
 
- 		usb_fill_bulk_urb(urb, line6->usbdev,
 
- 			usb_sndbulkpipe(line6->usbdev, line6->properties->ep_ctrl_w),
 
- 			(char *)msg->buffer + done, bytes,
 
- 			line6_async_request_sent, msg);
 
- 	}
 
- 	msg->done += bytes;
 
- 	retval = usb_submit_urb(urb, GFP_ATOMIC);
 
- 	if (retval < 0) {
 
- 		dev_err(line6->ifcdev, "%s: usb_submit_urb failed (%d)\n",
 
- 			__func__, retval);
 
- 		usb_free_urb(urb);
 
- 		kfree(msg);
 
- 		return retval;
 
- 	}
 
- 	return 0;
 
- }
 
- /*
 
- 	Setup and start timer.
 
- */
 
- void line6_start_timer(struct timer_list *timer, unsigned long msecs,
 
- 		       void (*function)(unsigned long), unsigned long data)
 
- {
 
- 	setup_timer(timer, function, data);
 
- 	mod_timer(timer, jiffies + msecs_to_jiffies(msecs));
 
- }
 
- EXPORT_SYMBOL_GPL(line6_start_timer);
 
- /*
 
- 	Asynchronously send raw message.
 
- */
 
- int line6_send_raw_message_async(struct usb_line6 *line6, const char *buffer,
 
- 				 int size)
 
- {
 
- 	struct message *msg;
 
- 	struct urb *urb;
 
- 	/* create message: */
 
- 	msg = kmalloc(sizeof(struct message), GFP_ATOMIC);
 
- 	if (msg == NULL)
 
- 		return -ENOMEM;
 
- 	/* create URB: */
 
- 	urb = usb_alloc_urb(0, GFP_ATOMIC);
 
- 	if (urb == NULL) {
 
- 		kfree(msg);
 
- 		return -ENOMEM;
 
- 	}
 
- 	/* set message data: */
 
- 	msg->line6 = line6;
 
- 	msg->buffer = buffer;
 
- 	msg->size = size;
 
- 	msg->done = 0;
 
- 	/* start sending: */
 
- 	return line6_send_raw_message_async_part(msg, urb);
 
- }
 
- EXPORT_SYMBOL_GPL(line6_send_raw_message_async);
 
- /*
 
- 	Send asynchronous device version request.
 
- */
 
- int line6_version_request_async(struct usb_line6 *line6)
 
- {
 
- 	char *buffer;
 
- 	int retval;
 
- 	buffer = kmemdup(line6_request_version,
 
- 			sizeof(line6_request_version), GFP_ATOMIC);
 
- 	if (buffer == NULL)
 
- 		return -ENOMEM;
 
- 	retval = line6_send_raw_message_async(line6, buffer,
 
- 					      sizeof(line6_request_version));
 
- 	kfree(buffer);
 
- 	return retval;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_version_request_async);
 
- /*
 
- 	Send sysex message in pieces of wMaxPacketSize bytes.
 
- */
 
- int line6_send_sysex_message(struct usb_line6 *line6, const char *buffer,
 
- 			     int size)
 
- {
 
- 	return line6_send_raw_message(line6, buffer,
 
- 				      size + SYSEX_EXTRA_SIZE) -
 
- 	    SYSEX_EXTRA_SIZE;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_send_sysex_message);
 
- /*
 
- 	Allocate buffer for sysex message and prepare header.
 
- 	@param code sysex message code
 
- 	@param size number of bytes between code and sysex end
 
- */
 
- char *line6_alloc_sysex_buffer(struct usb_line6 *line6, int code1, int code2,
 
- 			       int size)
 
- {
 
- 	char *buffer = kmalloc(size + SYSEX_EXTRA_SIZE, GFP_ATOMIC);
 
- 	if (!buffer)
 
- 		return NULL;
 
- 	buffer[0] = LINE6_SYSEX_BEGIN;
 
- 	memcpy(buffer + 1, line6_midi_id, sizeof(line6_midi_id));
 
- 	buffer[sizeof(line6_midi_id) + 1] = code1;
 
- 	buffer[sizeof(line6_midi_id) + 2] = code2;
 
- 	buffer[sizeof(line6_midi_id) + 3 + size] = LINE6_SYSEX_END;
 
- 	return buffer;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_alloc_sysex_buffer);
 
- /*
 
- 	Notification of data received from the Line 6 device.
 
- */
 
- static void line6_data_received(struct urb *urb)
 
- {
 
- 	struct usb_line6 *line6 = (struct usb_line6 *)urb->context;
 
- 	struct midi_buffer *mb = &line6->line6midi->midibuf_in;
 
- 	int done;
 
- 	if (urb->status == -ESHUTDOWN)
 
- 		return;
 
- 	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
 
- 		done =
 
- 			line6_midibuf_write(mb, urb->transfer_buffer, urb->actual_length);
 
- 		if (done < urb->actual_length) {
 
- 			line6_midibuf_ignore(mb, done);
 
- 			dev_dbg(line6->ifcdev, "%d %d buffer overflow - message skipped\n",
 
- 				done, urb->actual_length);
 
- 		}
 
- 		for (;;) {
 
- 			done =
 
- 				line6_midibuf_read(mb, line6->buffer_message,
 
- 						LINE6_MIDI_MESSAGE_MAXLEN);
 
- 			if (done == 0)
 
- 				break;
 
- 			line6->message_length = done;
 
- 			line6_midi_receive(line6, line6->buffer_message, done);
 
- 			if (line6->process_message)
 
- 				line6->process_message(line6);
 
- 		}
 
- 	} else {
 
- 		line6->buffer_message = urb->transfer_buffer;
 
- 		line6->message_length = urb->actual_length;
 
- 		if (line6->process_message)
 
- 			line6->process_message(line6);
 
- 		line6->buffer_message = NULL;
 
- 	}
 
- 	line6_start_listen(line6);
 
- }
 
- #define LINE6_READ_WRITE_STATUS_DELAY 2  /* milliseconds */
 
- #define LINE6_READ_WRITE_MAX_RETRIES 50
 
- /*
 
- 	Read data from device.
 
- */
 
- int line6_read_data(struct usb_line6 *line6, unsigned address, void *data,
 
- 		    unsigned datalen)
 
- {
 
- 	struct usb_device *usbdev = line6->usbdev;
 
- 	int ret;
 
- 	unsigned char len;
 
- 	unsigned count;
 
- 	if (address > 0xffff || datalen > 0xff)
 
- 		return -EINVAL;
 
- 	/* query the serial number: */
 
- 	ret = usb_control_msg(usbdev, usb_sndctrlpipe(usbdev, 0), 0x67,
 
- 			      USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
 
- 			      (datalen << 8) | 0x21, address,
 
- 			      NULL, 0, LINE6_TIMEOUT * HZ);
 
- 	if (ret < 0) {
 
- 		dev_err(line6->ifcdev, "read request failed (error %d)\n", ret);
 
- 		return ret;
 
- 	}
 
- 	/* Wait for data length. We'll get 0xff until length arrives. */
 
- 	for (count = 0; count < LINE6_READ_WRITE_MAX_RETRIES; count++) {
 
- 		mdelay(LINE6_READ_WRITE_STATUS_DELAY);
 
- 		ret = usb_control_msg(usbdev, usb_rcvctrlpipe(usbdev, 0), 0x67,
 
- 				      USB_TYPE_VENDOR | USB_RECIP_DEVICE |
 
- 				      USB_DIR_IN,
 
- 				      0x0012, 0x0000, &len, 1,
 
- 				      LINE6_TIMEOUT * HZ);
 
- 		if (ret < 0) {
 
- 			dev_err(line6->ifcdev,
 
- 				"receive length failed (error %d)\n", ret);
 
- 			return ret;
 
- 		}
 
- 		if (len != 0xff)
 
- 			break;
 
- 	}
 
- 	if (len == 0xff) {
 
- 		dev_err(line6->ifcdev, "read failed after %d retries\n",
 
- 			count);
 
- 		return -EIO;
 
- 	} else if (len != datalen) {
 
- 		/* should be equal or something went wrong */
 
- 		dev_err(line6->ifcdev,
 
- 			"length mismatch (expected %d, got %d)\n",
 
- 			(int)datalen, (int)len);
 
- 		return -EIO;
 
- 	}
 
- 	/* receive the result: */
 
- 	ret = usb_control_msg(usbdev, usb_rcvctrlpipe(usbdev, 0), 0x67,
 
- 			      USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN,
 
- 			      0x0013, 0x0000, data, datalen,
 
- 			      LINE6_TIMEOUT * HZ);
 
- 	if (ret < 0) {
 
- 		dev_err(line6->ifcdev, "read failed (error %d)\n", ret);
 
- 		return ret;
 
- 	}
 
- 	return 0;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_read_data);
 
- /*
 
- 	Write data to device.
 
- */
 
- int line6_write_data(struct usb_line6 *line6, unsigned address, void *data,
 
- 		     unsigned datalen)
 
- {
 
- 	struct usb_device *usbdev = line6->usbdev;
 
- 	int ret;
 
- 	unsigned char status;
 
- 	int count;
 
- 	if (address > 0xffff || datalen > 0xffff)
 
- 		return -EINVAL;
 
- 	ret = usb_control_msg(usbdev, usb_sndctrlpipe(usbdev, 0), 0x67,
 
- 			      USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT,
 
- 			      0x0022, address, data, datalen,
 
- 			      LINE6_TIMEOUT * HZ);
 
- 	if (ret < 0) {
 
- 		dev_err(line6->ifcdev,
 
- 			"write request failed (error %d)\n", ret);
 
- 		return ret;
 
- 	}
 
- 	for (count = 0; count < LINE6_READ_WRITE_MAX_RETRIES; count++) {
 
- 		mdelay(LINE6_READ_WRITE_STATUS_DELAY);
 
- 		ret = usb_control_msg(usbdev, usb_rcvctrlpipe(usbdev, 0),
 
- 				      0x67,
 
- 				      USB_TYPE_VENDOR | USB_RECIP_DEVICE |
 
- 				      USB_DIR_IN,
 
- 				      0x0012, 0x0000,
 
- 				      &status, 1, LINE6_TIMEOUT * HZ);
 
- 		if (ret < 0) {
 
- 			dev_err(line6->ifcdev,
 
- 				"receiving status failed (error %d)\n", ret);
 
- 			return ret;
 
- 		}
 
- 		if (status != 0xff)
 
- 			break;
 
- 	}
 
- 	if (status == 0xff) {
 
- 		dev_err(line6->ifcdev, "write failed after %d retries\n",
 
- 			count);
 
- 		return -EIO;
 
- 	} else if (status != 0) {
 
- 		dev_err(line6->ifcdev, "write failed (error %d)\n", ret);
 
- 		return -EIO;
 
- 	}
 
- 	return 0;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_write_data);
 
- /*
 
- 	Read Line 6 device serial number.
 
- 	(POD, TonePort, GuitarPort)
 
- */
 
- int line6_read_serial_number(struct usb_line6 *line6, u32 *serial_number)
 
- {
 
- 	return line6_read_data(line6, 0x80d0, serial_number,
 
- 			       sizeof(*serial_number));
 
- }
 
- EXPORT_SYMBOL_GPL(line6_read_serial_number);
 
- /*
 
- 	Card destructor.
 
- */
 
- static void line6_destruct(struct snd_card *card)
 
- {
 
- 	struct usb_line6 *line6 = card->private_data;
 
- 	struct usb_device *usbdev = line6->usbdev;
 
- 	/* Free buffer memory first. We cannot depend on the existence of private
 
- 	 * data from the (podhd) module, it may be gone already during this call
 
- 	 */
 
- 	kfree(line6->buffer_message);
 
- 	kfree(line6->buffer_listen);
 
- 	/* then free URBs: */
 
- 	usb_free_urb(line6->urb_listen);
 
- 	line6->urb_listen = NULL;
 
- 	/* decrement reference counters: */
 
- 	usb_put_dev(usbdev);
 
- }
 
- /* get data from endpoint descriptor (see usb_maxpacket): */
 
- static void line6_get_interval(struct usb_line6 *line6)
 
- {
 
- 	struct usb_device *usbdev = line6->usbdev;
 
- 	const struct line6_properties *properties = line6->properties;
 
- 	int pipe;
 
- 	struct usb_host_endpoint *ep;
 
- 	if (properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
 
- 		pipe =
 
- 			usb_rcvintpipe(line6->usbdev, line6->properties->ep_ctrl_r);
 
- 	} else {
 
- 		pipe =
 
- 			usb_rcvbulkpipe(line6->usbdev, line6->properties->ep_ctrl_r);
 
- 	}
 
- 	ep = usbdev->ep_in[usb_pipeendpoint(pipe)];
 
- 	if (ep) {
 
- 		line6->interval = ep->desc.bInterval;
 
- 		if (usbdev->speed == USB_SPEED_LOW) {
 
- 			line6->intervals_per_second = USB_LOW_INTERVALS_PER_SECOND;
 
- 			line6->iso_buffers = USB_LOW_ISO_BUFFERS;
 
- 		} else {
 
- 			line6->intervals_per_second = USB_HIGH_INTERVALS_PER_SECOND;
 
- 			line6->iso_buffers = USB_HIGH_ISO_BUFFERS;
 
- 		}
 
- 		line6->max_packet_size = le16_to_cpu(ep->desc.wMaxPacketSize);
 
- 	} else {
 
- 		dev_err(line6->ifcdev,
 
- 			"endpoint not available, using fallback values");
 
- 		line6->interval = LINE6_FALLBACK_INTERVAL;
 
- 		line6->max_packet_size = LINE6_FALLBACK_MAXPACKETSIZE;
 
- 	}
 
- }
 
- /* Enable buffering of incoming messages, flush the buffer */
 
- static int line6_hwdep_open(struct snd_hwdep *hw, struct file *file)
 
- {
 
- 	struct usb_line6 *line6 = hw->private_data;
 
- 	/* NOTE: hwdep layer provides atomicity here */
 
- 	line6->messages.active = 1;
 
- 	return 0;
 
- }
 
- /* Stop buffering */
 
- static int line6_hwdep_release(struct snd_hwdep *hw, struct file *file)
 
- {
 
- 	struct usb_line6 *line6 = hw->private_data;
 
- 	line6->messages.active = 0;
 
- 	return 0;
 
- }
 
- /* Read from circular buffer, return to user */
 
- static long
 
- line6_hwdep_read(struct snd_hwdep *hwdep, char __user *buf, long count,
 
- 					loff_t *offset)
 
- {
 
- 	struct usb_line6 *line6 = hwdep->private_data;
 
- 	long rv = 0;
 
- 	unsigned int out_count;
 
- 	if (mutex_lock_interruptible(&line6->messages.read_lock))
 
- 		return -ERESTARTSYS;
 
- 	while (kfifo_len(&line6->messages.fifo) == 0) {
 
- 		mutex_unlock(&line6->messages.read_lock);
 
- 		rv = wait_event_interruptible(
 
- 			line6->messages.wait_queue,
 
- 			kfifo_len(&line6->messages.fifo) != 0);
 
- 		if (rv < 0)
 
- 			return rv;
 
- 		if (mutex_lock_interruptible(&line6->messages.read_lock))
 
- 			return -ERESTARTSYS;
 
- 	}
 
- 	if (kfifo_peek_len(&line6->messages.fifo) > count) {
 
- 		/* Buffer too small; allow re-read of the current item... */
 
- 		rv = -EINVAL;
 
- 	} else {
 
- 		rv = kfifo_to_user(&line6->messages.fifo, buf, count, &out_count);
 
- 		if (rv == 0)
 
- 			rv = out_count;
 
- 	}
 
- 	mutex_unlock(&line6->messages.read_lock);
 
- 	return rv;
 
- }
 
- /* Write directly (no buffering) to device by user*/
 
- static long
 
- line6_hwdep_write(struct snd_hwdep *hwdep, const char __user *data, long count,
 
- 					loff_t *offset)
 
- {
 
- 	struct usb_line6 *line6 = hwdep->private_data;
 
- 	int rv;
 
- 	char *data_copy;
 
- 	if (count > line6->max_packet_size * LINE6_RAW_MESSAGES_MAXCOUNT) {
 
- 		/* This is an arbitrary limit - still better than nothing... */
 
- 		return -EINVAL;
 
- 	}
 
- 	data_copy = memdup_user(data, count);
 
- 	if (IS_ERR(data_copy))
 
- 		return PTR_ERR(data_copy);
 
- 	rv = line6_send_raw_message(line6, data_copy, count);
 
- 	kfree(data_copy);
 
- 	return rv;
 
- }
 
- static const struct snd_hwdep_ops hwdep_ops = {
 
- 	.open    = line6_hwdep_open,
 
- 	.release = line6_hwdep_release,
 
- 	.read    = line6_hwdep_read,
 
- 	.write   = line6_hwdep_write,
 
- };
 
- /* Insert into circular buffer */
 
- static void line6_hwdep_push_message(struct usb_line6 *line6)
 
- {
 
- 	if (!line6->messages.active)
 
- 		return;
 
- 	if (kfifo_avail(&line6->messages.fifo) >= line6->message_length) {
 
- 		/* No race condition here, there's only one writer */
 
- 		kfifo_in(&line6->messages.fifo,
 
- 			line6->buffer_message, line6->message_length);
 
- 	} /* else TODO: signal overflow */
 
- 	wake_up_interruptible(&line6->messages.wait_queue);
 
- }
 
- static int line6_hwdep_init(struct usb_line6 *line6)
 
- {
 
- 	int err;
 
- 	struct snd_hwdep *hwdep;
 
- 	/* TODO: usb_driver_claim_interface(); */
 
- 	line6->process_message = line6_hwdep_push_message;
 
- 	line6->messages.active = 0;
 
- 	init_waitqueue_head(&line6->messages.wait_queue);
 
- 	mutex_init(&line6->messages.read_lock);
 
- 	INIT_KFIFO(line6->messages.fifo);
 
- 	err = snd_hwdep_new(line6->card, "config", 0, &hwdep);
 
- 	if (err < 0)
 
- 		goto end;
 
- 	strcpy(hwdep->name, "config");
 
- 	hwdep->iface = SNDRV_HWDEP_IFACE_LINE6;
 
- 	hwdep->ops = hwdep_ops;
 
- 	hwdep->private_data = line6;
 
- 	hwdep->exclusive = true;
 
- end:
 
- 	return err;
 
- }
 
- static int line6_init_cap_control(struct usb_line6 *line6)
 
- {
 
- 	int ret;
 
- 	/* initialize USB buffers: */
 
- 	line6->buffer_listen = kmalloc(LINE6_BUFSIZE_LISTEN, GFP_KERNEL);
 
- 	if (!line6->buffer_listen)
 
- 		return -ENOMEM;
 
- 	line6->urb_listen = usb_alloc_urb(0, GFP_KERNEL);
 
- 	if (!line6->urb_listen)
 
- 		return -ENOMEM;
 
- 	if (line6->properties->capabilities & LINE6_CAP_CONTROL_MIDI) {
 
- 		line6->buffer_message = kmalloc(LINE6_MIDI_MESSAGE_MAXLEN, GFP_KERNEL);
 
- 		if (!line6->buffer_message)
 
- 			return -ENOMEM;
 
- 	} else {
 
- 		ret = line6_hwdep_init(line6);
 
- 		if (ret < 0)
 
- 			return ret;
 
- 	}
 
- 	ret = line6_start_listen(line6);
 
- 	if (ret < 0) {
 
- 		dev_err(line6->ifcdev, "cannot start listening: %d\n", ret);
 
- 		return ret;
 
- 	}
 
- 	return 0;
 
- }
 
- /*
 
- 	Probe USB device.
 
- */
 
- int line6_probe(struct usb_interface *interface,
 
- 		const struct usb_device_id *id,
 
- 		const char *driver_name,
 
- 		const struct line6_properties *properties,
 
- 		int (*private_init)(struct usb_line6 *, const struct usb_device_id *id),
 
- 		size_t data_size)
 
- {
 
- 	struct usb_device *usbdev = interface_to_usbdev(interface);
 
- 	struct snd_card *card;
 
- 	struct usb_line6 *line6;
 
- 	int interface_number;
 
- 	int ret;
 
- 	if (WARN_ON(data_size < sizeof(*line6)))
 
- 		return -EINVAL;
 
- 	/* we don't handle multiple configurations */
 
- 	if (usbdev->descriptor.bNumConfigurations != 1)
 
- 		return -ENODEV;
 
- 	ret = snd_card_new(&interface->dev,
 
- 			   SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
 
- 			   THIS_MODULE, data_size, &card);
 
- 	if (ret < 0)
 
- 		return ret;
 
- 	/* store basic data: */
 
- 	line6 = card->private_data;
 
- 	line6->card = card;
 
- 	line6->properties = properties;
 
- 	line6->usbdev = usbdev;
 
- 	line6->ifcdev = &interface->dev;
 
- 	strcpy(card->id, properties->id);
 
- 	strcpy(card->driver, driver_name);
 
- 	strcpy(card->shortname, properties->name);
 
- 	sprintf(card->longname, "Line 6 %s at USB %s", properties->name,
 
- 		dev_name(line6->ifcdev));
 
- 	card->private_free = line6_destruct;
 
- 	usb_set_intfdata(interface, line6);
 
- 	/* increment reference counters: */
 
- 	usb_get_dev(usbdev);
 
- 	/* initialize device info: */
 
- 	dev_info(&interface->dev, "Line 6 %s found\n", properties->name);
 
- 	/* query interface number */
 
- 	interface_number = interface->cur_altsetting->desc.bInterfaceNumber;
 
- 	/* TODO reserves the bus bandwidth even without actual transfer */
 
- 	ret = usb_set_interface(usbdev, interface_number,
 
- 				properties->altsetting);
 
- 	if (ret < 0) {
 
- 		dev_err(&interface->dev, "set_interface failed\n");
 
- 		goto error;
 
- 	}
 
- 	line6_get_interval(line6);
 
- 	if (properties->capabilities & LINE6_CAP_CONTROL) {
 
- 		ret = line6_init_cap_control(line6);
 
- 		if (ret < 0)
 
- 			goto error;
 
- 	}
 
- 	/* initialize device data based on device: */
 
- 	ret = private_init(line6, id);
 
- 	if (ret < 0)
 
- 		goto error;
 
- 	/* creation of additional special files should go here */
 
- 	dev_info(&interface->dev, "Line 6 %s now attached\n",
 
- 		 properties->name);
 
- 	return 0;
 
-  error:
 
- 	/* we can call disconnect callback here because no close-sync is
 
- 	 * needed yet at this point
 
- 	 */
 
- 	line6_disconnect(interface);
 
- 	return ret;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_probe);
 
- /*
 
- 	Line 6 device disconnected.
 
- */
 
- void line6_disconnect(struct usb_interface *interface)
 
- {
 
- 	struct usb_line6 *line6 = usb_get_intfdata(interface);
 
- 	struct usb_device *usbdev = interface_to_usbdev(interface);
 
- 	if (!line6)
 
- 		return;
 
- 	if (WARN_ON(usbdev != line6->usbdev))
 
- 		return;
 
- 	if (line6->urb_listen != NULL)
 
- 		line6_stop_listen(line6);
 
- 	snd_card_disconnect(line6->card);
 
- 	if (line6->line6pcm)
 
- 		line6_pcm_disconnect(line6->line6pcm);
 
- 	if (line6->disconnect)
 
- 		line6->disconnect(line6);
 
- 	dev_info(&interface->dev, "Line 6 %s now disconnected\n",
 
- 		 line6->properties->name);
 
- 	/* make sure the device isn't destructed twice: */
 
- 	usb_set_intfdata(interface, NULL);
 
- 	snd_card_free_when_closed(line6->card);
 
- }
 
- EXPORT_SYMBOL_GPL(line6_disconnect);
 
- #ifdef CONFIG_PM
 
- /*
 
- 	Suspend Line 6 device.
 
- */
 
- int line6_suspend(struct usb_interface *interface, pm_message_t message)
 
- {
 
- 	struct usb_line6 *line6 = usb_get_intfdata(interface);
 
- 	struct snd_line6_pcm *line6pcm = line6->line6pcm;
 
- 	snd_power_change_state(line6->card, SNDRV_CTL_POWER_D3hot);
 
- 	if (line6->properties->capabilities & LINE6_CAP_CONTROL)
 
- 		line6_stop_listen(line6);
 
- 	if (line6pcm != NULL) {
 
- 		snd_pcm_suspend_all(line6pcm->pcm);
 
- 		line6pcm->flags = 0;
 
- 	}
 
- 	return 0;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_suspend);
 
- /*
 
- 	Resume Line 6 device.
 
- */
 
- int line6_resume(struct usb_interface *interface)
 
- {
 
- 	struct usb_line6 *line6 = usb_get_intfdata(interface);
 
- 	if (line6->properties->capabilities & LINE6_CAP_CONTROL)
 
- 		line6_start_listen(line6);
 
- 	snd_power_change_state(line6->card, SNDRV_CTL_POWER_D0);
 
- 	return 0;
 
- }
 
- EXPORT_SYMBOL_GPL(line6_resume);
 
- #endif /* CONFIG_PM */
 
- MODULE_AUTHOR(DRIVER_AUTHOR);
 
- MODULE_DESCRIPTION(DRIVER_DESC);
 
- MODULE_LICENSE("GPL");
 
 
  |