Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * LEGO USB Tower driver |
| 3 | * |
| 4 | * Copyright (C) 2003 David Glance <davidgsf@sourceforge.net> |
| 5 | * 2001-2004 Juergen Stuber <starblue@users.sourceforge.net> |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or |
| 8 | * modify it under the terms of the GNU General Public License as |
| 9 | * published by the Free Software Foundation; either version 2 of |
| 10 | * the License, or (at your option) any later version. |
| 11 | * |
| 12 | * derived from USB Skeleton driver - 0.5 |
| 13 | * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com) |
| 14 | * |
| 15 | * History: |
| 16 | * |
| 17 | * 2001-10-13 - 0.1 js |
| 18 | * - first version |
| 19 | * 2001-11-03 - 0.2 js |
| 20 | * - simplified buffering, one-shot URBs for writing |
| 21 | * 2001-11-10 - 0.3 js |
| 22 | * - removed IOCTL (setting power/mode is more complicated, postponed) |
| 23 | * 2001-11-28 - 0.4 js |
| 24 | * - added vendor commands for mode of operation and power level in open |
| 25 | * 2001-12-04 - 0.5 js |
| 26 | * - set IR mode by default (by oversight 0.4 set VLL mode) |
| 27 | * 2002-01-11 - 0.5? pcchan |
| 28 | * - make read buffer reusable and work around bytes_to_write issue between |
| 29 | * uhci and legusbtower |
| 30 | * 2002-09-23 - 0.52 david (david@csse.uwa.edu.au) |
| 31 | * - imported into lejos project |
| 32 | * - changed wake_up to wake_up_interruptible |
| 33 | * - changed to use lego0 rather than tower0 |
Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 34 | * - changed dbg() to use __func__ rather than deprecated __func__ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | * 2003-01-12 - 0.53 david (david@csse.uwa.edu.au) |
| 36 | * - changed read and write to write everything or |
| 37 | * timeout (from a patch by Chris Riesen and Brett Thaeler driver) |
| 38 | * - added ioctl functionality to set timeouts |
| 39 | * 2003-07-18 - 0.54 davidgsf (david@csse.uwa.edu.au) |
| 40 | * - initial import into LegoUSB project |
| 41 | * - merge of existing LegoUSB.c driver |
| 42 | * 2003-07-18 - 0.56 davidgsf (david@csse.uwa.edu.au) |
| 43 | * - port to 2.6 style driver |
| 44 | * 2004-02-29 - 0.6 Juergen Stuber <starblue@users.sourceforge.net> |
| 45 | * - fix locking |
| 46 | * - unlink read URBs which are no longer needed |
| 47 | * - allow increased buffer size, eliminates need for timeout on write |
| 48 | * - have read URB running continuously |
| 49 | * - added poll |
| 50 | * - forbid seeking |
| 51 | * - added nonblocking I/O |
Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 52 | * - changed back __func__ to __func__ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | * - read and log tower firmware version |
| 54 | * - reset tower on probe, avoids failure of first write |
| 55 | * 2004-03-09 - 0.7 Juergen Stuber <starblue@users.sourceforge.net> |
| 56 | * - timeout read now only after inactivity, shorten default accordingly |
| 57 | * 2004-03-11 - 0.8 Juergen Stuber <starblue@users.sourceforge.net> |
| 58 | * - log major, minor instead of possibly confusing device filename |
| 59 | * - whitespace cleanup |
| 60 | * 2004-03-12 - 0.9 Juergen Stuber <starblue@users.sourceforge.net> |
| 61 | * - normalize whitespace in debug messages |
| 62 | * - take care about endianness in control message responses |
| 63 | * 2004-03-13 - 0.91 Juergen Stuber <starblue@users.sourceforge.net> |
| 64 | * - make default intervals longer to accommodate current EHCI driver |
| 65 | * 2004-03-19 - 0.92 Juergen Stuber <starblue@users.sourceforge.net> |
| 66 | * - replaced atomic_t by memory barriers |
| 67 | * 2004-04-21 - 0.93 Juergen Stuber <starblue@users.sourceforge.net> |
| 68 | * - wait for completion of write urb in release (needed for remotecontrol) |
| 69 | * - corrected poll for write direction (missing negation) |
| 70 | * 2004-04-22 - 0.94 Juergen Stuber <starblue@users.sourceforge.net> |
| 71 | * - make device locking interruptible |
| 72 | * 2004-04-30 - 0.95 Juergen Stuber <starblue@users.sourceforge.net> |
| 73 | * - check for valid udev on resubmitting and unlinking urbs |
| 74 | * 2004-08-03 - 0.96 Juergen Stuber <starblue@users.sourceforge.net> |
| 75 | * - move reset into open to clean out spurious data |
| 76 | */ |
| 77 | |
Greg Kroah-Hartman | 38726bf | 2013-06-26 16:30:42 -0700 | [diff] [blame] | 78 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 79 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 80 | #include <linux/kernel.h> |
| 81 | #include <linux/errno.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | #include <linux/slab.h> |
| 83 | #include <linux/module.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | #include <linux/completion.h> |
Arjan van de Ven | 4186ecf | 2006-01-11 15:55:29 +0100 | [diff] [blame] | 85 | #include <linux/mutex.h> |
Linus Torvalds | 7c0f6ba | 2016-12-24 11:46:01 -0800 | [diff] [blame] | 86 | #include <linux/uaccess.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | #include <linux/usb.h> |
| 88 | #include <linux/poll.h> |
| 89 | |
| 90 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 91 | #define DRIVER_AUTHOR "Juergen Stuber <starblue@sourceforge.net>" |
| 92 | #define DRIVER_DESC "LEGO USB Tower Driver" |
| 93 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | |
| 95 | /* The defaults are chosen to work with the latest versions of leJOS and NQC. |
| 96 | */ |
| 97 | |
| 98 | /* Some legacy software likes to receive packets in one piece. |
| 99 | * In this case read_buffer_size should exceed the maximal packet length |
| 100 | * (417 for datalog uploads), and packet_timeout should be set. |
| 101 | */ |
| 102 | static int read_buffer_size = 480; |
| 103 | module_param(read_buffer_size, int, 0); |
| 104 | MODULE_PARM_DESC(read_buffer_size, "Read buffer size"); |
| 105 | |
| 106 | /* Some legacy software likes to send packets in one piece. |
| 107 | * In this case write_buffer_size should exceed the maximal packet length |
| 108 | * (417 for firmware and program downloads). |
| 109 | * A problem with long writes is that the following read may time out |
| 110 | * if the software is not prepared to wait long enough. |
| 111 | */ |
| 112 | static int write_buffer_size = 480; |
| 113 | module_param(write_buffer_size, int, 0); |
| 114 | MODULE_PARM_DESC(write_buffer_size, "Write buffer size"); |
| 115 | |
| 116 | /* Some legacy software expects reads to contain whole LASM packets. |
| 117 | * To achieve this, characters which arrive before a packet timeout |
| 118 | * occurs will be returned in a single read operation. |
| 119 | * A problem with long reads is that the software may time out |
| 120 | * if it is not prepared to wait long enough. |
| 121 | * The packet timeout should be greater than the time between the |
| 122 | * reception of subsequent characters, which should arrive about |
| 123 | * every 5ms for the standard 2400 baud. |
| 124 | * Set it to 0 to disable. |
| 125 | */ |
| 126 | static int packet_timeout = 50; |
| 127 | module_param(packet_timeout, int, 0); |
| 128 | MODULE_PARM_DESC(packet_timeout, "Packet timeout in ms"); |
| 129 | |
| 130 | /* Some legacy software expects blocking reads to time out. |
| 131 | * Timeout occurs after the specified time of read and write inactivity. |
| 132 | * Set it to 0 to disable. |
| 133 | */ |
| 134 | static int read_timeout = 200; |
| 135 | module_param(read_timeout, int, 0); |
| 136 | MODULE_PARM_DESC(read_timeout, "Read timeout in ms"); |
| 137 | |
| 138 | /* As of kernel version 2.6.4 ehci-hcd uses an |
| 139 | * "only one interrupt transfer per frame" shortcut |
| 140 | * to simplify the scheduling of periodic transfers. |
| 141 | * This conflicts with our standard 1ms intervals for in and out URBs. |
| 142 | * We use default intervals of 2ms for in and 8ms for out transfers, |
| 143 | * which is fast enough for 2400 baud and allows a small additional load. |
| 144 | * Increase the interval to allow more devices that do interrupt transfers, |
| 145 | * or set to 0 to use the standard interval from the endpoint descriptors. |
| 146 | */ |
| 147 | static int interrupt_in_interval = 2; |
| 148 | module_param(interrupt_in_interval, int, 0); |
| 149 | MODULE_PARM_DESC(interrupt_in_interval, "Interrupt in interval in ms"); |
| 150 | |
| 151 | static int interrupt_out_interval = 8; |
| 152 | module_param(interrupt_out_interval, int, 0); |
| 153 | MODULE_PARM_DESC(interrupt_out_interval, "Interrupt out interval in ms"); |
| 154 | |
| 155 | /* Define these values to match your device */ |
| 156 | #define LEGO_USB_TOWER_VENDOR_ID 0x0694 |
| 157 | #define LEGO_USB_TOWER_PRODUCT_ID 0x0001 |
| 158 | |
| 159 | /* Vendor requests */ |
| 160 | #define LEGO_USB_TOWER_REQUEST_RESET 0x04 |
| 161 | #define LEGO_USB_TOWER_REQUEST_GET_VERSION 0xFD |
| 162 | |
| 163 | struct tower_reset_reply { |
| 164 | __le16 size; /* little-endian */ |
| 165 | __u8 err_code; |
| 166 | __u8 spare; |
| 167 | } __attribute__ ((packed)); |
| 168 | |
| 169 | struct tower_get_version_reply { |
| 170 | __le16 size; /* little-endian */ |
| 171 | __u8 err_code; |
| 172 | __u8 spare; |
| 173 | __u8 major; |
| 174 | __u8 minor; |
| 175 | __le16 build_no; /* little-endian */ |
| 176 | } __attribute__ ((packed)); |
| 177 | |
| 178 | |
| 179 | /* table of devices that work with this driver */ |
Németh Márton | 33b9e16 | 2010-01-10 15:34:45 +0100 | [diff] [blame] | 180 | static const struct usb_device_id tower_table[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 181 | { USB_DEVICE(LEGO_USB_TOWER_VENDOR_ID, LEGO_USB_TOWER_PRODUCT_ID) }, |
| 182 | { } /* Terminating entry */ |
| 183 | }; |
| 184 | |
| 185 | MODULE_DEVICE_TABLE (usb, tower_table); |
| 186 | |
| 187 | #define LEGO_USB_TOWER_MINOR_BASE 160 |
| 188 | |
| 189 | |
| 190 | /* Structure to hold all of our device specific stuff */ |
| 191 | struct lego_usb_tower { |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 192 | struct mutex lock; /* locks this structure */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | struct usb_device* udev; /* save off the usb device pointer */ |
| 194 | unsigned char minor; /* the starting minor number for this device */ |
| 195 | |
| 196 | int open_count; /* number of times this port has been opened */ |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 197 | unsigned long disconnected:1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | |
| 199 | char* read_buffer; |
| 200 | size_t read_buffer_length; /* this much came in */ |
| 201 | size_t read_packet_length; /* this much will be returned on read */ |
| 202 | spinlock_t read_buffer_lock; |
| 203 | int packet_timeout_jiffies; |
| 204 | unsigned long read_last_arrival; |
| 205 | |
| 206 | wait_queue_head_t read_wait; |
| 207 | wait_queue_head_t write_wait; |
| 208 | |
| 209 | char* interrupt_in_buffer; |
| 210 | struct usb_endpoint_descriptor* interrupt_in_endpoint; |
| 211 | struct urb* interrupt_in_urb; |
| 212 | int interrupt_in_interval; |
| 213 | int interrupt_in_running; |
| 214 | int interrupt_in_done; |
| 215 | |
| 216 | char* interrupt_out_buffer; |
| 217 | struct usb_endpoint_descriptor* interrupt_out_endpoint; |
| 218 | struct urb* interrupt_out_urb; |
| 219 | int interrupt_out_interval; |
| 220 | int interrupt_out_busy; |
| 221 | |
| 222 | }; |
| 223 | |
| 224 | |
| 225 | /* local function prototypes */ |
| 226 | static ssize_t tower_read (struct file *file, char __user *buffer, size_t count, loff_t *ppos); |
| 227 | static ssize_t tower_write (struct file *file, const char __user *buffer, size_t count, loff_t *ppos); |
| 228 | static inline void tower_delete (struct lego_usb_tower *dev); |
| 229 | static int tower_open (struct inode *inode, struct file *file); |
| 230 | static int tower_release (struct inode *inode, struct file *file); |
| 231 | static unsigned int tower_poll (struct file *file, poll_table *wait); |
| 232 | static loff_t tower_llseek (struct file *file, loff_t off, int whence); |
| 233 | |
| 234 | static void tower_abort_transfers (struct lego_usb_tower *dev); |
| 235 | static void tower_check_for_read_packet (struct lego_usb_tower *dev); |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 236 | static void tower_interrupt_in_callback (struct urb *urb); |
| 237 | static void tower_interrupt_out_callback (struct urb *urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | |
| 239 | static int tower_probe (struct usb_interface *interface, const struct usb_device_id *id); |
| 240 | static void tower_disconnect (struct usb_interface *interface); |
| 241 | |
| 242 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 243 | /* file operations needed when we register this driver */ |
Luiz Fernando N. Capitulino | 066202d | 2006-08-05 20:37:11 -0300 | [diff] [blame] | 244 | static const struct file_operations tower_fops = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 245 | .owner = THIS_MODULE, |
| 246 | .read = tower_read, |
| 247 | .write = tower_write, |
| 248 | .open = tower_open, |
| 249 | .release = tower_release, |
| 250 | .poll = tower_poll, |
| 251 | .llseek = tower_llseek, |
| 252 | }; |
| 253 | |
Al Viro | 2c9ede5 | 2011-07-23 20:24:48 -0400 | [diff] [blame] | 254 | static char *legousbtower_devnode(struct device *dev, umode_t *mode) |
Kay Sievers | f7a386c | 2009-04-30 15:23:42 +0200 | [diff] [blame] | 255 | { |
| 256 | return kasprintf(GFP_KERNEL, "usb/%s", dev_name(dev)); |
| 257 | } |
| 258 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 | /* |
| 260 | * usb class driver info in order to get a minor number from the usb core, |
Greg Kroah-Hartman | d6e5bcf | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 261 | * and to have the device registered with the driver core |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | */ |
| 263 | static struct usb_class_driver tower_class = { |
Greg Kroah-Hartman | d6e5bcf | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 264 | .name = "legousbtower%d", |
Kay Sievers | e454cea | 2009-09-18 23:01:12 +0200 | [diff] [blame] | 265 | .devnode = legousbtower_devnode, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 266 | .fops = &tower_fops, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 267 | .minor_base = LEGO_USB_TOWER_MINOR_BASE, |
| 268 | }; |
| 269 | |
| 270 | |
| 271 | /* usb specific object needed to register this driver with the usb subsystem */ |
| 272 | static struct usb_driver tower_driver = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 273 | .name = "legousbtower", |
| 274 | .probe = tower_probe, |
| 275 | .disconnect = tower_disconnect, |
| 276 | .id_table = tower_table, |
| 277 | }; |
| 278 | |
| 279 | |
| 280 | /** |
| 281 | * lego_usb_tower_debug_data |
| 282 | */ |
Greg Kroah-Hartman | 4dae996 | 2013-06-26 16:30:41 -0700 | [diff] [blame] | 283 | static inline void lego_usb_tower_debug_data(struct device *dev, |
| 284 | const char *function, int size, |
| 285 | const unsigned char *data) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 286 | { |
Greg Kroah-Hartman | 4dae996 | 2013-06-26 16:30:41 -0700 | [diff] [blame] | 287 | dev_dbg(dev, "%s - length = %d, data = %*ph\n", |
| 288 | function, size, size, data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 289 | } |
| 290 | |
| 291 | |
| 292 | /** |
| 293 | * tower_delete |
| 294 | */ |
| 295 | static inline void tower_delete (struct lego_usb_tower *dev) |
| 296 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | /* free data structures */ |
Mariusz Kozlowski | f53510e | 2006-11-08 15:36:14 +0100 | [diff] [blame] | 298 | usb_free_urb(dev->interrupt_in_urb); |
| 299 | usb_free_urb(dev->interrupt_out_urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | kfree (dev->read_buffer); |
| 301 | kfree (dev->interrupt_in_buffer); |
| 302 | kfree (dev->interrupt_out_buffer); |
Johan Hovold | 5f5264e | 2019-10-09 17:38:47 +0200 | [diff] [blame] | 303 | usb_put_dev(dev->udev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 304 | kfree (dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 305 | } |
| 306 | |
| 307 | |
| 308 | /** |
| 309 | * tower_open |
| 310 | */ |
| 311 | static int tower_open (struct inode *inode, struct file *file) |
| 312 | { |
| 313 | struct lego_usb_tower *dev = NULL; |
| 314 | int subminor; |
| 315 | int retval = 0; |
| 316 | struct usb_interface *interface; |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 317 | struct tower_reset_reply *reset_reply; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 318 | int result; |
| 319 | |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 320 | reset_reply = kmalloc(sizeof(*reset_reply), GFP_KERNEL); |
| 321 | |
| 322 | if (!reset_reply) { |
| 323 | retval = -ENOMEM; |
| 324 | goto exit; |
| 325 | } |
| 326 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 327 | nonseekable_open(inode, file); |
| 328 | subminor = iminor(inode); |
| 329 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 | interface = usb_find_interface (&tower_driver, subminor); |
| 331 | |
| 332 | if (!interface) { |
Greg Kroah-Hartman | 38726bf | 2013-06-26 16:30:42 -0700 | [diff] [blame] | 333 | pr_err("error, can't find device for minor %d\n", subminor); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 334 | retval = -ENODEV; |
Alan Stern | d4ead16 | 2007-05-22 11:46:41 -0400 | [diff] [blame] | 335 | goto exit; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 336 | } |
| 337 | |
| 338 | dev = usb_get_intfdata(interface); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | if (!dev) { |
| 340 | retval = -ENODEV; |
Alan Stern | d4ead16 | 2007-05-22 11:46:41 -0400 | [diff] [blame] | 341 | goto exit; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | } |
| 343 | |
| 344 | /* lock this device */ |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 345 | if (mutex_lock_interruptible(&dev->lock)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 346 | retval = -ERESTARTSYS; |
Alan Stern | d4ead16 | 2007-05-22 11:46:41 -0400 | [diff] [blame] | 347 | goto exit; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | } |
| 349 | |
Oliver Neukum | 78663ec | 2007-10-25 15:48:39 +0200 | [diff] [blame] | 350 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 351 | /* allow opening only once */ |
| 352 | if (dev->open_count) { |
| 353 | retval = -EBUSY; |
| 354 | goto unlock_exit; |
| 355 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 356 | |
| 357 | /* reset the tower */ |
| 358 | result = usb_control_msg (dev->udev, |
| 359 | usb_rcvctrlpipe(dev->udev, 0), |
| 360 | LEGO_USB_TOWER_REQUEST_RESET, |
| 361 | USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE, |
| 362 | 0, |
| 363 | 0, |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 364 | reset_reply, |
| 365 | sizeof(*reset_reply), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 366 | 1000); |
| 367 | if (result < 0) { |
Greg Kroah-Hartman | 9d974b2 | 2012-04-20 16:53:48 -0700 | [diff] [blame] | 368 | dev_err(&dev->udev->dev, |
| 369 | "LEGO USB Tower reset control request failed\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | retval = result; |
| 371 | goto unlock_exit; |
| 372 | } |
| 373 | |
| 374 | /* initialize in direction */ |
| 375 | dev->read_buffer_length = 0; |
| 376 | dev->read_packet_length = 0; |
| 377 | usb_fill_int_urb (dev->interrupt_in_urb, |
| 378 | dev->udev, |
| 379 | usb_rcvintpipe(dev->udev, dev->interrupt_in_endpoint->bEndpointAddress), |
| 380 | dev->interrupt_in_buffer, |
Kuninori Morimoto | 29cc889 | 2011-08-23 03:12:03 -0700 | [diff] [blame] | 381 | usb_endpoint_maxp(dev->interrupt_in_endpoint), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 | tower_interrupt_in_callback, |
| 383 | dev, |
| 384 | dev->interrupt_in_interval); |
| 385 | |
| 386 | dev->interrupt_in_running = 1; |
| 387 | dev->interrupt_in_done = 0; |
| 388 | mb(); |
| 389 | |
| 390 | retval = usb_submit_urb (dev->interrupt_in_urb, GFP_KERNEL); |
| 391 | if (retval) { |
Greg Kroah-Hartman | 9d974b2 | 2012-04-20 16:53:48 -0700 | [diff] [blame] | 392 | dev_err(&dev->udev->dev, |
| 393 | "Couldn't submit interrupt_in_urb %d\n", retval); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | dev->interrupt_in_running = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | goto unlock_exit; |
| 396 | } |
| 397 | |
| 398 | /* save device in the file's private structure */ |
| 399 | file->private_data = dev; |
| 400 | |
Johan Hovold | 2f24387 | 2019-09-19 10:30:39 +0200 | [diff] [blame] | 401 | dev->open_count = 1; |
| 402 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 403 | unlock_exit: |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 404 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | |
Alan Stern | d4ead16 | 2007-05-22 11:46:41 -0400 | [diff] [blame] | 406 | exit: |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 407 | kfree(reset_reply); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 | return retval; |
| 409 | } |
| 410 | |
| 411 | /** |
| 412 | * tower_release |
| 413 | */ |
| 414 | static int tower_release (struct inode *inode, struct file *file) |
| 415 | { |
| 416 | struct lego_usb_tower *dev; |
| 417 | int retval = 0; |
| 418 | |
Joe Perches | 5bd6e8b | 2010-07-12 13:50:12 -0700 | [diff] [blame] | 419 | dev = file->private_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 420 | |
| 421 | if (dev == NULL) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 422 | retval = -ENODEV; |
Johan Hovold | 9907054 | 2019-09-19 10:30:37 +0200 | [diff] [blame] | 423 | goto exit; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 424 | } |
| 425 | |
Johan Hovold | ddc87ec | 2019-10-10 14:58:35 +0200 | [diff] [blame] | 426 | mutex_lock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 427 | |
| 428 | if (dev->open_count != 1) { |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 429 | dev_dbg(&dev->udev->dev, "%s: device not opened exactly once\n", |
| 430 | __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | retval = -ENODEV; |
| 432 | goto unlock_exit; |
| 433 | } |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 434 | |
| 435 | if (dev->disconnected) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 436 | /* the device was unplugged before the file was released */ |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 437 | |
| 438 | /* unlock here as tower_delete frees dev */ |
| 439 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 440 | tower_delete (dev); |
| 441 | goto exit; |
| 442 | } |
| 443 | |
| 444 | /* wait until write transfer is finished */ |
| 445 | if (dev->interrupt_out_busy) { |
| 446 | wait_event_interruptible_timeout (dev->write_wait, !dev->interrupt_out_busy, 2 * HZ); |
| 447 | } |
| 448 | tower_abort_transfers (dev); |
| 449 | dev->open_count = 0; |
| 450 | |
| 451 | unlock_exit: |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 452 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 453 | exit: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 454 | return retval; |
| 455 | } |
| 456 | |
| 457 | |
| 458 | /** |
| 459 | * tower_abort_transfers |
| 460 | * aborts transfers and frees associated data structures |
| 461 | */ |
| 462 | static void tower_abort_transfers (struct lego_usb_tower *dev) |
| 463 | { |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 464 | if (dev == NULL) |
Greg Kroah-Hartman | d26f6e5 | 2013-06-26 16:30:39 -0700 | [diff] [blame] | 465 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 466 | |
| 467 | /* shutdown transfer */ |
| 468 | if (dev->interrupt_in_running) { |
| 469 | dev->interrupt_in_running = 0; |
| 470 | mb(); |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 471 | usb_kill_urb(dev->interrupt_in_urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 472 | } |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 473 | if (dev->interrupt_out_busy) |
Mariusz Kozlowski | f53510e | 2006-11-08 15:36:14 +0100 | [diff] [blame] | 474 | usb_kill_urb(dev->interrupt_out_urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 475 | } |
| 476 | |
| 477 | |
| 478 | /** |
| 479 | * tower_check_for_read_packet |
| 480 | * |
| 481 | * To get correct semantics for signals and non-blocking I/O |
| 482 | * with packetizing we pretend not to see any data in the read buffer |
| 483 | * until it has been there unchanged for at least |
| 484 | * dev->packet_timeout_jiffies, or until the buffer is full. |
| 485 | */ |
| 486 | static void tower_check_for_read_packet (struct lego_usb_tower *dev) |
| 487 | { |
| 488 | spin_lock_irq (&dev->read_buffer_lock); |
| 489 | if (!packet_timeout |
| 490 | || time_after(jiffies, dev->read_last_arrival + dev->packet_timeout_jiffies) |
| 491 | || dev->read_buffer_length == read_buffer_size) { |
| 492 | dev->read_packet_length = dev->read_buffer_length; |
| 493 | } |
| 494 | dev->interrupt_in_done = 0; |
| 495 | spin_unlock_irq (&dev->read_buffer_lock); |
| 496 | } |
| 497 | |
| 498 | |
| 499 | /** |
| 500 | * tower_poll |
| 501 | */ |
| 502 | static unsigned int tower_poll (struct file *file, poll_table *wait) |
| 503 | { |
| 504 | struct lego_usb_tower *dev; |
| 505 | unsigned int mask = 0; |
| 506 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | dev = file->private_data; |
| 508 | |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 509 | if (dev->disconnected) |
Oliver Neukum | d35b4ce | 2009-07-02 12:07:07 +0200 | [diff] [blame] | 510 | return POLLERR | POLLHUP; |
| 511 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 512 | poll_wait(file, &dev->read_wait, wait); |
| 513 | poll_wait(file, &dev->write_wait, wait); |
| 514 | |
| 515 | tower_check_for_read_packet(dev); |
| 516 | if (dev->read_packet_length > 0) { |
| 517 | mask |= POLLIN | POLLRDNORM; |
| 518 | } |
| 519 | if (!dev->interrupt_out_busy) { |
| 520 | mask |= POLLOUT | POLLWRNORM; |
| 521 | } |
| 522 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 523 | return mask; |
| 524 | } |
| 525 | |
| 526 | |
| 527 | /** |
| 528 | * tower_llseek |
| 529 | */ |
| 530 | static loff_t tower_llseek (struct file *file, loff_t off, int whence) |
| 531 | { |
| 532 | return -ESPIPE; /* unseekable */ |
| 533 | } |
| 534 | |
| 535 | |
| 536 | /** |
| 537 | * tower_read |
| 538 | */ |
| 539 | static ssize_t tower_read (struct file *file, char __user *buffer, size_t count, loff_t *ppos) |
| 540 | { |
| 541 | struct lego_usb_tower *dev; |
| 542 | size_t bytes_to_read; |
| 543 | int i; |
| 544 | int retval = 0; |
| 545 | unsigned long timeout = 0; |
| 546 | |
Joe Perches | 5bd6e8b | 2010-07-12 13:50:12 -0700 | [diff] [blame] | 547 | dev = file->private_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 548 | |
| 549 | /* lock this object */ |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 550 | if (mutex_lock_interruptible(&dev->lock)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 | retval = -ERESTARTSYS; |
| 552 | goto exit; |
| 553 | } |
| 554 | |
| 555 | /* verify that the device wasn't unplugged */ |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 556 | if (dev->disconnected) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 | retval = -ENODEV; |
Greg Kroah-Hartman | 38726bf | 2013-06-26 16:30:42 -0700 | [diff] [blame] | 558 | pr_err("No device or device unplugged %d\n", retval); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 559 | goto unlock_exit; |
| 560 | } |
| 561 | |
| 562 | /* verify that we actually have some data to read */ |
| 563 | if (count == 0) { |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 564 | dev_dbg(&dev->udev->dev, "read request of 0 bytes\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 565 | goto unlock_exit; |
| 566 | } |
| 567 | |
| 568 | if (read_timeout) { |
Nicholas Mc Guire | 8f7e947 | 2015-02-06 04:58:31 -0500 | [diff] [blame] | 569 | timeout = jiffies + msecs_to_jiffies(read_timeout); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 570 | } |
| 571 | |
| 572 | /* wait for data */ |
| 573 | tower_check_for_read_packet (dev); |
| 574 | while (dev->read_packet_length == 0) { |
| 575 | if (file->f_flags & O_NONBLOCK) { |
| 576 | retval = -EAGAIN; |
| 577 | goto unlock_exit; |
| 578 | } |
| 579 | retval = wait_event_interruptible_timeout(dev->read_wait, dev->interrupt_in_done, dev->packet_timeout_jiffies); |
| 580 | if (retval < 0) { |
| 581 | goto unlock_exit; |
| 582 | } |
| 583 | |
| 584 | /* reset read timeout during read or write activity */ |
| 585 | if (read_timeout |
| 586 | && (dev->read_buffer_length || dev->interrupt_out_busy)) { |
Nicholas Mc Guire | 8f7e947 | 2015-02-06 04:58:31 -0500 | [diff] [blame] | 587 | timeout = jiffies + msecs_to_jiffies(read_timeout); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 588 | } |
| 589 | /* check for read timeout */ |
| 590 | if (read_timeout && time_after (jiffies, timeout)) { |
| 591 | retval = -ETIMEDOUT; |
| 592 | goto unlock_exit; |
| 593 | } |
| 594 | tower_check_for_read_packet (dev); |
| 595 | } |
| 596 | |
| 597 | /* copy the data from read_buffer into userspace */ |
| 598 | bytes_to_read = min(count, dev->read_packet_length); |
| 599 | |
| 600 | if (copy_to_user (buffer, dev->read_buffer, bytes_to_read)) { |
| 601 | retval = -EFAULT; |
| 602 | goto unlock_exit; |
| 603 | } |
| 604 | |
| 605 | spin_lock_irq (&dev->read_buffer_lock); |
| 606 | dev->read_buffer_length -= bytes_to_read; |
| 607 | dev->read_packet_length -= bytes_to_read; |
| 608 | for (i=0; i<dev->read_buffer_length; i++) { |
| 609 | dev->read_buffer[i] = dev->read_buffer[i+bytes_to_read]; |
| 610 | } |
| 611 | spin_unlock_irq (&dev->read_buffer_lock); |
| 612 | |
| 613 | retval = bytes_to_read; |
| 614 | |
| 615 | unlock_exit: |
| 616 | /* unlock the device */ |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 617 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 618 | |
| 619 | exit: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 620 | return retval; |
| 621 | } |
| 622 | |
| 623 | |
| 624 | /** |
| 625 | * tower_write |
| 626 | */ |
| 627 | static ssize_t tower_write (struct file *file, const char __user *buffer, size_t count, loff_t *ppos) |
| 628 | { |
| 629 | struct lego_usb_tower *dev; |
| 630 | size_t bytes_to_write; |
| 631 | int retval = 0; |
| 632 | |
Joe Perches | 5bd6e8b | 2010-07-12 13:50:12 -0700 | [diff] [blame] | 633 | dev = file->private_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 634 | |
| 635 | /* lock this object */ |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 636 | if (mutex_lock_interruptible(&dev->lock)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 637 | retval = -ERESTARTSYS; |
| 638 | goto exit; |
| 639 | } |
| 640 | |
| 641 | /* verify that the device wasn't unplugged */ |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 642 | if (dev->disconnected) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 643 | retval = -ENODEV; |
Greg Kroah-Hartman | 38726bf | 2013-06-26 16:30:42 -0700 | [diff] [blame] | 644 | pr_err("No device or device unplugged %d\n", retval); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 645 | goto unlock_exit; |
| 646 | } |
| 647 | |
| 648 | /* verify that we actually have some data to write */ |
| 649 | if (count == 0) { |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 650 | dev_dbg(&dev->udev->dev, "write request of 0 bytes\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 651 | goto unlock_exit; |
| 652 | } |
| 653 | |
| 654 | /* wait until previous transfer is finished */ |
| 655 | while (dev->interrupt_out_busy) { |
| 656 | if (file->f_flags & O_NONBLOCK) { |
| 657 | retval = -EAGAIN; |
| 658 | goto unlock_exit; |
| 659 | } |
| 660 | retval = wait_event_interruptible (dev->write_wait, !dev->interrupt_out_busy); |
| 661 | if (retval) { |
| 662 | goto unlock_exit; |
| 663 | } |
| 664 | } |
| 665 | |
| 666 | /* write the data into interrupt_out_buffer from userspace */ |
| 667 | bytes_to_write = min_t(int, count, write_buffer_size); |
Alexey Dobriyan | 5b5e092 | 2017-02-27 14:30:02 -0800 | [diff] [blame] | 668 | dev_dbg(&dev->udev->dev, "%s: count = %zd, bytes_to_write = %zd\n", |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 669 | __func__, count, bytes_to_write); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 670 | |
| 671 | if (copy_from_user (dev->interrupt_out_buffer, buffer, bytes_to_write)) { |
| 672 | retval = -EFAULT; |
| 673 | goto unlock_exit; |
| 674 | } |
| 675 | |
| 676 | /* send off the urb */ |
| 677 | usb_fill_int_urb(dev->interrupt_out_urb, |
| 678 | dev->udev, |
| 679 | usb_sndintpipe(dev->udev, dev->interrupt_out_endpoint->bEndpointAddress), |
| 680 | dev->interrupt_out_buffer, |
| 681 | bytes_to_write, |
| 682 | tower_interrupt_out_callback, |
| 683 | dev, |
| 684 | dev->interrupt_out_interval); |
| 685 | |
| 686 | dev->interrupt_out_busy = 1; |
| 687 | wmb(); |
| 688 | |
| 689 | retval = usb_submit_urb (dev->interrupt_out_urb, GFP_KERNEL); |
| 690 | if (retval) { |
| 691 | dev->interrupt_out_busy = 0; |
Greg Kroah-Hartman | 9d974b2 | 2012-04-20 16:53:48 -0700 | [diff] [blame] | 692 | dev_err(&dev->udev->dev, |
| 693 | "Couldn't submit interrupt_out_urb %d\n", retval); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 694 | goto unlock_exit; |
| 695 | } |
| 696 | retval = bytes_to_write; |
| 697 | |
| 698 | unlock_exit: |
| 699 | /* unlock the device */ |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 700 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 701 | |
| 702 | exit: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 703 | return retval; |
| 704 | } |
| 705 | |
| 706 | |
| 707 | /** |
| 708 | * tower_interrupt_in_callback |
| 709 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 710 | static void tower_interrupt_in_callback (struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 711 | { |
Ming Lei | cdc9779 | 2008-02-24 18:41:47 +0800 | [diff] [blame] | 712 | struct lego_usb_tower *dev = urb->context; |
Greg Kroah-Hartman | 64771a0 | 2007-07-18 10:58:02 -0700 | [diff] [blame] | 713 | int status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 714 | int retval; |
| 715 | |
Greg Kroah-Hartman | 4dae996 | 2013-06-26 16:30:41 -0700 | [diff] [blame] | 716 | lego_usb_tower_debug_data(&dev->udev->dev, __func__, |
| 717 | urb->actual_length, urb->transfer_buffer); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | |
Greg Kroah-Hartman | 64771a0 | 2007-07-18 10:58:02 -0700 | [diff] [blame] | 719 | if (status) { |
| 720 | if (status == -ENOENT || |
| 721 | status == -ECONNRESET || |
| 722 | status == -ESHUTDOWN) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 723 | goto exit; |
| 724 | } else { |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 725 | dev_dbg(&dev->udev->dev, |
| 726 | "%s: nonzero status received: %d\n", __func__, |
| 727 | status); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 728 | goto resubmit; /* maybe we can recover */ |
| 729 | } |
| 730 | } |
| 731 | |
| 732 | if (urb->actual_length > 0) { |
| 733 | spin_lock (&dev->read_buffer_lock); |
| 734 | if (dev->read_buffer_length + urb->actual_length < read_buffer_size) { |
| 735 | memcpy (dev->read_buffer + dev->read_buffer_length, |
| 736 | dev->interrupt_in_buffer, |
| 737 | urb->actual_length); |
| 738 | dev->read_buffer_length += urb->actual_length; |
| 739 | dev->read_last_arrival = jiffies; |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 740 | dev_dbg(&dev->udev->dev, "%s: received %d bytes\n", |
| 741 | __func__, urb->actual_length); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 742 | } else { |
Greg Kroah-Hartman | 38726bf | 2013-06-26 16:30:42 -0700 | [diff] [blame] | 743 | pr_warn("read_buffer overflow, %d bytes dropped\n", |
| 744 | urb->actual_length); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 745 | } |
| 746 | spin_unlock (&dev->read_buffer_lock); |
| 747 | } |
| 748 | |
| 749 | resubmit: |
| 750 | /* resubmit if we're still running */ |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 751 | if (dev->interrupt_in_running) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 752 | retval = usb_submit_urb (dev->interrupt_in_urb, GFP_ATOMIC); |
Greg Kroah-Hartman | 9d974b2 | 2012-04-20 16:53:48 -0700 | [diff] [blame] | 753 | if (retval) |
| 754 | dev_err(&dev->udev->dev, |
| 755 | "%s: usb_submit_urb failed (%d)\n", |
| 756 | __func__, retval); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 757 | } |
| 758 | |
| 759 | exit: |
| 760 | dev->interrupt_in_done = 1; |
| 761 | wake_up_interruptible (&dev->read_wait); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 762 | } |
| 763 | |
| 764 | |
| 765 | /** |
| 766 | * tower_interrupt_out_callback |
| 767 | */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 768 | static void tower_interrupt_out_callback (struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 769 | { |
Ming Lei | cdc9779 | 2008-02-24 18:41:47 +0800 | [diff] [blame] | 770 | struct lego_usb_tower *dev = urb->context; |
Greg Kroah-Hartman | 64771a0 | 2007-07-18 10:58:02 -0700 | [diff] [blame] | 771 | int status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 772 | |
Greg Kroah-Hartman | 4dae996 | 2013-06-26 16:30:41 -0700 | [diff] [blame] | 773 | lego_usb_tower_debug_data(&dev->udev->dev, __func__, |
| 774 | urb->actual_length, urb->transfer_buffer); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 775 | |
| 776 | /* sync/async unlink faults aren't errors */ |
Greg Kroah-Hartman | 64771a0 | 2007-07-18 10:58:02 -0700 | [diff] [blame] | 777 | if (status && !(status == -ENOENT || |
| 778 | status == -ECONNRESET || |
| 779 | status == -ESHUTDOWN)) { |
Greg Kroah-Hartman | fef526c | 2013-06-26 16:30:40 -0700 | [diff] [blame] | 780 | dev_dbg(&dev->udev->dev, |
| 781 | "%s: nonzero write bulk status received: %d\n", __func__, |
| 782 | status); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 783 | } |
| 784 | |
| 785 | dev->interrupt_out_busy = 0; |
| 786 | wake_up_interruptible(&dev->write_wait); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 787 | } |
| 788 | |
| 789 | |
| 790 | /** |
| 791 | * tower_probe |
| 792 | * |
| 793 | * Called by the usb core when a new device is connected that it thinks |
| 794 | * this driver might be interested in. |
| 795 | */ |
| 796 | static int tower_probe (struct usb_interface *interface, const struct usb_device_id *id) |
| 797 | { |
Greg Kroah-Hartman | 9d974b2 | 2012-04-20 16:53:48 -0700 | [diff] [blame] | 798 | struct device *idev = &interface->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 799 | struct usb_device *udev = interface_to_usbdev(interface); |
| 800 | struct lego_usb_tower *dev = NULL; |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 801 | struct tower_get_version_reply *get_version_reply = NULL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 802 | int retval = -ENOMEM; |
| 803 | int result; |
| 804 | |
Steven Cole | 093cf72 | 2005-05-03 19:07:24 -0600 | [diff] [blame] | 805 | /* allocate memory for our device state and initialize it */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 806 | |
| 807 | dev = kmalloc (sizeof(struct lego_usb_tower), GFP_KERNEL); |
| 808 | |
Wolfram Sang | 49d8ffa | 2016-08-25 19:39:19 +0200 | [diff] [blame] | 809 | if (!dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 810 | goto exit; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 811 | |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 812 | mutex_init(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 813 | |
Johan Hovold | 5f5264e | 2019-10-09 17:38:47 +0200 | [diff] [blame] | 814 | dev->udev = usb_get_dev(udev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 815 | dev->open_count = 0; |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 816 | dev->disconnected = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 817 | |
| 818 | dev->read_buffer = NULL; |
| 819 | dev->read_buffer_length = 0; |
| 820 | dev->read_packet_length = 0; |
| 821 | spin_lock_init (&dev->read_buffer_lock); |
Nicholas Mc Guire | 8f7e947 | 2015-02-06 04:58:31 -0500 | [diff] [blame] | 822 | dev->packet_timeout_jiffies = msecs_to_jiffies(packet_timeout); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 823 | dev->read_last_arrival = jiffies; |
| 824 | |
| 825 | init_waitqueue_head (&dev->read_wait); |
| 826 | init_waitqueue_head (&dev->write_wait); |
| 827 | |
| 828 | dev->interrupt_in_buffer = NULL; |
| 829 | dev->interrupt_in_endpoint = NULL; |
| 830 | dev->interrupt_in_urb = NULL; |
| 831 | dev->interrupt_in_running = 0; |
| 832 | dev->interrupt_in_done = 0; |
| 833 | |
| 834 | dev->interrupt_out_buffer = NULL; |
| 835 | dev->interrupt_out_endpoint = NULL; |
| 836 | dev->interrupt_out_urb = NULL; |
| 837 | dev->interrupt_out_busy = 0; |
| 838 | |
Johan Hovold | 9b18116 | 2017-03-17 11:35:41 +0100 | [diff] [blame] | 839 | result = usb_find_common_endpoints_reverse(interface->cur_altsetting, |
| 840 | NULL, NULL, |
| 841 | &dev->interrupt_in_endpoint, |
| 842 | &dev->interrupt_out_endpoint); |
| 843 | if (result) { |
| 844 | dev_err(idev, "interrupt endpoints not found\n"); |
| 845 | retval = result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 846 | goto error; |
| 847 | } |
| 848 | |
| 849 | dev->read_buffer = kmalloc (read_buffer_size, GFP_KERNEL); |
Wolfram Sang | 49d8ffa | 2016-08-25 19:39:19 +0200 | [diff] [blame] | 850 | if (!dev->read_buffer) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 851 | goto error; |
Kuninori Morimoto | 29cc889 | 2011-08-23 03:12:03 -0700 | [diff] [blame] | 852 | dev->interrupt_in_buffer = kmalloc (usb_endpoint_maxp(dev->interrupt_in_endpoint), GFP_KERNEL); |
Wolfram Sang | 49d8ffa | 2016-08-25 19:39:19 +0200 | [diff] [blame] | 853 | if (!dev->interrupt_in_buffer) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 854 | goto error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 855 | dev->interrupt_in_urb = usb_alloc_urb(0, GFP_KERNEL); |
Wolfram Sang | a131f41 | 2016-08-11 23:14:41 +0200 | [diff] [blame] | 856 | if (!dev->interrupt_in_urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 857 | goto error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 858 | dev->interrupt_out_buffer = kmalloc (write_buffer_size, GFP_KERNEL); |
Wolfram Sang | 49d8ffa | 2016-08-25 19:39:19 +0200 | [diff] [blame] | 859 | if (!dev->interrupt_out_buffer) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 860 | goto error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 861 | dev->interrupt_out_urb = usb_alloc_urb(0, GFP_KERNEL); |
Wolfram Sang | a131f41 | 2016-08-11 23:14:41 +0200 | [diff] [blame] | 862 | if (!dev->interrupt_out_urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 863 | goto error; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 864 | dev->interrupt_in_interval = interrupt_in_interval ? interrupt_in_interval : dev->interrupt_in_endpoint->bInterval; |
| 865 | dev->interrupt_out_interval = interrupt_out_interval ? interrupt_out_interval : dev->interrupt_out_endpoint->bInterval; |
| 866 | |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 867 | get_version_reply = kmalloc(sizeof(*get_version_reply), GFP_KERNEL); |
| 868 | |
| 869 | if (!get_version_reply) { |
| 870 | retval = -ENOMEM; |
| 871 | goto error; |
| 872 | } |
| 873 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 874 | /* get the firmware version and log it */ |
| 875 | result = usb_control_msg (udev, |
| 876 | usb_rcvctrlpipe(udev, 0), |
| 877 | LEGO_USB_TOWER_REQUEST_GET_VERSION, |
| 878 | USB_TYPE_VENDOR | USB_DIR_IN | USB_RECIP_DEVICE, |
| 879 | 0, |
| 880 | 0, |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 881 | get_version_reply, |
| 882 | sizeof(*get_version_reply), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 883 | 1000); |
Dan Carpenter | d7030f0 | 2019-10-11 17:11:15 +0300 | [diff] [blame] | 884 | if (result != sizeof(*get_version_reply)) { |
Johan Hovold | b076bfe | 2019-09-19 10:30:36 +0200 | [diff] [blame] | 885 | if (result >= 0) |
| 886 | result = -EIO; |
| 887 | dev_err(idev, "get version request failed: %d\n", result); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 888 | retval = result; |
| 889 | goto error; |
| 890 | } |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 891 | dev_info(&interface->dev, |
| 892 | "LEGO USB Tower firmware version is %d.%d build %d\n", |
| 893 | get_version_reply->major, |
| 894 | get_version_reply->minor, |
| 895 | le16_to_cpu(get_version_reply->build_no)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 896 | |
Greg Kroah-Hartman | 2fae9e5 | 2016-09-19 19:09:51 +0100 | [diff] [blame] | 897 | /* we can register the device now, as it is ready */ |
| 898 | usb_set_intfdata (interface, dev); |
| 899 | |
| 900 | retval = usb_register_dev (interface, &tower_class); |
| 901 | |
| 902 | if (retval) { |
| 903 | /* something prevented us from registering this driver */ |
| 904 | dev_err(idev, "Not able to get a minor for this device.\n"); |
Greg Kroah-Hartman | 2fae9e5 | 2016-09-19 19:09:51 +0100 | [diff] [blame] | 905 | goto error; |
| 906 | } |
| 907 | dev->minor = interface->minor; |
| 908 | |
| 909 | /* let the user know what node this device is now attached to */ |
| 910 | dev_info(&interface->dev, "LEGO USB Tower #%d now attached to major " |
| 911 | "%d minor %d\n", (dev->minor - LEGO_USB_TOWER_MINOR_BASE), |
| 912 | USB_MAJOR, dev->minor); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 913 | |
| 914 | exit: |
Maksim Salau | 0bd193d | 2017-05-13 23:49:26 +0300 | [diff] [blame] | 915 | kfree(get_version_reply); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 916 | return retval; |
| 917 | |
| 918 | error: |
Maksim Salau | 942a487 | 2017-04-25 22:49:21 +0300 | [diff] [blame] | 919 | kfree(get_version_reply); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 920 | tower_delete(dev); |
| 921 | return retval; |
| 922 | } |
| 923 | |
| 924 | |
| 925 | /** |
| 926 | * tower_disconnect |
| 927 | * |
| 928 | * Called by the usb core when the device is removed from the system. |
| 929 | */ |
| 930 | static void tower_disconnect (struct usb_interface *interface) |
| 931 | { |
| 932 | struct lego_usb_tower *dev; |
| 933 | int minor; |
| 934 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 935 | dev = usb_get_intfdata (interface); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 936 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 937 | minor = dev->minor; |
| 938 | |
Johan Hovold | 9907054 | 2019-09-19 10:30:37 +0200 | [diff] [blame] | 939 | /* give back our minor and prevent further open() */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 940 | usb_deregister_dev (interface, &tower_class); |
| 941 | |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 942 | /* stop I/O */ |
| 943 | usb_poison_urb(dev->interrupt_in_urb); |
| 944 | usb_poison_urb(dev->interrupt_out_urb); |
| 945 | |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 946 | mutex_lock(&dev->lock); |
Alan Stern | d4ead16 | 2007-05-22 11:46:41 -0400 | [diff] [blame] | 947 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 948 | /* if the device is not opened, then we clean up right now */ |
| 949 | if (!dev->open_count) { |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 950 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 951 | tower_delete (dev); |
| 952 | } else { |
Johan Hovold | 32031fc | 2019-09-19 10:30:38 +0200 | [diff] [blame] | 953 | dev->disconnected = 1; |
Oliver Neukum | d35b4ce | 2009-07-02 12:07:07 +0200 | [diff] [blame] | 954 | /* wake up pollers */ |
| 955 | wake_up_interruptible_all(&dev->read_wait); |
| 956 | wake_up_interruptible_all(&dev->write_wait); |
Daniel Walker | 18bcbcf | 2008-01-11 08:45:44 -0800 | [diff] [blame] | 957 | mutex_unlock(&dev->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 958 | } |
| 959 | |
Greg Kroah-Hartman | 1b29a37 | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 960 | dev_info(&interface->dev, "LEGO USB Tower #%d now disconnected\n", |
| 961 | (minor - LEGO_USB_TOWER_MINOR_BASE)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 962 | } |
| 963 | |
Greg Kroah-Hartman | 65db430 | 2011-11-18 09:34:02 -0800 | [diff] [blame] | 964 | module_usb_driver(tower_driver); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 965 | |
| 966 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 967 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 968 | #ifdef MODULE_LICENSE |
| 969 | MODULE_LICENSE("GPL"); |
| 970 | #endif |