103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* 203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * adutux - driver for ADU devices from Ontrak Control Systems 303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * This is an experimental driver. Use at your own risk. 403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * This driver is not supported by Ontrak Control Systems. 503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * Copyright (c) 2003 John Homppi (SCO, leave this notice here) 703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * This program is free software; you can redistribute it and/or 903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * modify it under the terms of the GNU General Public License as 1003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * published by the Free Software Foundation; either version 2 of 1103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * the License, or (at your option) any later version. 1203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 1303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * derived from the Lego USB Tower driver 0.56: 1403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * Copyright (c) 2003 David Glance <davidgsf@sourceforge.net> 1503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 2001 Juergen Stuber <stuber@loria.fr> 1603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * that was derived from USB Skeleton driver - 0.5 1703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * Copyright (c) 2001 Greg Kroah-Hartman (greg@kroah.com) 1803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 1903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh */ 2003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 2103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <linux/kernel.h> 2203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <linux/errno.h> 2303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <linux/init.h> 2403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <linux/slab.h> 2503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <linux/module.h> 2603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <linux/usb.h> 278293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke#include <linux/mutex.h> 2803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#include <asm/uaccess.h> 2903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 3003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#ifdef CONFIG_USB_DEBUG 3103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic int debug = 5; 3203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#else 3303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic int debug = 1; 3403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#endif 3503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 3603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* Use our own dbg macro */ 3703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#undef dbg 3803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define dbg(lvl, format, arg...) \ 3903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighdo { \ 4003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (debug >= lvl) \ 41f45ba776da4fe6c9a9eddd42b0fd5d1f15c260f3Joe Perches printk(KERN_DEBUG "%s: " format "\n", __FILE__, ##arg); \ 4203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} while (0) 4303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 4403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 4503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* Version Information */ 4603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define DRIVER_VERSION "v0.0.13" 4703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define DRIVER_AUTHOR "John Homppi" 4803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define DRIVER_DESC "adutux (see www.ontrak.net)" 4903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 5003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* Module parameters */ 5103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighmodule_param(debug, int, S_IRUGO | S_IWUSR); 5203270634e242dd10cc8569d31a00659d25b2b8e7Steven HaighMODULE_PARM_DESC(debug, "Debug enabled or not"); 5303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 5403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* Define these values to match your device */ 5503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define ADU_VENDOR_ID 0x0a07 5603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define ADU_PRODUCT_ID 0x0064 5703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 5803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* table of devices that work with this driver */ 5933b9e16243fd69493be3ddda7be73226c8be586aNémeth Mártonstatic const struct usb_device_id device_table[] = { 6003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID) }, /* ADU100 */ 6103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+20) }, /* ADU120 */ 6203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+30) }, /* ADU130 */ 6303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+100) }, /* ADU200 */ 6403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+108) }, /* ADU208 */ 6503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { USB_DEVICE(ADU_VENDOR_ID, ADU_PRODUCT_ID+118) }, /* ADU218 */ 6603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh { }/* Terminating entry */ 6703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh}; 6803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 6903270634e242dd10cc8569d31a00659d25b2b8e7Steven HaighMODULE_DEVICE_TABLE(usb, device_table); 7003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 7103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#ifdef CONFIG_USB_DYNAMIC_MINORS 7203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define ADU_MINOR_BASE 0 7303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#else 7403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define ADU_MINOR_BASE 67 7503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#endif 7603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 7703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* we can have up to this number of device plugged in at once */ 7803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define MAX_DEVICES 16 7903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 8003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh#define COMMAND_TIMEOUT (2*HZ) /* 60 second timeout for a command */ 8103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 82f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev/* 83f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * The locking scheme is a vanilla 3-lock: 84f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * adu_device.buflock: A spinlock, covers what IRQs touch. 85f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * adutux_mutex: A Static lock to cover open_count. It would also cover 86f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * any globals, but we don't have them in 2.6. 87f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * adu_device.mtx: A mutex to hold across sleepers like copy_from_user. 88f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * It covers all of adu_device, except the open_count 89f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev * and what .buflock covers. 90f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev */ 91f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 9203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* Structure to hold all of our device specific stuff */ 9303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstruct adu_device { 94f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev struct mutex mtx; 9503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_device* udev; /* save off the usb device pointer */ 9603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_interface* interface; 97f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev unsigned int minor; /* the starting minor number for this device */ 9803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh char serial_number[8]; 9903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 10003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int open_count; /* number of times this port has been opened */ 10103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 10203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh char* read_buffer_primary; 10303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int read_buffer_length; 10403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh char* read_buffer_secondary; 10503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int secondary_head; 10603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int secondary_tail; 10703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spinlock_t buflock; 10803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 10903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh wait_queue_head_t read_wait; 11003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh wait_queue_head_t write_wait; 11103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 11203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh char* interrupt_in_buffer; 11303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_endpoint_descriptor* interrupt_in_endpoint; 11403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct urb* interrupt_in_urb; 11503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int read_urb_finished; 11603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 11703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh char* interrupt_out_buffer; 11803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_endpoint_descriptor* interrupt_out_endpoint; 11903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct urb* interrupt_out_urb; 120f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev int out_urb_finished; 12103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh}; 12203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 123f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcevstatic DEFINE_MUTEX(adutux_mutex); 124f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 12503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic struct usb_driver adu_driver; 12603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 12703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic void adu_debug_data(int level, const char *function, int size, 12803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh const unsigned char *data) 12903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 13003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int i; 13103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 13203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (debug < level) 13303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return; 13403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 135f45ba776da4fe6c9a9eddd42b0fd5d1f15c260f3Joe Perches printk(KERN_DEBUG "%s: %s - length = %d, data = ", 136f45ba776da4fe6c9a9eddd42b0fd5d1f15c260f3Joe Perches __FILE__, function, size); 13703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh for (i = 0; i < size; ++i) 13803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh printk("%.2x ", data[i]); 13903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh printk("\n"); 14003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 14103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 14203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/** 14303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * adu_abort_transfers 14403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * aborts transfers and frees associated data structures 14503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh */ 14603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic void adu_abort_transfers(struct adu_device *dev) 14703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 148f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev unsigned long flags; 14903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 150441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter", __func__); 15103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 15203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->udev == NULL) { 153441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : udev is null", __func__); 15403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 15503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 15603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 15703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* shutdown transfer */ 158f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 159f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* XXX Anchor these instead */ 160f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_lock_irqsave(&dev->buflock, flags); 161f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->read_urb_finished) { 162f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 163f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev usb_kill_urb(dev->interrupt_in_urb); 164f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } else 165f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 166f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 167f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_lock_irqsave(&dev->buflock, flags); 168f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->out_urb_finished) { 169f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 170f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev usb_kill_urb(dev->interrupt_out_urb); 171f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } else 172f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 17303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 17403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit: 175441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave", __func__); 17603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 17703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 17803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic void adu_delete(struct adu_device *dev) 17903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 180441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2, "%s enter", __func__); 18103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 18203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* free data structures */ 18303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_free_urb(dev->interrupt_in_urb); 18403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_free_urb(dev->interrupt_out_urb); 18503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh kfree(dev->read_buffer_primary); 18603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh kfree(dev->read_buffer_secondary); 18703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh kfree(dev->interrupt_in_buffer); 18803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh kfree(dev->interrupt_out_buffer); 18903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh kfree(dev); 19003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 191441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2, "%s : leave", __func__); 19203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 19303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 1947d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic void adu_interrupt_in_callback(struct urb *urb) 19503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 19603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev = urb->context; 19724497a00114ef42a752d614635168db9e2192f5eGreg Kroah-Hartman int status = urb->status; 19803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 199441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(4," %s : enter, status %d", __func__, status); 200441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison adu_debug_data(5, __func__, urb->actual_length, 20103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh urb->transfer_buffer); 20203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 20303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spin_lock(&dev->buflock); 20403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 20524497a00114ef42a752d614635168db9e2192f5eGreg Kroah-Hartman if (status != 0) { 206f6c1ceaa3844b7a7787816cc97d15b9fea8b0909Oliver Neukum if ((status != -ENOENT) && (status != -ECONNRESET) && 207f6c1ceaa3844b7a7787816cc97d15b9fea8b0909Oliver Neukum (status != -ESHUTDOWN)) { 20803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dbg(1," %s : nonzero status received: %d", 209441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison __func__, status); 21003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 21103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 21203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 21303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 21403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (urb->actual_length > 0 && dev->interrupt_in_buffer[0] != 0x00) { 21503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->read_buffer_length < 21629cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto (4 * usb_endpoint_maxp(dev->interrupt_in_endpoint)) - 21703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh (urb->actual_length)) { 21803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memcpy (dev->read_buffer_primary + 21903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_length, 22003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_buffer, urb->actual_length); 22103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 22203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_length += urb->actual_length; 223441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s reading %d ", __func__, 22403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh urb->actual_length); 22503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } else { 226441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : read_buffer overflow", __func__); 22703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 22803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 22903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 23003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit: 23103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_urb_finished = 1; 23203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spin_unlock(&dev->buflock); 23303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* always wake up so we recover from errors */ 23403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh wake_up_interruptible(&dev->read_wait); 235441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison adu_debug_data(5, __func__, urb->actual_length, 23603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh urb->transfer_buffer); 237441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(4," %s : leave, status %d", __func__, status); 23803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 23903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 2407d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic void adu_interrupt_out_callback(struct urb *urb) 24103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 24203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev = urb->context; 24324497a00114ef42a752d614635168db9e2192f5eGreg Kroah-Hartman int status = urb->status; 24403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 245441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(4," %s : enter, status %d", __func__, status); 246441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison adu_debug_data(5,__func__, urb->actual_length, urb->transfer_buffer); 24703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 24824497a00114ef42a752d614635168db9e2192f5eGreg Kroah-Hartman if (status != 0) { 24924497a00114ef42a752d614635168db9e2192f5eGreg Kroah-Hartman if ((status != -ENOENT) && 25024497a00114ef42a752d614635168db9e2192f5eGreg Kroah-Hartman (status != -ECONNRESET)) { 25103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dbg(1, " %s :nonzero status received: %d", 252441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison __func__, status); 25303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 25403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 25503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 25603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 257f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_lock(&dev->buflock); 258f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->out_urb_finished = 1; 259f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev wake_up(&dev->write_wait); 260f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock(&dev->buflock); 26103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit: 26203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 263441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison adu_debug_data(5, __func__, urb->actual_length, 26403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh urb->transfer_buffer); 265441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(4," %s : leave, status %d", __func__, status); 26603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 26703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 26803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic int adu_open(struct inode *inode, struct file *file) 26903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 27003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev = NULL; 27103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_interface *interface; 27203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int subminor; 273f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev int retval; 27403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 275441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2,"%s : enter", __func__); 27603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 27703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh subminor = iminor(inode); 27803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 279f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if ((retval = mutex_lock_interruptible(&adutux_mutex))) { 280441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2, "%s : mutex lock failed", __func__); 281f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev goto exit_no_lock; 282f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } 283f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 28403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh interface = usb_find_interface(&adu_driver, subminor); 28503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!interface) { 286fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman printk(KERN_ERR "adutux: %s - error, can't find device for " 287fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman "minor %d\n", __func__, subminor); 28803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 28903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit_no_device; 29003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 29103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 29203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev = usb_get_intfdata(interface); 293f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev || !dev->udev) { 29403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 29503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit_no_device; 29603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 29703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 298f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* check that nobody else is using the device */ 299f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (dev->open_count) { 300f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev retval = -EBUSY; 30103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit_no_device; 30203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 30303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 30403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh ++dev->open_count; 305441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2,"%s : open count %d", __func__, dev->open_count); 30603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 30703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* save device in the file's private structure */ 30803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh file->private_data = dev; 30903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 310f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* initialize in direction */ 311f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->read_buffer_length = 0; 31203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 313f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* fixup first read by having urb waiting for it */ 314f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev usb_fill_int_urb(dev->interrupt_in_urb,dev->udev, 315f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev usb_rcvintpipe(dev->udev, 316f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->interrupt_in_endpoint->bEndpointAddress), 317f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->interrupt_in_buffer, 31829cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto usb_endpoint_maxp(dev->interrupt_in_endpoint), 319f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev adu_interrupt_in_callback, dev, 320f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->interrupt_in_endpoint->bInterval); 321f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->read_urb_finished = 0; 322f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (usb_submit_urb(dev->interrupt_in_urb, GFP_KERNEL)) 323f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->read_urb_finished = 1; 324f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* we ignore failure */ 325f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* end of fixup for first read */ 326f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 327f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev /* initialize out direction */ 328f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->out_urb_finished = 1; 329f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 330f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev retval = 0; 33103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 33203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit_no_device: 333f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_unlock(&adutux_mutex); 334f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcevexit_no_lock: 335441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2,"%s : leave, return value %d ", __func__, retval); 33603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return retval; 33703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 33803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 339f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcevstatic void adu_release_internal(struct adu_device *dev) 34003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 341441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter", __func__); 34203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 34303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* decrement our usage count for the device */ 34403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh --dev->open_count; 345441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : open count %d", __func__, dev->open_count); 34603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->open_count <= 0) { 34703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh adu_abort_transfers(dev); 34803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->open_count = 0; 34903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 35003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 351441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave", __func__); 35203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 35303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 35403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic int adu_release(struct inode *inode, struct file *file) 35503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 356f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev struct adu_device *dev; 35703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int retval = 0; 35803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 359441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter", __func__); 36003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 36103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (file == NULL) { 362441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : file is NULL", __func__); 36303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 36403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 36503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 36603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 36703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev = file->private_data; 36803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev == NULL) { 369441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : object is NULL", __func__); 37003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 37103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 37203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 37303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 374f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_lock(&adutux_mutex); /* not interruptible */ 37503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 37603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->open_count <= 0) { 377441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : device not opened", __func__); 37803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 37946c9844c4014be53c67622dcd3ba4302f36e9cacJiri Slaby goto unlock; 38003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 38103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 382f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev adu_release_internal(dev); 383d4ead16f50f9ad30bdc7276ec8fee7a24c72f294Alan Stern if (dev->udev == NULL) { 384d4ead16f50f9ad30bdc7276ec8fee7a24c72f294Alan Stern /* the device was unplugged before the file was released */ 385f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->open_count) /* ... and we're the last user */ 386f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev adu_delete(dev); 387d4ead16f50f9ad30bdc7276ec8fee7a24c72f294Alan Stern } 38846c9844c4014be53c67622dcd3ba4302f36e9cacJiri Slabyunlock: 389f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_unlock(&adutux_mutex); 39046c9844c4014be53c67622dcd3ba4302f36e9cacJiri Slabyexit: 391441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave, return value %d", __func__, retval); 39203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return retval; 39303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 39403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 39503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic ssize_t adu_read(struct file *file, __user char *buffer, size_t count, 39603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh loff_t *ppos) 39703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 39803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev; 39903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh size_t bytes_read = 0; 40003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh size_t bytes_to_read = count; 40103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int i; 40203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int retval = 0; 40303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int timeout = 0; 40403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int should_submit = 0; 40503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh unsigned long flags; 40603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh DECLARE_WAITQUEUE(wait, current); 40703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 408441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter, count = %Zd, file=%p", __func__, count, file); 40903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 41003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev = file->private_data; 411441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : dev=%p", __func__, dev); 412f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 4138293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke if (mutex_lock_interruptible(&dev->mtx)) 41403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return -ERESTARTSYS; 41503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 41603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* verify that the device wasn't unplugged */ 417f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (dev->udev == NULL) { 41803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 419fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman printk(KERN_ERR "adutux: No device or device unplugged %d\n", 420fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman retval); 42103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 42203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 42303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 42403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* verify that some data was requested */ 42503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (count == 0) { 426441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : read request of 0 bytes", __func__); 42703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 42803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 42903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 43003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh timeout = COMMAND_TIMEOUT; 431441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : about to start looping", __func__); 43203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh while (bytes_to_read) { 43303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int data_in_secondary = dev->secondary_tail - dev->secondary_head; 43403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dbg(2," %s : while, data_in_secondary=%d, status=%d", 435441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison __func__, data_in_secondary, 43603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_urb->status); 43703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 43803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (data_in_secondary) { 43903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* drain secondary buffer */ 44003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int amount = bytes_to_read < data_in_secondary ? bytes_to_read : data_in_secondary; 44103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh i = copy_to_user(buffer, dev->read_buffer_secondary+dev->secondary_head, amount); 4421865a9c382ede507065cf1575308b53495814c7dKulikov Vasiliy if (i) { 44303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -EFAULT; 44403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 44503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 44603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->secondary_head += (amount - i); 44703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh bytes_read += (amount - i); 44803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh bytes_to_read -= (amount - i); 44903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (i) { 45003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = bytes_read ? bytes_read : -EFAULT; 45103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 45203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 45303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } else { 45403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we check the primary buffer */ 45503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spin_lock_irqsave (&dev->buflock, flags); 45603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->read_buffer_length) { 45703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we secure access to the primary */ 45803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh char *tmp; 45903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dbg(2," %s : swap, read_buffer_length = %d", 460441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison __func__, dev->read_buffer_length); 46103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh tmp = dev->read_buffer_secondary; 46203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_secondary = dev->read_buffer_primary; 46303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_primary = tmp; 46403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->secondary_head = 0; 46503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->secondary_tail = dev->read_buffer_length; 46603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_length = 0; 46703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spin_unlock_irqrestore(&dev->buflock, flags); 46803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we have a free buffer so use it */ 46903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh should_submit = 1; 47003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } else { 47103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* even the primary was empty - we may need to do IO */ 472f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->read_urb_finished) { 47303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* somebody is doing IO */ 47403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spin_unlock_irqrestore(&dev->buflock, flags); 475441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : submitted already", __func__); 47603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } else { 47703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we must initiate input */ 478441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : initiate input", __func__); 47903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_urb_finished = 0; 480f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 48103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 48203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_fill_int_urb(dev->interrupt_in_urb,dev->udev, 48303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_rcvintpipe(dev->udev, 48403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_endpoint->bEndpointAddress), 48503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_buffer, 48629cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto usb_endpoint_maxp(dev->interrupt_in_endpoint), 48703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh adu_interrupt_in_callback, 48803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev, 48903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_endpoint->bInterval); 490f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev retval = usb_submit_urb(dev->interrupt_in_urb, GFP_KERNEL); 491f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (retval) { 492f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->read_urb_finished = 1; 49303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (retval == -ENOMEM) { 49403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = bytes_read ? bytes_read : -ENOMEM; 49503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 496441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : submit failed", __func__); 49703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 49803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 49903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 50003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 50103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we wait for I/O to complete */ 50203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh set_current_state(TASK_INTERRUPTIBLE); 50303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh add_wait_queue(&dev->read_wait, &wait); 504f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_lock_irqsave(&dev->buflock, flags); 505f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->read_urb_finished) { 506f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 50703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh timeout = schedule_timeout(COMMAND_TIMEOUT); 508f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } else { 509f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 51003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh set_current_state(TASK_RUNNING); 511f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } 51203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh remove_wait_queue(&dev->read_wait, &wait); 51303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 51403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (timeout <= 0) { 515441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : timeout", __func__); 51603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = bytes_read ? bytes_read : -ETIMEDOUT; 51703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 51803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 51903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 52003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (signal_pending(current)) { 521441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : signal pending", __func__); 52203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = bytes_read ? bytes_read : -EINTR; 52303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 52403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 52503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 52603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 52703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 52803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 52903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = bytes_read; 53003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* if the primary buffer is empty then use it */ 531f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_lock_irqsave(&dev->buflock, flags); 532f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (should_submit && dev->read_urb_finished) { 533f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->read_urb_finished = 0; 534f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 53503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_fill_int_urb(dev->interrupt_in_urb,dev->udev, 53603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_rcvintpipe(dev->udev, 53703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_endpoint->bEndpointAddress), 538f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->interrupt_in_buffer, 53929cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto usb_endpoint_maxp(dev->interrupt_in_endpoint), 540f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev adu_interrupt_in_callback, 541f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev, 542f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->interrupt_in_endpoint->bInterval); 543f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (usb_submit_urb(dev->interrupt_in_urb, GFP_KERNEL) != 0) 544f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->read_urb_finished = 1; 54503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we ignore failure */ 546f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } else { 547f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 54803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 54903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 55003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit: 55103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* unlock the device */ 5528293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke mutex_unlock(&dev->mtx); 55303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 554441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave, return value %d", __func__, retval); 55503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return retval; 55603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 55703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 55803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic ssize_t adu_write(struct file *file, const __user char *buffer, 55903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh size_t count, loff_t *ppos) 56003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 561f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev DECLARE_WAITQUEUE(waita, current); 56203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev; 56303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh size_t bytes_written = 0; 56403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh size_t bytes_to_write; 56503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh size_t buffer_size; 566f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev unsigned long flags; 567ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum int retval; 56803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 569441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter, count = %Zd", __func__, count); 57003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 57103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev = file->private_data; 57203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 5738293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke retval = mutex_lock_interruptible(&dev->mtx); 574ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum if (retval) 575ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum goto exit_nolock; 57603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 57703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* verify that the device wasn't unplugged */ 578f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (dev->udev == NULL) { 57903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENODEV; 580fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman printk(KERN_ERR "adutux: No device or device unplugged %d\n", 581fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman retval); 58203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 58303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 58403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 58503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* verify that we actually have some data to write */ 58603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (count == 0) { 587441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : write request of 0 bytes", __func__); 58803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 58903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 59003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 59103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh while (count > 0) { 592f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev add_wait_queue(&dev->write_wait, &waita); 593f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev set_current_state(TASK_INTERRUPTIBLE); 594f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_lock_irqsave(&dev->buflock, flags); 595f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->out_urb_finished) { 596f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 59703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 598f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_unlock(&dev->mtx); 599f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (signal_pending(current)) { 600441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1," %s : interrupted", __func__); 601f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev set_current_state(TASK_RUNNING); 60203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -EINTR; 603f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev goto exit_onqueue; 60403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 605f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (schedule_timeout(COMMAND_TIMEOUT) == 0) { 606441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(1, "%s - command timed out.", __func__); 607f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev retval = -ETIMEDOUT; 608f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev goto exit_onqueue; 609f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev } 610f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev remove_wait_queue(&dev->write_wait, &waita); 6118293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke retval = mutex_lock_interruptible(&dev->mtx); 612ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum if (retval) { 613ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum retval = bytes_written ? bytes_written : retval; 614ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum goto exit_nolock; 615ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukum } 61603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 617441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(4," %s : in progress, count = %Zd", __func__, count); 61803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } else { 619f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev spin_unlock_irqrestore(&dev->buflock, flags); 620f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev set_current_state(TASK_RUNNING); 621f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev remove_wait_queue(&dev->write_wait, &waita); 622441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(4," %s : sending, count = %Zd", __func__, count); 62303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 62403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* write the data into interrupt_out_buffer from userspace */ 62529cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto buffer_size = usb_endpoint_maxp(dev->interrupt_out_endpoint); 62603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh bytes_to_write = count > buffer_size ? buffer_size : count; 62703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dbg(4," %s : buffer_size = %Zd, count = %Zd, bytes_to_write = %Zd", 628441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison __func__, buffer_size, count, bytes_to_write); 62903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 63003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (copy_from_user(dev->interrupt_out_buffer, buffer, bytes_to_write) != 0) { 63103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -EFAULT; 63203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 63303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 63403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 63503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* send off the urb */ 63603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_fill_int_urb( 63703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_out_urb, 63803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->udev, 63903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_sndintpipe(dev->udev, dev->interrupt_out_endpoint->bEndpointAddress), 64003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_out_buffer, 64103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh bytes_to_write, 64203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh adu_interrupt_out_callback, 64303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev, 644f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->interrupt_out_endpoint->bInterval); 64503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_out_urb->actual_length = bytes_to_write; 646f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->out_urb_finished = 0; 64703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = usb_submit_urb(dev->interrupt_out_urb, GFP_KERNEL); 64803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (retval < 0) { 649f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->out_urb_finished = 1; 650fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman dev_err(&dev->udev->dev, "Couldn't submit " 651fd3f1917e345d852ef9ae36178719f4e639f70aeGreg Kroah-Hartman "interrupt_out_urb %d\n", retval); 65203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 65303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 65403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 65503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh buffer += bytes_to_write; 65603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh count -= bytes_to_write; 65703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 65803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh bytes_written += bytes_to_write; 65903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 66003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 661f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_unlock(&dev->mtx); 662f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev return bytes_written; 66303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 66403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit: 6658293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke mutex_unlock(&dev->mtx); 666ebc3ac149bf3a20c235625f1c07e0f997b3e08baOliver Neukumexit_nolock: 667441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave, return value %d", __func__, retval); 668f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev return retval; 66903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 670f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcevexit_onqueue: 671f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev remove_wait_queue(&dev->write_wait, &waita); 67203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return retval; 67303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 67403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 67503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* file operations needed when we register this driver */ 67600977a59b951207d38380c75f03a36829950265cArjan van de Venstatic const struct file_operations adu_fops = { 67703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .owner = THIS_MODULE, 67803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .read = adu_read, 67903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .write = adu_write, 68003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .open = adu_open, 68103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .release = adu_release, 6826038f373a3dc1f1c26496e60b6c40b164716f07eArnd Bergmann .llseek = noop_llseek, 68303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh}; 68403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 68503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* 68603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * usb class driver info in order to get a minor number from the usb core, 68703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * and to have the device registered with devfs and the driver core 68803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh */ 68903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic struct usb_class_driver adu_class = { 69003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .name = "usb/adutux%d", 69103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .fops = &adu_fops, 69203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .minor_base = ADU_MINOR_BASE, 69303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh}; 69403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 69503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/** 69603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * adu_probe 69703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 69803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * Called by the usb core when a new device is connected that it thinks 69903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * this driver might be interested in. 70003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh */ 70103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic int adu_probe(struct usb_interface *interface, 70203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh const struct usb_device_id *id) 70303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 70403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_device *udev = interface_to_usbdev(interface); 70503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev = NULL; 70603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_host_interface *iface_desc; 70703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct usb_endpoint_descriptor *endpoint; 70803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int retval = -ENODEV; 70903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int in_end_size; 71003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int out_end_size; 71103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int i; 71203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 713441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter", __func__); 71403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 71503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (udev == NULL) { 71603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "udev is NULL.\n"); 71703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 71803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 71903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 720b595076a180a56d1bb170e6eceda6eb9d76f4cd3Uwe Kleine-König /* allocate memory for our device state and initialize it */ 72103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev = kzalloc(sizeof(struct adu_device), GFP_KERNEL); 72203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev == NULL) { 72303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Out of memory\n"); 72403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENOMEM; 72503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto exit; 72603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 72703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 7288293c568b25611cdc4ac54ded438d8d7938c593cMatthias Kaehlcke mutex_init(&dev->mtx); 72903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh spin_lock_init(&dev->buflock); 73003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->udev = udev; 73103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh init_waitqueue_head(&dev->read_wait); 73203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh init_waitqueue_head(&dev->write_wait); 73303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 73403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh iface_desc = &interface->altsetting[0]; 73503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 73603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* set up the endpoint information */ 73703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) { 73803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh endpoint = &iface_desc->endpoint[i].desc; 73903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 74003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (usb_endpoint_is_int_in(endpoint)) 74103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_endpoint = endpoint; 74203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 74303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (usb_endpoint_is_int_out(endpoint)) 74403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_out_endpoint = endpoint; 74503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 74603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->interrupt_in_endpoint == NULL) { 74703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "interrupt in endpoint not found\n"); 74803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 74903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 75003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (dev->interrupt_out_endpoint == NULL) { 75103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "interrupt out endpoint not found\n"); 75203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 75303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 75403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 75529cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto in_end_size = usb_endpoint_maxp(dev->interrupt_in_endpoint); 75629cc88979a8818cd8c5019426e945aed118b400eKuninori Morimoto out_end_size = usb_endpoint_maxp(dev->interrupt_out_endpoint); 75703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 75803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_primary = kmalloc((4 * in_end_size), GFP_KERNEL); 75903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!dev->read_buffer_primary) { 76003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Couldn't allocate read_buffer_primary\n"); 76103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENOMEM; 76203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 76303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 76403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 76503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* debug code prime the buffer */ 76603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_primary, 'a', in_end_size); 76703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_primary + in_end_size, 'b', in_end_size); 76803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_primary + (2 * in_end_size), 'c', in_end_size); 76903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_primary + (3 * in_end_size), 'd', in_end_size); 77003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 77103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->read_buffer_secondary = kmalloc((4 * in_end_size), GFP_KERNEL); 77203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!dev->read_buffer_secondary) { 77303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Couldn't allocate read_buffer_secondary\n"); 77403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = -ENOMEM; 77503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 77603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 77703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 77803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* debug code prime the buffer */ 77903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_secondary, 'e', in_end_size); 78003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_secondary + in_end_size, 'f', in_end_size); 78103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_secondary + (2 * in_end_size), 'g', in_end_size); 78203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->read_buffer_secondary + (3 * in_end_size), 'h', in_end_size); 78303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 78403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_buffer = kmalloc(in_end_size, GFP_KERNEL); 78503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!dev->interrupt_in_buffer) { 78603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Couldn't allocate interrupt_in_buffer\n"); 78703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 78803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 78903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 79003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* debug code prime the buffer */ 79103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh memset(dev->interrupt_in_buffer, 'i', in_end_size); 79203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 79303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_in_urb = usb_alloc_urb(0, GFP_KERNEL); 79403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!dev->interrupt_in_urb) { 79503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Couldn't allocate interrupt_in_urb\n"); 79603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 79703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 79803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_out_buffer = kmalloc(out_end_size, GFP_KERNEL); 79903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!dev->interrupt_out_buffer) { 80003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Couldn't allocate interrupt_out_buffer\n"); 80103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 80203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 80303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->interrupt_out_urb = usb_alloc_urb(0, GFP_KERNEL); 80403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!dev->interrupt_out_urb) { 80503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Couldn't allocate interrupt_out_urb\n"); 80603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 80703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 80803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 80903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (!usb_string(udev, udev->descriptor.iSerialNumber, dev->serial_number, 81003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh sizeof(dev->serial_number))) { 81103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Could not retrieve serial number\n"); 81203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 81303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 814441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : serial_number=%s", __func__, dev->serial_number); 81503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 81603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* we can register the device now, as it is ready */ 81703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_set_intfdata(interface, dev); 81803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 81903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh retval = usb_register_dev(interface, &adu_class); 82003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 82103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh if (retval) { 82203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* something prevented us from registering this driver */ 82303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev_err(&interface->dev, "Not able to get a minor for this device.\n"); 82403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_set_intfdata(interface, NULL); 82503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh goto error; 82603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh } 82703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 82803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev->minor = interface->minor; 82903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 83003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* let the user know what node this device is now attached to */ 831898eb71cb17644964c5895fb190e79e3d0c49679Joe Perches dev_info(&interface->dev, "ADU%d %s now attached to /dev/usb/adutux%d\n", 83203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh udev->descriptor.idProduct, dev->serial_number, 83303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh (dev->minor - ADU_MINOR_BASE)); 83403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighexit: 835441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave, return value %p (dev)", __func__, dev); 83603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 83703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return retval; 83803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 83903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigherror: 84003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh adu_delete(dev); 84103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh return retval; 84203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 84303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 84403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/** 84503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * adu_disconnect 84603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * 84703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh * Called by the usb core when the device is removed from the system. 84803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh */ 84903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic void adu_disconnect(struct usb_interface *interface) 85003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh{ 85103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh struct adu_device *dev; 85203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh int minor; 85303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 854441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : enter", __func__); 85503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 85603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh dev = usb_get_intfdata(interface); 85703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 858f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_lock(&dev->mtx); /* not interruptible */ 859f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev dev->udev = NULL; /* poison */ 86003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh minor = dev->minor; 86103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh usb_deregister_dev(interface, &adu_class); 862f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_unlock(&dev->mtx); 86303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 864f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_lock(&adutux_mutex); 865f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev usb_set_intfdata(interface, NULL); 866d4ead16f50f9ad30bdc7276ec8fee7a24c72f294Alan Stern 86703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh /* if the device is not opened, then we clean up right now */ 868441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : open count %d", __func__, dev->open_count); 869f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev if (!dev->open_count) 87003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh adu_delete(dev); 871f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev 872f08812d5eb8f8cd1a5bd5f5c26a96eb93d97ab69Pete Zaitcev mutex_unlock(&adutux_mutex); 87303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 874898eb71cb17644964c5895fb190e79e3d0c49679Joe Perches dev_info(&interface->dev, "ADU device adutux%d now disconnected\n", 87503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh (minor - ADU_MINOR_BASE)); 87603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 877441b62c1edb986827154768d89bbac0ba779984fHarvey Harrison dbg(2," %s : leave", __func__); 87803270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh} 87903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 88003270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh/* usb specific object needed to register this driver with the usb subsystem */ 88103270634e242dd10cc8569d31a00659d25b2b8e7Steven Haighstatic struct usb_driver adu_driver = { 88203270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .name = "adutux", 88303270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .probe = adu_probe, 88403270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .disconnect = adu_disconnect, 88503270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh .id_table = device_table, 88603270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh}; 88703270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 88865db43054065790a75291b0834657445fea2cf56Greg Kroah-Hartmanmodule_usb_driver(adu_driver); 88903270634e242dd10cc8569d31a00659d25b2b8e7Steven Haigh 89003270634e242dd10cc8569d31a00659d25b2b8e7Steven HaighMODULE_AUTHOR(DRIVER_AUTHOR); 89103270634e242dd10cc8569d31a00659d25b2b8e7Steven HaighMODULE_DESCRIPTION(DRIVER_DESC); 89203270634e242dd10cc8569d31a00659d25b2b8e7Steven HaighMODULE_LICENSE("GPL"); 893