xref: /openbmc/linux/drivers/usb/misc/adutux.c (revision 66d4bc30d128e7c7ac4cf64aa78cb76e971cec5b)
103270634SSteven Haigh /*
203270634SSteven Haigh  * adutux - driver for ADU devices from Ontrak Control Systems
303270634SSteven Haigh  * This is an experimental driver. Use at your own risk.
403270634SSteven Haigh  * This driver is not supported by Ontrak Control Systems.
503270634SSteven Haigh  *
603270634SSteven Haigh  * Copyright (c) 2003 John Homppi (SCO, leave this notice here)
703270634SSteven Haigh  *
803270634SSteven Haigh  * This program is free software; you can redistribute it and/or
903270634SSteven Haigh  * modify it under the terms of the GNU General Public License as
1003270634SSteven Haigh  * published by the Free Software Foundation; either version 2 of
1103270634SSteven Haigh  * the License, or (at your option) any later version.
1203270634SSteven Haigh  *
1303270634SSteven Haigh  * derived from the Lego USB Tower driver 0.56:
1403270634SSteven Haigh  * Copyright (c) 2003 David Glance <davidgsf@sourceforge.net>
1503270634SSteven Haigh  *               2001 Juergen Stuber <stuber@loria.fr>
1603270634SSteven Haigh  * that was derived from USB Skeleton driver - 0.5
1703270634SSteven Haigh  * Copyright (c) 2001 Greg Kroah-Hartman (greg@kroah.com)
1803270634SSteven Haigh  *
1903270634SSteven Haigh  */
2003270634SSteven Haigh 
2103270634SSteven Haigh #include <linux/kernel.h>
2203270634SSteven Haigh #include <linux/errno.h>
2303270634SSteven Haigh #include <linux/init.h>
2403270634SSteven Haigh #include <linux/slab.h>
2503270634SSteven Haigh #include <linux/module.h>
2603270634SSteven Haigh #include <linux/usb.h>
278293c568SMatthias Kaehlcke #include <linux/mutex.h>
2840cf4833SLisa Nguyen #include <linux/uaccess.h>
2903270634SSteven Haigh 
3003270634SSteven Haigh #ifdef CONFIG_USB_DEBUG
3103270634SSteven Haigh static int debug = 5;
3203270634SSteven Haigh #else
3303270634SSteven Haigh static int debug = 1;
3403270634SSteven Haigh #endif
3503270634SSteven Haigh 
3603270634SSteven Haigh /* Use our own dbg macro */
3703270634SSteven Haigh #undef dbg
3803270634SSteven Haigh #define dbg(lvl, format, arg...)	\
3903270634SSteven Haigh do {								\
4003270634SSteven Haigh 	if (debug >= lvl)						\
41f45ba776SJoe Perches 		printk(KERN_DEBUG "%s: " format "\n", __FILE__, ##arg);	\
4203270634SSteven Haigh } while (0)
4303270634SSteven Haigh 
4403270634SSteven Haigh 
4503270634SSteven Haigh /* Version Information */
4603270634SSteven Haigh #define DRIVER_VERSION "v0.0.13"
4703270634SSteven Haigh #define DRIVER_AUTHOR "John Homppi"
4803270634SSteven Haigh #define DRIVER_DESC "adutux (see www.ontrak.net)"
4903270634SSteven Haigh 
5003270634SSteven Haigh /* Module parameters */
5103270634SSteven Haigh module_param(debug, int, S_IRUGO | S_IWUSR);
5203270634SSteven Haigh MODULE_PARM_DESC(debug, "Debug enabled or not");
5303270634SSteven Haigh 
5403270634SSteven Haigh /* Define these values to match your device */
5503270634SSteven Haigh #define ADU_VENDOR_ID 0x0a07
5603270634SSteven Haigh #define ADU_PRODUCT_ID 0x0064
5703270634SSteven Haigh 
5803270634SSteven Haigh /* table of devices that work with this driver */
5933b9e162SNémeth Márton static const struct usb_device_id device_table[] = {
6003270634SSteven Haigh 	{ USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID) },		/* ADU100 */
6103270634SSteven Haigh 	{ USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+20) },	/* ADU120 */
6203270634SSteven Haigh 	{ USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+30) },	/* ADU130 */
6303270634SSteven Haigh 	{ USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+100) },	/* ADU200 */
6403270634SSteven Haigh 	{ USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+108) },	/* ADU208 */
6503270634SSteven Haigh 	{ USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+118) },	/* ADU218 */
6603270634SSteven Haigh 	{ } /* Terminating entry */
6703270634SSteven Haigh };
6803270634SSteven Haigh 
6903270634SSteven Haigh MODULE_DEVICE_TABLE(usb, device_table);
7003270634SSteven Haigh 
7103270634SSteven Haigh #ifdef CONFIG_USB_DYNAMIC_MINORS
7203270634SSteven Haigh #define ADU_MINOR_BASE	0
7303270634SSteven Haigh #else
7403270634SSteven Haigh #define ADU_MINOR_BASE	67
7503270634SSteven Haigh #endif
7603270634SSteven Haigh 
7703270634SSteven Haigh /* we can have up to this number of device plugged in at once */
7803270634SSteven Haigh #define MAX_DEVICES	16
7903270634SSteven Haigh 
8003270634SSteven Haigh #define COMMAND_TIMEOUT	(2*HZ)	/* 60 second timeout for a command */
8103270634SSteven Haigh 
82f08812d5SPete Zaitcev /*
83f08812d5SPete Zaitcev  * The locking scheme is a vanilla 3-lock:
84f08812d5SPete Zaitcev  *   adu_device.buflock: A spinlock, covers what IRQs touch.
85f08812d5SPete Zaitcev  *   adutux_mutex:       A Static lock to cover open_count. It would also cover
86f08812d5SPete Zaitcev  *                       any globals, but we don't have them in 2.6.
87f08812d5SPete Zaitcev  *   adu_device.mtx:     A mutex to hold across sleepers like copy_from_user.
88f08812d5SPete Zaitcev  *                       It covers all of adu_device, except the open_count
89f08812d5SPete Zaitcev  *                       and what .buflock covers.
90f08812d5SPete Zaitcev  */
91f08812d5SPete Zaitcev 
9203270634SSteven Haigh /* Structure to hold all of our device specific stuff */
9303270634SSteven Haigh struct adu_device {
94f08812d5SPete Zaitcev 	struct mutex		mtx;
9503270634SSteven Haigh 	struct usb_device *udev; /* save off the usb device pointer */
9603270634SSteven Haigh 	struct usb_interface *interface;
97f08812d5SPete Zaitcev 	unsigned int		minor; /* the starting minor number for this device */
9803270634SSteven Haigh 	char			serial_number[8];
9903270634SSteven Haigh 
10003270634SSteven Haigh 	int			open_count; /* number of times this port has been opened */
10103270634SSteven Haigh 
10203270634SSteven Haigh 	char		*read_buffer_primary;
10303270634SSteven Haigh 	int			read_buffer_length;
10403270634SSteven Haigh 	char		*read_buffer_secondary;
10503270634SSteven Haigh 	int			secondary_head;
10603270634SSteven Haigh 	int			secondary_tail;
10703270634SSteven Haigh 	spinlock_t		buflock;
10803270634SSteven Haigh 
10903270634SSteven Haigh 	wait_queue_head_t	read_wait;
11003270634SSteven Haigh 	wait_queue_head_t	write_wait;
11103270634SSteven Haigh 
11203270634SSteven Haigh 	char		*interrupt_in_buffer;
11303270634SSteven Haigh 	struct usb_endpoint_descriptor *interrupt_in_endpoint;
11403270634SSteven Haigh 	struct urb	*interrupt_in_urb;
11503270634SSteven Haigh 	int			read_urb_finished;
11603270634SSteven Haigh 
11703270634SSteven Haigh 	char		*interrupt_out_buffer;
11803270634SSteven Haigh 	struct usb_endpoint_descriptor *interrupt_out_endpoint;
11903270634SSteven Haigh 	struct urb	*interrupt_out_urb;
120f08812d5SPete Zaitcev 	int			out_urb_finished;
12103270634SSteven Haigh };
12203270634SSteven Haigh 
123f08812d5SPete Zaitcev static DEFINE_MUTEX(adutux_mutex);
124f08812d5SPete Zaitcev 
12503270634SSteven Haigh static struct usb_driver adu_driver;
12603270634SSteven Haigh 
12703270634SSteven Haigh static void adu_debug_data(int level, const char *function, int size,
12803270634SSteven Haigh 			   const unsigned char *data)
12903270634SSteven Haigh {
13003270634SSteven Haigh 	int i;
13103270634SSteven Haigh 
13203270634SSteven Haigh 	if (debug < level)
13303270634SSteven Haigh 		return;
13403270634SSteven Haigh 
135f45ba776SJoe Perches 	printk(KERN_DEBUG "%s: %s - length = %d, data = ",
136f45ba776SJoe Perches 	       __FILE__, function, size);
13703270634SSteven Haigh 	for (i = 0; i < size; ++i)
13803270634SSteven Haigh 		printk("%.2x ", data[i]);
13903270634SSteven Haigh 	printk("\n");
14003270634SSteven Haigh }
14103270634SSteven Haigh 
14203270634SSteven Haigh /**
14303270634SSteven Haigh  * adu_abort_transfers
14403270634SSteven Haigh  *      aborts transfers and frees associated data structures
14503270634SSteven Haigh  */
14603270634SSteven Haigh static void adu_abort_transfers(struct adu_device *dev)
14703270634SSteven Haigh {
148f08812d5SPete Zaitcev 	unsigned long flags;
14903270634SSteven Haigh 
150*66d4bc30SGreg Kroah-Hartman 	if (dev->udev == NULL)
1516e42a158SGreg Kroah-Hartman 		return;
15203270634SSteven Haigh 
15303270634SSteven Haigh 	/* shutdown transfer */
154f08812d5SPete Zaitcev 
155f08812d5SPete Zaitcev 	/* XXX Anchor these instead */
156f08812d5SPete Zaitcev 	spin_lock_irqsave(&dev->buflock, flags);
157f08812d5SPete Zaitcev 	if (!dev->read_urb_finished) {
158f08812d5SPete Zaitcev 		spin_unlock_irqrestore(&dev->buflock, flags);
159f08812d5SPete Zaitcev 		usb_kill_urb(dev->interrupt_in_urb);
160f08812d5SPete Zaitcev 	} else
161f08812d5SPete Zaitcev 		spin_unlock_irqrestore(&dev->buflock, flags);
162f08812d5SPete Zaitcev 
163f08812d5SPete Zaitcev 	spin_lock_irqsave(&dev->buflock, flags);
164f08812d5SPete Zaitcev 	if (!dev->out_urb_finished) {
165f08812d5SPete Zaitcev 		spin_unlock_irqrestore(&dev->buflock, flags);
166f08812d5SPete Zaitcev 		usb_kill_urb(dev->interrupt_out_urb);
167f08812d5SPete Zaitcev 	} else
168f08812d5SPete Zaitcev 		spin_unlock_irqrestore(&dev->buflock, flags);
16903270634SSteven Haigh }
17003270634SSteven Haigh 
17103270634SSteven Haigh static void adu_delete(struct adu_device *dev)
17203270634SSteven Haigh {
17303270634SSteven Haigh 	/* free data structures */
17403270634SSteven Haigh 	usb_free_urb(dev->interrupt_in_urb);
17503270634SSteven Haigh 	usb_free_urb(dev->interrupt_out_urb);
17603270634SSteven Haigh 	kfree(dev->read_buffer_primary);
17703270634SSteven Haigh 	kfree(dev->read_buffer_secondary);
17803270634SSteven Haigh 	kfree(dev->interrupt_in_buffer);
17903270634SSteven Haigh 	kfree(dev->interrupt_out_buffer);
18003270634SSteven Haigh 	kfree(dev);
18103270634SSteven Haigh }
18203270634SSteven Haigh 
1837d12e780SDavid Howells static void adu_interrupt_in_callback(struct urb *urb)
18403270634SSteven Haigh {
18503270634SSteven Haigh 	struct adu_device *dev = urb->context;
18624497a00SGreg Kroah-Hartman 	int status = urb->status;
18703270634SSteven Haigh 
188441b62c1SHarvey Harrison 	adu_debug_data(5, __func__, urb->actual_length,
18903270634SSteven Haigh 		       urb->transfer_buffer);
19003270634SSteven Haigh 
19103270634SSteven Haigh 	spin_lock(&dev->buflock);
19203270634SSteven Haigh 
19324497a00SGreg Kroah-Hartman 	if (status != 0) {
194f6c1ceaaSOliver Neukum 		if ((status != -ENOENT) && (status != -ECONNRESET) &&
195f6c1ceaaSOliver Neukum 			(status != -ESHUTDOWN)) {
196*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev,
197*66d4bc30SGreg Kroah-Hartman 				"%s : nonzero status received: %d\n",
198441b62c1SHarvey Harrison 				__func__, status);
19903270634SSteven Haigh 		}
20003270634SSteven Haigh 		goto exit;
20103270634SSteven Haigh 	}
20203270634SSteven Haigh 
20303270634SSteven Haigh 	if (urb->actual_length > 0 && dev->interrupt_in_buffer[0] != 0x00) {
20403270634SSteven Haigh 		if (dev->read_buffer_length <
20529cc8897SKuninori Morimoto 		    (4 * usb_endpoint_maxp(dev->interrupt_in_endpoint)) -
20603270634SSteven Haigh 		     (urb->actual_length)) {
20703270634SSteven Haigh 			memcpy (dev->read_buffer_primary +
20803270634SSteven Haigh 				dev->read_buffer_length,
20903270634SSteven Haigh 				dev->interrupt_in_buffer, urb->actual_length);
21003270634SSteven Haigh 
21103270634SSteven Haigh 			dev->read_buffer_length += urb->actual_length;
212*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev,"%s reading  %d\n", __func__,
21303270634SSteven Haigh 				urb->actual_length);
21403270634SSteven Haigh 		} else {
215*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev,"%s : read_buffer overflow\n",
216*66d4bc30SGreg Kroah-Hartman 				__func__);
21703270634SSteven Haigh 		}
21803270634SSteven Haigh 	}
21903270634SSteven Haigh 
22003270634SSteven Haigh exit:
22103270634SSteven Haigh 	dev->read_urb_finished = 1;
22203270634SSteven Haigh 	spin_unlock(&dev->buflock);
22303270634SSteven Haigh 	/* always wake up so we recover from errors */
22403270634SSteven Haigh 	wake_up_interruptible(&dev->read_wait);
225441b62c1SHarvey Harrison 	adu_debug_data(5, __func__, urb->actual_length,
22603270634SSteven Haigh 		       urb->transfer_buffer);
22703270634SSteven Haigh }
22803270634SSteven Haigh 
2297d12e780SDavid Howells static void adu_interrupt_out_callback(struct urb *urb)
23003270634SSteven Haigh {
23103270634SSteven Haigh 	struct adu_device *dev = urb->context;
23224497a00SGreg Kroah-Hartman 	int status = urb->status;
23303270634SSteven Haigh 
234441b62c1SHarvey Harrison 	adu_debug_data(5, __func__, urb->actual_length, urb->transfer_buffer);
23503270634SSteven Haigh 
23624497a00SGreg Kroah-Hartman 	if (status != 0) {
23724497a00SGreg Kroah-Hartman 		if ((status != -ENOENT) &&
23824497a00SGreg Kroah-Hartman 		    (status != -ECONNRESET)) {
239*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev,
240*66d4bc30SGreg Kroah-Hartman 				"%s :nonzero status received: %d\n", __func__,
241*66d4bc30SGreg Kroah-Hartman 				status);
24203270634SSteven Haigh 		}
24303270634SSteven Haigh 		goto exit;
24403270634SSteven Haigh 	}
24503270634SSteven Haigh 
246f08812d5SPete Zaitcev 	spin_lock(&dev->buflock);
247f08812d5SPete Zaitcev 	dev->out_urb_finished = 1;
248f08812d5SPete Zaitcev 	wake_up(&dev->write_wait);
249f08812d5SPete Zaitcev 	spin_unlock(&dev->buflock);
25003270634SSteven Haigh exit:
25103270634SSteven Haigh 
252441b62c1SHarvey Harrison 	adu_debug_data(5, __func__, urb->actual_length,
25303270634SSteven Haigh 		       urb->transfer_buffer);
25403270634SSteven Haigh }
25503270634SSteven Haigh 
25603270634SSteven Haigh static int adu_open(struct inode *inode, struct file *file)
25703270634SSteven Haigh {
25803270634SSteven Haigh 	struct adu_device *dev = NULL;
25903270634SSteven Haigh 	struct usb_interface *interface;
26003270634SSteven Haigh 	int subminor;
261f08812d5SPete Zaitcev 	int retval;
26203270634SSteven Haigh 
26303270634SSteven Haigh 	subminor = iminor(inode);
26403270634SSteven Haigh 
265e77c4e6aSLisa Nguyen 	retval = mutex_lock_interruptible(&adutux_mutex);
266*66d4bc30SGreg Kroah-Hartman 	if (retval)
267f08812d5SPete Zaitcev 		goto exit_no_lock;
268f08812d5SPete Zaitcev 
26903270634SSteven Haigh 	interface = usb_find_interface(&adu_driver, subminor);
27003270634SSteven Haigh 	if (!interface) {
271fd3f1917SGreg Kroah-Hartman 		printk(KERN_ERR "adutux: %s - error, can't find device for "
272fd3f1917SGreg Kroah-Hartman 		       "minor %d\n", __func__, subminor);
27303270634SSteven Haigh 		retval = -ENODEV;
27403270634SSteven Haigh 		goto exit_no_device;
27503270634SSteven Haigh 	}
27603270634SSteven Haigh 
27703270634SSteven Haigh 	dev = usb_get_intfdata(interface);
278f08812d5SPete Zaitcev 	if (!dev || !dev->udev) {
27903270634SSteven Haigh 		retval = -ENODEV;
28003270634SSteven Haigh 		goto exit_no_device;
28103270634SSteven Haigh 	}
28203270634SSteven Haigh 
283f08812d5SPete Zaitcev 	/* check that nobody else is using the device */
284f08812d5SPete Zaitcev 	if (dev->open_count) {
285f08812d5SPete Zaitcev 		retval = -EBUSY;
28603270634SSteven Haigh 		goto exit_no_device;
28703270634SSteven Haigh 	}
28803270634SSteven Haigh 
28903270634SSteven Haigh 	++dev->open_count;
290*66d4bc30SGreg Kroah-Hartman 	dev_dbg(&dev->udev->dev, "%s: open count %d\n", __func__,
291*66d4bc30SGreg Kroah-Hartman 		dev->open_count);
29203270634SSteven Haigh 
29303270634SSteven Haigh 	/* save device in the file's private structure */
29403270634SSteven Haigh 	file->private_data = dev;
29503270634SSteven Haigh 
29603270634SSteven Haigh 	/* initialize in direction */
29703270634SSteven Haigh 	dev->read_buffer_length = 0;
29803270634SSteven Haigh 
29903270634SSteven Haigh 	/* fixup first read by having urb waiting for it */
30003270634SSteven Haigh 	usb_fill_int_urb(dev->interrupt_in_urb, dev->udev,
30103270634SSteven Haigh 			 usb_rcvintpipe(dev->udev,
30203270634SSteven Haigh 					dev->interrupt_in_endpoint->bEndpointAddress),
30303270634SSteven Haigh 			 dev->interrupt_in_buffer,
30429cc8897SKuninori Morimoto 			 usb_endpoint_maxp(dev->interrupt_in_endpoint),
30503270634SSteven Haigh 			 adu_interrupt_in_callback, dev,
30603270634SSteven Haigh 			 dev->interrupt_in_endpoint->bInterval);
30703270634SSteven Haigh 	dev->read_urb_finished = 0;
308f08812d5SPete Zaitcev 	if (usb_submit_urb(dev->interrupt_in_urb, GFP_KERNEL))
309f08812d5SPete Zaitcev 		dev->read_urb_finished = 1;
310f08812d5SPete Zaitcev 	/* we ignore failure */
311f08812d5SPete Zaitcev 	/* end of fixup for first read */
312f08812d5SPete Zaitcev 
313f08812d5SPete Zaitcev 	/* initialize out direction */
314f08812d5SPete Zaitcev 	dev->out_urb_finished = 1;
315f08812d5SPete Zaitcev 
316f08812d5SPete Zaitcev 	retval = 0;
31703270634SSteven Haigh 
31803270634SSteven Haigh exit_no_device:
319f08812d5SPete Zaitcev 	mutex_unlock(&adutux_mutex);
320f08812d5SPete Zaitcev exit_no_lock:
32103270634SSteven Haigh 	return retval;
32203270634SSteven Haigh }
32303270634SSteven Haigh 
324f08812d5SPete Zaitcev static void adu_release_internal(struct adu_device *dev)
32503270634SSteven Haigh {
32603270634SSteven Haigh 	/* decrement our usage count for the device */
32703270634SSteven Haigh 	--dev->open_count;
328*66d4bc30SGreg Kroah-Hartman 	dev_dbg(&dev->udev->dev, "%s : open count %d\n", __func__,
329*66d4bc30SGreg Kroah-Hartman 		dev->open_count);
33003270634SSteven Haigh 	if (dev->open_count <= 0) {
33103270634SSteven Haigh 		adu_abort_transfers(dev);
33203270634SSteven Haigh 		dev->open_count = 0;
33303270634SSteven Haigh 	}
33403270634SSteven Haigh }
33503270634SSteven Haigh 
33603270634SSteven Haigh static int adu_release(struct inode *inode, struct file *file)
33703270634SSteven Haigh {
338f08812d5SPete Zaitcev 	struct adu_device *dev;
33903270634SSteven Haigh 	int retval = 0;
34003270634SSteven Haigh 
34103270634SSteven Haigh 	if (file == NULL) {
34203270634SSteven Haigh 		retval = -ENODEV;
34303270634SSteven Haigh 		goto exit;
34403270634SSteven Haigh 	}
34503270634SSteven Haigh 
34603270634SSteven Haigh 	dev = file->private_data;
34703270634SSteven Haigh 	if (dev == NULL) {
34803270634SSteven Haigh 		retval = -ENODEV;
34903270634SSteven Haigh 		goto exit;
35003270634SSteven Haigh 	}
35103270634SSteven Haigh 
352f08812d5SPete Zaitcev 	mutex_lock(&adutux_mutex); /* not interruptible */
35303270634SSteven Haigh 
35403270634SSteven Haigh 	if (dev->open_count <= 0) {
355*66d4bc30SGreg Kroah-Hartman 		dev_dbg(&dev->udev->dev, "%s : device not opened\n", __func__);
35603270634SSteven Haigh 		retval = -ENODEV;
35746c9844cSJiri Slaby 		goto unlock;
35803270634SSteven Haigh 	}
35903270634SSteven Haigh 
360f08812d5SPete Zaitcev 	adu_release_internal(dev);
361d4ead16fSAlan Stern 	if (dev->udev == NULL) {
362d4ead16fSAlan Stern 		/* the device was unplugged before the file was released */
363f08812d5SPete Zaitcev 		if (!dev->open_count)	/* ... and we're the last user */
364d4ead16fSAlan Stern 			adu_delete(dev);
365d4ead16fSAlan Stern 	}
36646c9844cSJiri Slaby unlock:
367f08812d5SPete Zaitcev 	mutex_unlock(&adutux_mutex);
36846c9844cSJiri Slaby exit:
36903270634SSteven Haigh 	return retval;
37003270634SSteven Haigh }
37103270634SSteven Haigh 
37203270634SSteven Haigh static ssize_t adu_read(struct file *file, __user char *buffer, size_t count,
37303270634SSteven Haigh 			loff_t *ppos)
37403270634SSteven Haigh {
37503270634SSteven Haigh 	struct adu_device *dev;
37603270634SSteven Haigh 	size_t bytes_read = 0;
37703270634SSteven Haigh 	size_t bytes_to_read = count;
37803270634SSteven Haigh 	int i;
37903270634SSteven Haigh 	int retval = 0;
38003270634SSteven Haigh 	int timeout = 0;
38103270634SSteven Haigh 	int should_submit = 0;
38203270634SSteven Haigh 	unsigned long flags;
38303270634SSteven Haigh 	DECLARE_WAITQUEUE(wait, current);
38403270634SSteven Haigh 
38503270634SSteven Haigh 	dev = file->private_data;
3868293c568SMatthias Kaehlcke 	if (mutex_lock_interruptible(&dev->mtx))
38703270634SSteven Haigh 		return -ERESTARTSYS;
38803270634SSteven Haigh 
38903270634SSteven Haigh 	/* verify that the device wasn't unplugged */
390f08812d5SPete Zaitcev 	if (dev->udev == NULL) {
39103270634SSteven Haigh 		retval = -ENODEV;
392fd3f1917SGreg Kroah-Hartman 		printk(KERN_ERR "adutux: No device or device unplugged %d\n",
393fd3f1917SGreg Kroah-Hartman 		       retval);
39403270634SSteven Haigh 		goto exit;
39503270634SSteven Haigh 	}
39603270634SSteven Haigh 
39703270634SSteven Haigh 	/* verify that some data was requested */
39803270634SSteven Haigh 	if (count == 0) {
399*66d4bc30SGreg Kroah-Hartman 		dev_dbg(&dev->udev->dev, "%s : read request of 0 bytes\n",
400*66d4bc30SGreg Kroah-Hartman 			__func__);
40103270634SSteven Haigh 		goto exit;
40203270634SSteven Haigh 	}
40303270634SSteven Haigh 
40403270634SSteven Haigh 	timeout = COMMAND_TIMEOUT;
405*66d4bc30SGreg Kroah-Hartman 	dev_dbg(&dev->udev->dev, "%s : about to start looping\n", __func__);
40603270634SSteven Haigh 	while (bytes_to_read) {
40703270634SSteven Haigh 		int data_in_secondary = dev->secondary_tail - dev->secondary_head;
408*66d4bc30SGreg Kroah-Hartman 		dev_dbg(&dev->udev->dev,
409*66d4bc30SGreg Kroah-Hartman 			"%s : while, data_in_secondary=%d, status=%d\n",
410441b62c1SHarvey Harrison 			__func__, data_in_secondary,
41103270634SSteven Haigh 			dev->interrupt_in_urb->status);
41203270634SSteven Haigh 
41303270634SSteven Haigh 		if (data_in_secondary) {
41403270634SSteven Haigh 			/* drain secondary buffer */
41503270634SSteven Haigh 			int amount = bytes_to_read < data_in_secondary ? bytes_to_read : data_in_secondary;
41603270634SSteven Haigh 			i = copy_to_user(buffer, dev->read_buffer_secondary+dev->secondary_head, amount);
4171865a9c3SKulikov Vasiliy 			if (i) {
41803270634SSteven Haigh 				retval = -EFAULT;
41903270634SSteven Haigh 				goto exit;
42003270634SSteven Haigh 			}
42103270634SSteven Haigh 			dev->secondary_head += (amount - i);
42203270634SSteven Haigh 			bytes_read += (amount - i);
42303270634SSteven Haigh 			bytes_to_read -= (amount - i);
42403270634SSteven Haigh 			if (i) {
42503270634SSteven Haigh 				retval = bytes_read ? bytes_read : -EFAULT;
42603270634SSteven Haigh 				goto exit;
42703270634SSteven Haigh 			}
42803270634SSteven Haigh 		} else {
42903270634SSteven Haigh 			/* we check the primary buffer */
43003270634SSteven Haigh 			spin_lock_irqsave (&dev->buflock, flags);
43103270634SSteven Haigh 			if (dev->read_buffer_length) {
43203270634SSteven Haigh 				/* we secure access to the primary */
43303270634SSteven Haigh 				char *tmp;
434*66d4bc30SGreg Kroah-Hartman 				dev_dbg(&dev->udev->dev,
435*66d4bc30SGreg Kroah-Hartman 					"%s : swap, read_buffer_length = %d\n",
436441b62c1SHarvey Harrison 					__func__, dev->read_buffer_length);
43703270634SSteven Haigh 				tmp = dev->read_buffer_secondary;
43803270634SSteven Haigh 				dev->read_buffer_secondary = dev->read_buffer_primary;
43903270634SSteven Haigh 				dev->read_buffer_primary = tmp;
44003270634SSteven Haigh 				dev->secondary_head = 0;
44103270634SSteven Haigh 				dev->secondary_tail = dev->read_buffer_length;
44203270634SSteven Haigh 				dev->read_buffer_length = 0;
44303270634SSteven Haigh 				spin_unlock_irqrestore(&dev->buflock, flags);
44403270634SSteven Haigh 				/* we have a free buffer so use it */
44503270634SSteven Haigh 				should_submit = 1;
44603270634SSteven Haigh 			} else {
44703270634SSteven Haigh 				/* even the primary was empty - we may need to do IO */
448f08812d5SPete Zaitcev 				if (!dev->read_urb_finished) {
44903270634SSteven Haigh 					/* somebody is doing IO */
45003270634SSteven Haigh 					spin_unlock_irqrestore(&dev->buflock, flags);
451*66d4bc30SGreg Kroah-Hartman 					dev_dbg(&dev->udev->dev,
452*66d4bc30SGreg Kroah-Hartman 						"%s : submitted already\n",
453*66d4bc30SGreg Kroah-Hartman 						__func__);
45403270634SSteven Haigh 				} else {
45503270634SSteven Haigh 					/* we must initiate input */
456*66d4bc30SGreg Kroah-Hartman 					dev_dbg(&dev->udev->dev,
457*66d4bc30SGreg Kroah-Hartman 						"%s : initiate input\n",
458*66d4bc30SGreg Kroah-Hartman 						__func__);
45903270634SSteven Haigh 					dev->read_urb_finished = 0;
460f08812d5SPete Zaitcev 					spin_unlock_irqrestore(&dev->buflock, flags);
46103270634SSteven Haigh 
46203270634SSteven Haigh 					usb_fill_int_urb(dev->interrupt_in_urb, dev->udev,
46303270634SSteven Haigh 							usb_rcvintpipe(dev->udev,
46403270634SSteven Haigh 								dev->interrupt_in_endpoint->bEndpointAddress),
46503270634SSteven Haigh 							 dev->interrupt_in_buffer,
46629cc8897SKuninori Morimoto 							 usb_endpoint_maxp(dev->interrupt_in_endpoint),
46703270634SSteven Haigh 							 adu_interrupt_in_callback,
46803270634SSteven Haigh 							 dev,
46903270634SSteven Haigh 							 dev->interrupt_in_endpoint->bInterval);
470f08812d5SPete Zaitcev 					retval = usb_submit_urb(dev->interrupt_in_urb, GFP_KERNEL);
471f08812d5SPete Zaitcev 					if (retval) {
472f08812d5SPete Zaitcev 						dev->read_urb_finished = 1;
47303270634SSteven Haigh 						if (retval == -ENOMEM) {
47403270634SSteven Haigh 							retval = bytes_read ? bytes_read : -ENOMEM;
47503270634SSteven Haigh 						}
476*66d4bc30SGreg Kroah-Hartman 						dev_dbg(&dev->udev->dev,
477*66d4bc30SGreg Kroah-Hartman 							"%s : submit failed\n",
478*66d4bc30SGreg Kroah-Hartman 							__func__);
47903270634SSteven Haigh 						goto exit;
48003270634SSteven Haigh 					}
48103270634SSteven Haigh 				}
48203270634SSteven Haigh 
48303270634SSteven Haigh 				/* we wait for I/O to complete */
48403270634SSteven Haigh 				set_current_state(TASK_INTERRUPTIBLE);
48503270634SSteven Haigh 				add_wait_queue(&dev->read_wait, &wait);
486f08812d5SPete Zaitcev 				spin_lock_irqsave(&dev->buflock, flags);
487f08812d5SPete Zaitcev 				if (!dev->read_urb_finished) {
488f08812d5SPete Zaitcev 					spin_unlock_irqrestore(&dev->buflock, flags);
48903270634SSteven Haigh 					timeout = schedule_timeout(COMMAND_TIMEOUT);
490f08812d5SPete Zaitcev 				} else {
491f08812d5SPete Zaitcev 					spin_unlock_irqrestore(&dev->buflock, flags);
49203270634SSteven Haigh 					set_current_state(TASK_RUNNING);
493f08812d5SPete Zaitcev 				}
49403270634SSteven Haigh 				remove_wait_queue(&dev->read_wait, &wait);
49503270634SSteven Haigh 
49603270634SSteven Haigh 				if (timeout <= 0) {
497*66d4bc30SGreg Kroah-Hartman 					dev_dbg(&dev->udev->dev,
498*66d4bc30SGreg Kroah-Hartman 						"%s : timeout\n", __func__);
49903270634SSteven Haigh 					retval = bytes_read ? bytes_read : -ETIMEDOUT;
50003270634SSteven Haigh 					goto exit;
50103270634SSteven Haigh 				}
50203270634SSteven Haigh 
50303270634SSteven Haigh 				if (signal_pending(current)) {
504*66d4bc30SGreg Kroah-Hartman 					dev_dbg(&dev->udev->dev,
505*66d4bc30SGreg Kroah-Hartman 						"%s : signal pending\n",
506*66d4bc30SGreg Kroah-Hartman 						__func__);
50703270634SSteven Haigh 					retval = bytes_read ? bytes_read : -EINTR;
50803270634SSteven Haigh 					goto exit;
50903270634SSteven Haigh 				}
51003270634SSteven Haigh 			}
51103270634SSteven Haigh 		}
51203270634SSteven Haigh 	}
51303270634SSteven Haigh 
51403270634SSteven Haigh 	retval = bytes_read;
51503270634SSteven Haigh 	/* if the primary buffer is empty then use it */
516f08812d5SPete Zaitcev 	spin_lock_irqsave(&dev->buflock, flags);
517f08812d5SPete Zaitcev 	if (should_submit && dev->read_urb_finished) {
518f08812d5SPete Zaitcev 		dev->read_urb_finished = 0;
519f08812d5SPete Zaitcev 		spin_unlock_irqrestore(&dev->buflock, flags);
52003270634SSteven Haigh 		usb_fill_int_urb(dev->interrupt_in_urb, dev->udev,
52103270634SSteven Haigh 				 usb_rcvintpipe(dev->udev,
52203270634SSteven Haigh 					dev->interrupt_in_endpoint->bEndpointAddress),
52303270634SSteven Haigh 				dev->interrupt_in_buffer,
52429cc8897SKuninori Morimoto 				usb_endpoint_maxp(dev->interrupt_in_endpoint),
52503270634SSteven Haigh 				adu_interrupt_in_callback,
52603270634SSteven Haigh 				dev,
52703270634SSteven Haigh 				dev->interrupt_in_endpoint->bInterval);
528f08812d5SPete Zaitcev 		if (usb_submit_urb(dev->interrupt_in_urb, GFP_KERNEL) != 0)
529f08812d5SPete Zaitcev 			dev->read_urb_finished = 1;
53003270634SSteven Haigh 		/* we ignore failure */
531f08812d5SPete Zaitcev 	} else {
532f08812d5SPete Zaitcev 		spin_unlock_irqrestore(&dev->buflock, flags);
53303270634SSteven Haigh 	}
53403270634SSteven Haigh 
53503270634SSteven Haigh exit:
53603270634SSteven Haigh 	/* unlock the device */
5378293c568SMatthias Kaehlcke 	mutex_unlock(&dev->mtx);
53803270634SSteven Haigh 
53903270634SSteven Haigh 	return retval;
54003270634SSteven Haigh }
54103270634SSteven Haigh 
54203270634SSteven Haigh static ssize_t adu_write(struct file *file, const __user char *buffer,
54303270634SSteven Haigh 			 size_t count, loff_t *ppos)
54403270634SSteven Haigh {
545f08812d5SPete Zaitcev 	DECLARE_WAITQUEUE(waita, current);
54603270634SSteven Haigh 	struct adu_device *dev;
54703270634SSteven Haigh 	size_t bytes_written = 0;
54803270634SSteven Haigh 	size_t bytes_to_write;
54903270634SSteven Haigh 	size_t buffer_size;
550f08812d5SPete Zaitcev 	unsigned long flags;
551ebc3ac14SOliver Neukum 	int retval;
55203270634SSteven Haigh 
55303270634SSteven Haigh 	dev = file->private_data;
55403270634SSteven Haigh 
5558293c568SMatthias Kaehlcke 	retval = mutex_lock_interruptible(&dev->mtx);
556ebc3ac14SOliver Neukum 	if (retval)
557ebc3ac14SOliver Neukum 		goto exit_nolock;
55803270634SSteven Haigh 
55903270634SSteven Haigh 	/* verify that the device wasn't unplugged */
560f08812d5SPete Zaitcev 	if (dev->udev == NULL) {
56103270634SSteven Haigh 		retval = -ENODEV;
562fd3f1917SGreg Kroah-Hartman 		printk(KERN_ERR "adutux: No device or device unplugged %d\n",
563fd3f1917SGreg Kroah-Hartman 		       retval);
56403270634SSteven Haigh 		goto exit;
56503270634SSteven Haigh 	}
56603270634SSteven Haigh 
56703270634SSteven Haigh 	/* verify that we actually have some data to write */
56803270634SSteven Haigh 	if (count == 0) {
569*66d4bc30SGreg Kroah-Hartman 		dev_dbg(&dev->udev->dev, "%s : write request of 0 bytes\n",
570*66d4bc30SGreg Kroah-Hartman 			__func__);
57103270634SSteven Haigh 		goto exit;
57203270634SSteven Haigh 	}
57303270634SSteven Haigh 
57403270634SSteven Haigh 	while (count > 0) {
575f08812d5SPete Zaitcev 		add_wait_queue(&dev->write_wait, &waita);
576f08812d5SPete Zaitcev 		set_current_state(TASK_INTERRUPTIBLE);
577f08812d5SPete Zaitcev 		spin_lock_irqsave(&dev->buflock, flags);
578f08812d5SPete Zaitcev 		if (!dev->out_urb_finished) {
579f08812d5SPete Zaitcev 			spin_unlock_irqrestore(&dev->buflock, flags);
58003270634SSteven Haigh 
581f08812d5SPete Zaitcev 			mutex_unlock(&dev->mtx);
58203270634SSteven Haigh 			if (signal_pending(current)) {
583*66d4bc30SGreg Kroah-Hartman 				dev_dbg(&dev->udev->dev, "%s : interrupted\n",
584*66d4bc30SGreg Kroah-Hartman 					__func__);
585f08812d5SPete Zaitcev 				set_current_state(TASK_RUNNING);
58603270634SSteven Haigh 				retval = -EINTR;
587f08812d5SPete Zaitcev 				goto exit_onqueue;
58803270634SSteven Haigh 			}
589f08812d5SPete Zaitcev 			if (schedule_timeout(COMMAND_TIMEOUT) == 0) {
590*66d4bc30SGreg Kroah-Hartman 				dev_dbg(&dev->udev->dev,
591*66d4bc30SGreg Kroah-Hartman 					"%s - command timed out.\n", __func__);
592f08812d5SPete Zaitcev 				retval = -ETIMEDOUT;
593f08812d5SPete Zaitcev 				goto exit_onqueue;
594f08812d5SPete Zaitcev 			}
595f08812d5SPete Zaitcev 			remove_wait_queue(&dev->write_wait, &waita);
5968293c568SMatthias Kaehlcke 			retval = mutex_lock_interruptible(&dev->mtx);
597ebc3ac14SOliver Neukum 			if (retval) {
598ebc3ac14SOliver Neukum 				retval = bytes_written ? bytes_written : retval;
599ebc3ac14SOliver Neukum 				goto exit_nolock;
600ebc3ac14SOliver Neukum 			}
60103270634SSteven Haigh 
602*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev,
603*66d4bc30SGreg Kroah-Hartman 				"%s : in progress, count = %Zd\n",
604*66d4bc30SGreg Kroah-Hartman 				__func__, count);
60503270634SSteven Haigh 		} else {
606f08812d5SPete Zaitcev 			spin_unlock_irqrestore(&dev->buflock, flags);
607f08812d5SPete Zaitcev 			set_current_state(TASK_RUNNING);
608f08812d5SPete Zaitcev 			remove_wait_queue(&dev->write_wait, &waita);
609*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev, "%s : sending, count = %Zd\n",
610*66d4bc30SGreg Kroah-Hartman 				__func__, count);
61103270634SSteven Haigh 
61203270634SSteven Haigh 			/* write the data into interrupt_out_buffer from userspace */
61329cc8897SKuninori Morimoto 			buffer_size = usb_endpoint_maxp(dev->interrupt_out_endpoint);
61403270634SSteven Haigh 			bytes_to_write = count > buffer_size ? buffer_size : count;
615*66d4bc30SGreg Kroah-Hartman 			dev_dbg(&dev->udev->dev,
616*66d4bc30SGreg Kroah-Hartman 				"%s : buffer_size = %Zd, count = %Zd, bytes_to_write = %Zd\n",
617441b62c1SHarvey Harrison 				__func__, buffer_size, count, bytes_to_write);
61803270634SSteven Haigh 
61903270634SSteven Haigh 			if (copy_from_user(dev->interrupt_out_buffer, buffer, bytes_to_write) != 0) {
62003270634SSteven Haigh 				retval = -EFAULT;
62103270634SSteven Haigh 				goto exit;
62203270634SSteven Haigh 			}
62303270634SSteven Haigh 
62403270634SSteven Haigh 			/* send off the urb */
62503270634SSteven Haigh 			usb_fill_int_urb(
62603270634SSteven Haigh 				dev->interrupt_out_urb,
62703270634SSteven Haigh 				dev->udev,
62803270634SSteven Haigh 				usb_sndintpipe(dev->udev, dev->interrupt_out_endpoint->bEndpointAddress),
62903270634SSteven Haigh 				dev->interrupt_out_buffer,
63003270634SSteven Haigh 				bytes_to_write,
63103270634SSteven Haigh 				adu_interrupt_out_callback,
63203270634SSteven Haigh 				dev,
633f08812d5SPete Zaitcev 				dev->interrupt_out_endpoint->bInterval);
63403270634SSteven Haigh 			dev->interrupt_out_urb->actual_length = bytes_to_write;
635f08812d5SPete Zaitcev 			dev->out_urb_finished = 0;
63603270634SSteven Haigh 			retval = usb_submit_urb(dev->interrupt_out_urb, GFP_KERNEL);
63703270634SSteven Haigh 			if (retval < 0) {
638f08812d5SPete Zaitcev 				dev->out_urb_finished = 1;
639fd3f1917SGreg Kroah-Hartman 				dev_err(&dev->udev->dev, "Couldn't submit "
640fd3f1917SGreg Kroah-Hartman 					"interrupt_out_urb %d\n", retval);
64103270634SSteven Haigh 				goto exit;
64203270634SSteven Haigh 			}
64303270634SSteven Haigh 
64403270634SSteven Haigh 			buffer += bytes_to_write;
64503270634SSteven Haigh 			count -= bytes_to_write;
64603270634SSteven Haigh 
64703270634SSteven Haigh 			bytes_written += bytes_to_write;
64803270634SSteven Haigh 		}
64903270634SSteven Haigh 	}
650f08812d5SPete Zaitcev 	mutex_unlock(&dev->mtx);
651f08812d5SPete Zaitcev 	return bytes_written;
65203270634SSteven Haigh 
65303270634SSteven Haigh exit:
6548293c568SMatthias Kaehlcke 	mutex_unlock(&dev->mtx);
655ebc3ac14SOliver Neukum exit_nolock:
656f08812d5SPete Zaitcev 	return retval;
65703270634SSteven Haigh 
658f08812d5SPete Zaitcev exit_onqueue:
659f08812d5SPete Zaitcev 	remove_wait_queue(&dev->write_wait, &waita);
66003270634SSteven Haigh 	return retval;
66103270634SSteven Haigh }
66203270634SSteven Haigh 
66303270634SSteven Haigh /* file operations needed when we register this driver */
66400977a59SArjan van de Ven static const struct file_operations adu_fops = {
66503270634SSteven Haigh 	.owner = THIS_MODULE,
66603270634SSteven Haigh 	.read  = adu_read,
66703270634SSteven Haigh 	.write = adu_write,
66803270634SSteven Haigh 	.open = adu_open,
66903270634SSteven Haigh 	.release = adu_release,
6706038f373SArnd Bergmann 	.llseek = noop_llseek,
67103270634SSteven Haigh };
67203270634SSteven Haigh 
67303270634SSteven Haigh /*
67403270634SSteven Haigh  * usb class driver info in order to get a minor number from the usb core,
67503270634SSteven Haigh  * and to have the device registered with devfs and the driver core
67603270634SSteven Haigh  */
67703270634SSteven Haigh static struct usb_class_driver adu_class = {
67803270634SSteven Haigh 	.name = "usb/adutux%d",
67903270634SSteven Haigh 	.fops = &adu_fops,
68003270634SSteven Haigh 	.minor_base = ADU_MINOR_BASE,
68103270634SSteven Haigh };
68203270634SSteven Haigh 
68303270634SSteven Haigh /**
68403270634SSteven Haigh  * adu_probe
68503270634SSteven Haigh  *
68603270634SSteven Haigh  * Called by the usb core when a new device is connected that it thinks
68703270634SSteven Haigh  * this driver might be interested in.
68803270634SSteven Haigh  */
68903270634SSteven Haigh static int adu_probe(struct usb_interface *interface,
69003270634SSteven Haigh 		     const struct usb_device_id *id)
69103270634SSteven Haigh {
69203270634SSteven Haigh 	struct usb_device *udev = interface_to_usbdev(interface);
69303270634SSteven Haigh 	struct adu_device *dev = NULL;
69403270634SSteven Haigh 	struct usb_host_interface *iface_desc;
69503270634SSteven Haigh 	struct usb_endpoint_descriptor *endpoint;
69603270634SSteven Haigh 	int retval = -ENODEV;
69703270634SSteven Haigh 	int in_end_size;
69803270634SSteven Haigh 	int out_end_size;
69903270634SSteven Haigh 	int i;
70003270634SSteven Haigh 
70103270634SSteven Haigh 	if (udev == NULL) {
70203270634SSteven Haigh 		dev_err(&interface->dev, "udev is NULL.\n");
70303270634SSteven Haigh 		goto exit;
70403270634SSteven Haigh 	}
70503270634SSteven Haigh 
706b595076aSUwe Kleine-König 	/* allocate memory for our device state and initialize it */
70703270634SSteven Haigh 	dev = kzalloc(sizeof(struct adu_device), GFP_KERNEL);
70803270634SSteven Haigh 	if (dev == NULL) {
70903270634SSteven Haigh 		dev_err(&interface->dev, "Out of memory\n");
71003270634SSteven Haigh 		retval = -ENOMEM;
71103270634SSteven Haigh 		goto exit;
71203270634SSteven Haigh 	}
71303270634SSteven Haigh 
7148293c568SMatthias Kaehlcke 	mutex_init(&dev->mtx);
71503270634SSteven Haigh 	spin_lock_init(&dev->buflock);
71603270634SSteven Haigh 	dev->udev = udev;
71703270634SSteven Haigh 	init_waitqueue_head(&dev->read_wait);
71803270634SSteven Haigh 	init_waitqueue_head(&dev->write_wait);
71903270634SSteven Haigh 
72003270634SSteven Haigh 	iface_desc = &interface->altsetting[0];
72103270634SSteven Haigh 
72203270634SSteven Haigh 	/* set up the endpoint information */
72303270634SSteven Haigh 	for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
72403270634SSteven Haigh 		endpoint = &iface_desc->endpoint[i].desc;
72503270634SSteven Haigh 
72603270634SSteven Haigh 		if (usb_endpoint_is_int_in(endpoint))
72703270634SSteven Haigh 			dev->interrupt_in_endpoint = endpoint;
72803270634SSteven Haigh 
72903270634SSteven Haigh 		if (usb_endpoint_is_int_out(endpoint))
73003270634SSteven Haigh 			dev->interrupt_out_endpoint = endpoint;
73103270634SSteven Haigh 	}
73203270634SSteven Haigh 	if (dev->interrupt_in_endpoint == NULL) {
73303270634SSteven Haigh 		dev_err(&interface->dev, "interrupt in endpoint not found\n");
73403270634SSteven Haigh 		goto error;
73503270634SSteven Haigh 	}
73603270634SSteven Haigh 	if (dev->interrupt_out_endpoint == NULL) {
73703270634SSteven Haigh 		dev_err(&interface->dev, "interrupt out endpoint not found\n");
73803270634SSteven Haigh 		goto error;
73903270634SSteven Haigh 	}
74003270634SSteven Haigh 
74129cc8897SKuninori Morimoto 	in_end_size = usb_endpoint_maxp(dev->interrupt_in_endpoint);
74229cc8897SKuninori Morimoto 	out_end_size = usb_endpoint_maxp(dev->interrupt_out_endpoint);
74303270634SSteven Haigh 
74403270634SSteven Haigh 	dev->read_buffer_primary = kmalloc((4 * in_end_size), GFP_KERNEL);
74503270634SSteven Haigh 	if (!dev->read_buffer_primary) {
74603270634SSteven Haigh 		dev_err(&interface->dev, "Couldn't allocate read_buffer_primary\n");
74703270634SSteven Haigh 		retval = -ENOMEM;
74803270634SSteven Haigh 		goto error;
74903270634SSteven Haigh 	}
75003270634SSteven Haigh 
75103270634SSteven Haigh 	/* debug code prime the buffer */
75203270634SSteven Haigh 	memset(dev->read_buffer_primary, 'a', in_end_size);
75303270634SSteven Haigh 	memset(dev->read_buffer_primary + in_end_size, 'b', in_end_size);
75403270634SSteven Haigh 	memset(dev->read_buffer_primary + (2 * in_end_size), 'c', in_end_size);
75503270634SSteven Haigh 	memset(dev->read_buffer_primary + (3 * in_end_size), 'd', in_end_size);
75603270634SSteven Haigh 
75703270634SSteven Haigh 	dev->read_buffer_secondary = kmalloc((4 * in_end_size), GFP_KERNEL);
75803270634SSteven Haigh 	if (!dev->read_buffer_secondary) {
75903270634SSteven Haigh 		dev_err(&interface->dev, "Couldn't allocate read_buffer_secondary\n");
76003270634SSteven Haigh 		retval = -ENOMEM;
76103270634SSteven Haigh 		goto error;
76203270634SSteven Haigh 	}
76303270634SSteven Haigh 
76403270634SSteven Haigh 	/* debug code prime the buffer */
76503270634SSteven Haigh 	memset(dev->read_buffer_secondary, 'e', in_end_size);
76603270634SSteven Haigh 	memset(dev->read_buffer_secondary + in_end_size, 'f', in_end_size);
76703270634SSteven Haigh 	memset(dev->read_buffer_secondary + (2 * in_end_size), 'g', in_end_size);
76803270634SSteven Haigh 	memset(dev->read_buffer_secondary + (3 * in_end_size), 'h', in_end_size);
76903270634SSteven Haigh 
77003270634SSteven Haigh 	dev->interrupt_in_buffer = kmalloc(in_end_size, GFP_KERNEL);
77103270634SSteven Haigh 	if (!dev->interrupt_in_buffer) {
77203270634SSteven Haigh 		dev_err(&interface->dev, "Couldn't allocate interrupt_in_buffer\n");
77303270634SSteven Haigh 		goto error;
77403270634SSteven Haigh 	}
77503270634SSteven Haigh 
77603270634SSteven Haigh 	/* debug code prime the buffer */
77703270634SSteven Haigh 	memset(dev->interrupt_in_buffer, 'i', in_end_size);
77803270634SSteven Haigh 
77903270634SSteven Haigh 	dev->interrupt_in_urb = usb_alloc_urb(0, GFP_KERNEL);
78003270634SSteven Haigh 	if (!dev->interrupt_in_urb) {
78103270634SSteven Haigh 		dev_err(&interface->dev, "Couldn't allocate interrupt_in_urb\n");
78203270634SSteven Haigh 		goto error;
78303270634SSteven Haigh 	}
78403270634SSteven Haigh 	dev->interrupt_out_buffer = kmalloc(out_end_size, GFP_KERNEL);
78503270634SSteven Haigh 	if (!dev->interrupt_out_buffer) {
78603270634SSteven Haigh 		dev_err(&interface->dev, "Couldn't allocate interrupt_out_buffer\n");
78703270634SSteven Haigh 		goto error;
78803270634SSteven Haigh 	}
78903270634SSteven Haigh 	dev->interrupt_out_urb = usb_alloc_urb(0, GFP_KERNEL);
79003270634SSteven Haigh 	if (!dev->interrupt_out_urb) {
79103270634SSteven Haigh 		dev_err(&interface->dev, "Couldn't allocate interrupt_out_urb\n");
79203270634SSteven Haigh 		goto error;
79303270634SSteven Haigh 	}
79403270634SSteven Haigh 
79503270634SSteven Haigh 	if (!usb_string(udev, udev->descriptor.iSerialNumber, dev->serial_number,
79603270634SSteven Haigh 			sizeof(dev->serial_number))) {
79703270634SSteven Haigh 		dev_err(&interface->dev, "Could not retrieve serial number\n");
79803270634SSteven Haigh 		goto error;
79903270634SSteven Haigh 	}
800*66d4bc30SGreg Kroah-Hartman 	dev_dbg(&interface->dev,"serial_number=%s", dev->serial_number);
80103270634SSteven Haigh 
80203270634SSteven Haigh 	/* we can register the device now, as it is ready */
80303270634SSteven Haigh 	usb_set_intfdata(interface, dev);
80403270634SSteven Haigh 
80503270634SSteven Haigh 	retval = usb_register_dev(interface, &adu_class);
80603270634SSteven Haigh 
80703270634SSteven Haigh 	if (retval) {
80803270634SSteven Haigh 		/* something prevented us from registering this driver */
80903270634SSteven Haigh 		dev_err(&interface->dev, "Not able to get a minor for this device.\n");
81003270634SSteven Haigh 		usb_set_intfdata(interface, NULL);
81103270634SSteven Haigh 		goto error;
81203270634SSteven Haigh 	}
81303270634SSteven Haigh 
81403270634SSteven Haigh 	dev->minor = interface->minor;
81503270634SSteven Haigh 
81603270634SSteven Haigh 	/* let the user know what node this device is now attached to */
817898eb71cSJoe Perches 	dev_info(&interface->dev, "ADU%d %s now attached to /dev/usb/adutux%d\n",
81803270634SSteven Haigh 		 udev->descriptor.idProduct, dev->serial_number,
81903270634SSteven Haigh 		 (dev->minor - ADU_MINOR_BASE));
82003270634SSteven Haigh exit:
82103270634SSteven Haigh 	return retval;
82203270634SSteven Haigh 
82303270634SSteven Haigh error:
82403270634SSteven Haigh 	adu_delete(dev);
82503270634SSteven Haigh 	return retval;
82603270634SSteven Haigh }
82703270634SSteven Haigh 
82803270634SSteven Haigh /**
82903270634SSteven Haigh  * adu_disconnect
83003270634SSteven Haigh  *
83103270634SSteven Haigh  * Called by the usb core when the device is removed from the system.
83203270634SSteven Haigh  */
83303270634SSteven Haigh static void adu_disconnect(struct usb_interface *interface)
83403270634SSteven Haigh {
83503270634SSteven Haigh 	struct adu_device *dev;
83603270634SSteven Haigh 	int minor;
83703270634SSteven Haigh 
83803270634SSteven Haigh 	dev = usb_get_intfdata(interface);
83903270634SSteven Haigh 
8408293c568SMatthias Kaehlcke 	mutex_lock(&dev->mtx);	/* not interruptible */
841f08812d5SPete Zaitcev 	dev->udev = NULL;	/* poison */
842f08812d5SPete Zaitcev 	minor = dev->minor;
843f08812d5SPete Zaitcev 	usb_deregister_dev(interface, &adu_class);
844f08812d5SPete Zaitcev 	mutex_unlock(&dev->mtx);
845f08812d5SPete Zaitcev 
846f08812d5SPete Zaitcev 	mutex_lock(&adutux_mutex);
847f08812d5SPete Zaitcev 	usb_set_intfdata(interface, NULL);
848d4ead16fSAlan Stern 
84903270634SSteven Haigh 	/* if the device is not opened, then we clean up right now */
850*66d4bc30SGreg Kroah-Hartman 	dev_dbg(&dev->udev->dev, "%s : open count %d\n",
851*66d4bc30SGreg Kroah-Hartman 		__func__, dev->open_count);
852f08812d5SPete Zaitcev 	if (!dev->open_count)
85303270634SSteven Haigh 		adu_delete(dev);
854f08812d5SPete Zaitcev 
855f08812d5SPete Zaitcev 	mutex_unlock(&adutux_mutex);
85603270634SSteven Haigh 
857898eb71cSJoe Perches 	dev_info(&interface->dev, "ADU device adutux%d now disconnected\n",
85803270634SSteven Haigh 		 (minor - ADU_MINOR_BASE));
85903270634SSteven Haigh }
86003270634SSteven Haigh 
86103270634SSteven Haigh /* usb specific object needed to register this driver with the usb subsystem */
86203270634SSteven Haigh static struct usb_driver adu_driver = {
86303270634SSteven Haigh 	.name = "adutux",
86403270634SSteven Haigh 	.probe = adu_probe,
86503270634SSteven Haigh 	.disconnect = adu_disconnect,
86603270634SSteven Haigh 	.id_table = device_table,
86703270634SSteven Haigh };
86803270634SSteven Haigh 
86965db4305SGreg Kroah-Hartman module_usb_driver(adu_driver);
87003270634SSteven Haigh 
87103270634SSteven Haigh MODULE_AUTHOR(DRIVER_AUTHOR);
87203270634SSteven Haigh MODULE_DESCRIPTION(DRIVER_DESC);
87303270634SSteven Haigh MODULE_LICENSE("GPL");
874