Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * USB ConnectTech WhiteHEAT driver |
| 3 | * |
| 4 | * Copyright (C) 2002 |
| 5 | * Connect Tech Inc. |
| 6 | * |
| 7 | * Copyright (C) 1999 - 2001 |
| 8 | * Greg Kroah-Hartman (greg@kroah.com) |
| 9 | * |
| 10 | * This program is free software; you can redistribute it and/or modify |
| 11 | * it under the terms of the GNU General Public License as published by |
| 12 | * the Free Software Foundation; either version 2 of the License, or |
| 13 | * (at your option) any later version. |
| 14 | * |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 15 | * See Documentation/usb/usb-serial.txt for more information on using this |
| 16 | * driver |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | */ |
| 18 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 19 | #include <linux/kernel.h> |
| 20 | #include <linux/errno.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | #include <linux/slab.h> |
| 22 | #include <linux/tty.h> |
| 23 | #include <linux/tty_driver.h> |
| 24 | #include <linux/tty_flip.h> |
| 25 | #include <linux/module.h> |
| 26 | #include <linux/spinlock.h> |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 27 | #include <linux/mutex.h> |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 28 | #include <linux/uaccess.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | #include <asm/termbits.h> |
| 30 | #include <linux/usb.h> |
| 31 | #include <linux/serial_reg.h> |
| 32 | #include <linux/serial.h> |
Greg Kroah-Hartman | a969888 | 2006-07-11 21:22:58 -0700 | [diff] [blame] | 33 | #include <linux/usb/serial.h> |
Rene Buergel | cc183e2 | 2012-09-18 09:00:41 +0200 | [diff] [blame] | 34 | #include <linux/usb/ezusb.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | #include "whiteheat.h" /* WhiteHEAT specific commands */ |
| 36 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #ifndef CMSPAR |
| 38 | #define CMSPAR 0 |
| 39 | #endif |
| 40 | |
| 41 | /* |
| 42 | * Version Information |
| 43 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | #define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Stuart MacDonald <stuartm@connecttech.com>" |
| 45 | #define DRIVER_DESC "USB ConnectTech WhiteHEAT driver" |
| 46 | |
| 47 | #define CONNECT_TECH_VENDOR_ID 0x0710 |
| 48 | #define CONNECT_TECH_FAKE_WHITE_HEAT_ID 0x0001 |
| 49 | #define CONNECT_TECH_WHITE_HEAT_ID 0x8001 |
| 50 | |
| 51 | /* |
| 52 | ID tables for whiteheat are unusual, because we want to different |
| 53 | things for different versions of the device. Eventually, this |
| 54 | will be doable from a single table. But, for now, we define two |
| 55 | separate ID tables, and then a third table that combines them |
| 56 | just for the purpose of exporting the autoloading information. |
| 57 | */ |
Németh Márton | 7d40d7e | 2010-01-10 15:34:24 +0100 | [diff] [blame] | 58 | static const struct usb_device_id id_table_std[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | { USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_WHITE_HEAT_ID) }, |
| 60 | { } /* Terminating entry */ |
| 61 | }; |
| 62 | |
Németh Márton | 7d40d7e | 2010-01-10 15:34:24 +0100 | [diff] [blame] | 63 | static const struct usb_device_id id_table_prerenumeration[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | { USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_FAKE_WHITE_HEAT_ID) }, |
| 65 | { } /* Terminating entry */ |
| 66 | }; |
| 67 | |
Németh Márton | 7d40d7e | 2010-01-10 15:34:24 +0100 | [diff] [blame] | 68 | static const struct usb_device_id id_table_combined[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | { USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_WHITE_HEAT_ID) }, |
| 70 | { USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_FAKE_WHITE_HEAT_ID) }, |
| 71 | { } /* Terminating entry */ |
| 72 | }; |
| 73 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 74 | MODULE_DEVICE_TABLE(usb, id_table_combined); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | |
| 77 | /* function prototypes for the Connect Tech WhiteHEAT prerenumeration device */ |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 78 | static int whiteheat_firmware_download(struct usb_serial *serial, |
| 79 | const struct usb_device_id *id); |
| 80 | static int whiteheat_firmware_attach(struct usb_serial *serial); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | |
| 82 | /* function prototypes for the Connect Tech WhiteHEAT serial converter */ |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 83 | static int whiteheat_attach(struct usb_serial *serial); |
Alan Stern | f9c99bb | 2009-06-02 11:53:55 -0400 | [diff] [blame] | 84 | static void whiteheat_release(struct usb_serial *serial); |
Johan Hovold | c467206 | 2012-10-25 10:29:02 +0200 | [diff] [blame] | 85 | static int whiteheat_port_probe(struct usb_serial_port *port); |
| 86 | static int whiteheat_port_remove(struct usb_serial_port *port); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 87 | static int whiteheat_open(struct tty_struct *tty, |
Alan Cox | a509a7e | 2009-09-19 13:13:26 -0700 | [diff] [blame] | 88 | struct usb_serial_port *port); |
Alan Cox | 335f851 | 2009-06-11 12:26:29 +0100 | [diff] [blame] | 89 | static void whiteheat_close(struct usb_serial_port *port); |
Alan Cox | 00a0d0d | 2011-02-14 16:27:06 +0000 | [diff] [blame] | 90 | static int whiteheat_ioctl(struct tty_struct *tty, |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 91 | unsigned int cmd, unsigned long arg); |
| 92 | static void whiteheat_set_termios(struct tty_struct *tty, |
| 93 | struct usb_serial_port *port, struct ktermios *old); |
Alan Cox | 60b33c1 | 2011-02-14 16:26:14 +0000 | [diff] [blame] | 94 | static int whiteheat_tiocmget(struct tty_struct *tty); |
Alan Cox | 20b9d17 | 2011-02-14 16:26:50 +0000 | [diff] [blame] | 95 | static int whiteheat_tiocmset(struct tty_struct *tty, |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 96 | unsigned int set, unsigned int clear); |
| 97 | static void whiteheat_break_ctl(struct tty_struct *tty, int break_state); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | |
Greg Kroah-Hartman | ea65370 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 99 | static struct usb_serial_driver whiteheat_fake_device = { |
Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 100 | .driver = { |
| 101 | .owner = THIS_MODULE, |
Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 102 | .name = "whiteheatnofirm", |
Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 103 | }, |
Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 104 | .description = "Connect Tech - WhiteHEAT - (prerenumeration)", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | .id_table = id_table_prerenumeration, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | .num_ports = 1, |
| 107 | .probe = whiteheat_firmware_download, |
| 108 | .attach = whiteheat_firmware_attach, |
| 109 | }; |
| 110 | |
Greg Kroah-Hartman | ea65370 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 111 | static struct usb_serial_driver whiteheat_device = { |
Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 112 | .driver = { |
| 113 | .owner = THIS_MODULE, |
Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 114 | .name = "whiteheat", |
Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 115 | }, |
Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 116 | .description = "Connect Tech - WhiteHEAT", |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | .id_table = id_table_std, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | .num_ports = 4, |
| 119 | .attach = whiteheat_attach, |
Alan Stern | f9c99bb | 2009-06-02 11:53:55 -0400 | [diff] [blame] | 120 | .release = whiteheat_release, |
Johan Hovold | c467206 | 2012-10-25 10:29:02 +0200 | [diff] [blame] | 121 | .port_probe = whiteheat_port_probe, |
| 122 | .port_remove = whiteheat_port_remove, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 123 | .open = whiteheat_open, |
| 124 | .close = whiteheat_close, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | .ioctl = whiteheat_ioctl, |
| 126 | .set_termios = whiteheat_set_termios, |
| 127 | .break_ctl = whiteheat_break_ctl, |
| 128 | .tiocmget = whiteheat_tiocmget, |
| 129 | .tiocmset = whiteheat_tiocmset, |
Johan Hovold | 5c0c758 | 2012-03-22 16:50:55 +0100 | [diff] [blame] | 130 | .throttle = usb_serial_generic_throttle, |
| 131 | .unthrottle = usb_serial_generic_unthrottle, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 132 | }; |
| 133 | |
Alan Stern | 29618e9 | 2012-02-23 14:57:32 -0500 | [diff] [blame] | 134 | static struct usb_serial_driver * const serial_drivers[] = { |
| 135 | &whiteheat_fake_device, &whiteheat_device, NULL |
| 136 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 137 | |
| 138 | struct whiteheat_command_private { |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 139 | struct mutex mutex; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | __u8 port_running; |
| 141 | __u8 command_finished; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 142 | wait_queue_head_t wait_command; /* for handling sleeping whilst |
| 143 | waiting for a command to |
| 144 | finish */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 145 | __u8 result_buffer[64]; |
| 146 | }; |
| 147 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | struct whiteheat_private { |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 149 | __u8 mcr; /* FIXME: no locking on mcr */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | }; |
| 151 | |
| 152 | |
| 153 | /* local function prototypes */ |
| 154 | static int start_command_port(struct usb_serial *serial); |
| 155 | static void stop_command_port(struct usb_serial *serial); |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 156 | static void command_port_write_callback(struct urb *urb); |
| 157 | static void command_port_read_callback(struct urb *urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 158 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 159 | static int firm_send_command(struct usb_serial_port *port, __u8 command, |
| 160 | __u8 *data, __u8 datasize); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 161 | static int firm_open(struct usb_serial_port *port); |
| 162 | static int firm_close(struct usb_serial_port *port); |
Alan Cox | fe1ae7f | 2009-09-19 13:13:33 -0700 | [diff] [blame] | 163 | static void firm_setup_port(struct tty_struct *tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | static int firm_set_rts(struct usb_serial_port *port, __u8 onoff); |
| 165 | static int firm_set_dtr(struct usb_serial_port *port, __u8 onoff); |
| 166 | static int firm_set_break(struct usb_serial_port *port, __u8 onoff); |
| 167 | static int firm_purge(struct usb_serial_port *port, __u8 rxtx); |
| 168 | static int firm_get_dtr_rts(struct usb_serial_port *port); |
| 169 | static int firm_report_tx_done(struct usb_serial_port *port); |
| 170 | |
| 171 | |
| 172 | #define COMMAND_PORT 4 |
| 173 | #define COMMAND_TIMEOUT (2*HZ) /* 2 second timeout for a command */ |
| 174 | #define COMMAND_TIMEOUT_MS 2000 |
| 175 | #define CLOSING_DELAY (30 * HZ) |
| 176 | |
| 177 | |
| 178 | /***************************************************************************** |
| 179 | * Connect Tech's White Heat prerenumeration driver functions |
| 180 | *****************************************************************************/ |
| 181 | |
| 182 | /* steps to download the firmware to the WhiteHEAT device: |
| 183 | - hold the reset (by writing to the reset bit of the CPUCS register) |
| 184 | - download the VEND_AX.HEX file to the chip using VENDOR_REQUEST-ANCHOR_LOAD |
| 185 | - release the reset (by writing to the CPUCS register) |
| 186 | - download the WH.HEX file for all addresses greater than 0x1b3f using |
| 187 | VENDOR_REQUEST-ANCHOR_EXTERNAL_RAM_LOAD |
| 188 | - hold the reset |
| 189 | - download the WH.HEX file for all addresses less than 0x1b40 using |
| 190 | VENDOR_REQUEST_ANCHOR_LOAD |
| 191 | - release the reset |
| 192 | - device renumerated itself and comes up as new device id with all |
| 193 | firmware download completed. |
| 194 | */ |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 195 | static int whiteheat_firmware_download(struct usb_serial *serial, |
| 196 | const struct usb_device_id *id) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 197 | { |
Rene Buergel | 8d733e2 | 2012-09-18 09:02:01 +0200 | [diff] [blame] | 198 | int response; |
David Woodhouse | ec6752f | 2008-05-31 01:35:29 +0300 | [diff] [blame] | 199 | |
Rene Buergel | 8d733e2 | 2012-09-18 09:02:01 +0200 | [diff] [blame] | 200 | response = ezusb_fx1_ihex_firmware_download(serial->dev, "whiteheat_loader.fw"); |
| 201 | if (response >= 0) { |
| 202 | response = ezusb_fx1_ihex_firmware_download(serial->dev, "whiteheat.fw"); |
| 203 | if (response >= 0) |
| 204 | return 0; |
David Woodhouse | ec6752f | 2008-05-31 01:35:29 +0300 | [diff] [blame] | 205 | } |
Rene Buergel | 8d733e2 | 2012-09-18 09:02:01 +0200 | [diff] [blame] | 206 | return -ENOENT; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 207 | } |
| 208 | |
| 209 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 210 | static int whiteheat_firmware_attach(struct usb_serial *serial) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 | { |
| 212 | /* We want this device to fail to have a driver assigned to it */ |
| 213 | return 1; |
| 214 | } |
| 215 | |
| 216 | |
| 217 | /***************************************************************************** |
| 218 | * Connect Tech's White Heat serial driver functions |
| 219 | *****************************************************************************/ |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 220 | static int whiteheat_attach(struct usb_serial *serial) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | { |
| 222 | struct usb_serial_port *command_port; |
| 223 | struct whiteheat_command_private *command_info; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 224 | struct whiteheat_hw_info *hw_info; |
| 225 | int pipe; |
| 226 | int ret; |
| 227 | int alen; |
| 228 | __u8 *command; |
| 229 | __u8 *result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 230 | |
| 231 | command_port = serial->port[COMMAND_PORT]; |
| 232 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 233 | pipe = usb_sndbulkpipe(serial->dev, |
| 234 | command_port->bulk_out_endpointAddress); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | command = kmalloc(2, GFP_KERNEL); |
| 236 | if (!command) |
| 237 | goto no_command_buffer; |
| 238 | command[0] = WHITEHEAT_GET_HW_INFO; |
| 239 | command[1] = 0; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 240 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | result = kmalloc(sizeof(*hw_info) + 1, GFP_KERNEL); |
| 242 | if (!result) |
| 243 | goto no_result_buffer; |
| 244 | /* |
| 245 | * When the module is reloaded the firmware is still there and |
| 246 | * the endpoints are still in the usb core unchanged. This is the |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 247 | * unlinking bug in disguise. Same for the call below. |
| 248 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 249 | usb_clear_halt(serial->dev, pipe); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 250 | ret = usb_bulk_msg(serial->dev, pipe, command, 2, |
| 251 | &alen, COMMAND_TIMEOUT_MS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 252 | if (ret) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 253 | dev_err(&serial->dev->dev, "%s: Couldn't send command [%d]\n", |
| 254 | serial->type->description, ret); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 255 | goto no_firmware; |
Stuart MacDonald | 09fd6bc | 2006-05-31 13:28:40 -0400 | [diff] [blame] | 256 | } else if (alen != 2) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 257 | dev_err(&serial->dev->dev, "%s: Send command incomplete [%d]\n", |
| 258 | serial->type->description, alen); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 | goto no_firmware; |
| 260 | } |
| 261 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 262 | pipe = usb_rcvbulkpipe(serial->dev, |
| 263 | command_port->bulk_in_endpointAddress); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 264 | /* See the comment on the usb_clear_halt() above */ |
| 265 | usb_clear_halt(serial->dev, pipe); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 266 | ret = usb_bulk_msg(serial->dev, pipe, result, |
| 267 | sizeof(*hw_info) + 1, &alen, COMMAND_TIMEOUT_MS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | if (ret) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 269 | dev_err(&serial->dev->dev, "%s: Couldn't get results [%d]\n", |
| 270 | serial->type->description, ret); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 271 | goto no_firmware; |
Stuart MacDonald | 09fd6bc | 2006-05-31 13:28:40 -0400 | [diff] [blame] | 272 | } else if (alen != sizeof(*hw_info) + 1) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 273 | dev_err(&serial->dev->dev, "%s: Get results incomplete [%d]\n", |
| 274 | serial->type->description, alen); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 275 | goto no_firmware; |
| 276 | } else if (result[0] != command[0]) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 277 | dev_err(&serial->dev->dev, "%s: Command failed [%d]\n", |
| 278 | serial->type->description, result[0]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | goto no_firmware; |
| 280 | } |
| 281 | |
| 282 | hw_info = (struct whiteheat_hw_info *)&result[1]; |
| 283 | |
Johan Hovold | a6765cb | 2012-03-22 16:50:54 +0100 | [diff] [blame] | 284 | dev_info(&serial->dev->dev, "%s: Firmware v%d.%02d\n", |
| 285 | serial->type->description, |
Greg Kroah-Hartman | c197a8d | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 286 | hw_info->sw_major_rev, hw_info->sw_minor_rev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 288 | command_info = kmalloc(sizeof(struct whiteheat_command_private), |
| 289 | GFP_KERNEL); |
Johan Hovold | 10c642d | 2013-12-29 19:22:56 +0100 | [diff] [blame] | 290 | if (!command_info) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 291 | goto no_command_private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 | |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 293 | mutex_init(&command_info->mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | command_info->port_running = 0; |
| 295 | init_waitqueue_head(&command_info->wait_command); |
| 296 | usb_set_serial_port_data(command_port, command_info); |
| 297 | command_port->write_urb->complete = command_port_write_callback; |
| 298 | command_port->read_urb->complete = command_port_read_callback; |
| 299 | kfree(result); |
| 300 | kfree(command); |
| 301 | |
| 302 | return 0; |
| 303 | |
| 304 | no_firmware: |
| 305 | /* Firmware likely not running */ |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 306 | dev_err(&serial->dev->dev, |
| 307 | "%s: Unable to retrieve firmware version, try replugging\n", |
| 308 | serial->type->description); |
| 309 | dev_err(&serial->dev->dev, |
| 310 | "%s: If the firmware is not running (status led not blinking)\n", |
| 311 | serial->type->description); |
| 312 | dev_err(&serial->dev->dev, |
| 313 | "%s: please contact support@connecttech.com\n", |
| 314 | serial->type->description); |
Jesper Juhl | 67ca0284 | 2006-04-23 19:59:23 +0200 | [diff] [blame] | 315 | kfree(result); |
Johan Hovold | c129197 | 2012-10-25 10:29:01 +0200 | [diff] [blame] | 316 | kfree(command); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 317 | return -ENODEV; |
| 318 | |
| 319 | no_command_private: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 320 | kfree(result); |
| 321 | no_result_buffer: |
| 322 | kfree(command); |
| 323 | no_command_buffer: |
| 324 | return -ENOMEM; |
| 325 | } |
| 326 | |
Alan Stern | f9c99bb | 2009-06-02 11:53:55 -0400 | [diff] [blame] | 327 | static void whiteheat_release(struct usb_serial *serial) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 328 | { |
| 329 | struct usb_serial_port *command_port; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 331 | /* free up our private data for our command port */ |
| 332 | command_port = serial->port[COMMAND_PORT]; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 333 | kfree(usb_get_serial_port_data(command_port)); |
Johan Hovold | c467206 | 2012-10-25 10:29:02 +0200 | [diff] [blame] | 334 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 335 | |
Johan Hovold | c467206 | 2012-10-25 10:29:02 +0200 | [diff] [blame] | 336 | static int whiteheat_port_probe(struct usb_serial_port *port) |
| 337 | { |
| 338 | struct whiteheat_private *info; |
| 339 | |
| 340 | info = kzalloc(sizeof(*info), GFP_KERNEL); |
| 341 | if (!info) |
| 342 | return -ENOMEM; |
| 343 | |
| 344 | usb_set_serial_port_data(port, info); |
| 345 | |
| 346 | return 0; |
| 347 | } |
| 348 | |
| 349 | static int whiteheat_port_remove(struct usb_serial_port *port) |
| 350 | { |
| 351 | struct whiteheat_private *info; |
| 352 | |
| 353 | info = usb_get_serial_port_data(port); |
| 354 | kfree(info); |
| 355 | |
| 356 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 357 | } |
| 358 | |
Alan Cox | a509a7e | 2009-09-19 13:13:26 -0700 | [diff] [blame] | 359 | static int whiteheat_open(struct tty_struct *tty, struct usb_serial_port *port) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 360 | { |
Johan Hovold | 5c0c758 | 2012-03-22 16:50:55 +0100 | [diff] [blame] | 361 | int retval; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | retval = start_command_port(port->serial); |
| 364 | if (retval) |
| 365 | goto exit; |
| 366 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | /* send an open port command */ |
| 368 | retval = firm_open(port); |
| 369 | if (retval) { |
| 370 | stop_command_port(port->serial); |
| 371 | goto exit; |
| 372 | } |
| 373 | |
| 374 | retval = firm_purge(port, WHITEHEAT_PURGE_RX | WHITEHEAT_PURGE_TX); |
| 375 | if (retval) { |
| 376 | firm_close(port); |
| 377 | stop_command_port(port->serial); |
| 378 | goto exit; |
| 379 | } |
| 380 | |
Alan Cox | 72e2741 | 2008-07-22 11:09:29 +0100 | [diff] [blame] | 381 | if (tty) |
| 382 | firm_setup_port(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | |
| 384 | /* Work around HCD bugs */ |
| 385 | usb_clear_halt(port->serial->dev, port->read_urb->pipe); |
| 386 | usb_clear_halt(port->serial->dev, port->write_urb->pipe); |
| 387 | |
Johan Hovold | 5c0c758 | 2012-03-22 16:50:55 +0100 | [diff] [blame] | 388 | retval = usb_serial_generic_open(tty, port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 389 | if (retval) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | firm_close(port); |
| 391 | stop_command_port(port->serial); |
| 392 | goto exit; |
| 393 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | exit: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 395 | return retval; |
| 396 | } |
| 397 | |
| 398 | |
Alan Cox | 335f851 | 2009-06-11 12:26:29 +0100 | [diff] [blame] | 399 | static void whiteheat_close(struct usb_serial_port *port) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 400 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 401 | firm_report_tx_done(port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 402 | firm_close(port); |
| 403 | |
Johan Hovold | 5c0c758 | 2012-03-22 16:50:55 +0100 | [diff] [blame] | 404 | usb_serial_generic_close(port); |
| 405 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 406 | stop_command_port(port->serial); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 407 | } |
| 408 | |
Alan Cox | 60b33c1 | 2011-02-14 16:26:14 +0000 | [diff] [blame] | 409 | static int whiteheat_tiocmget(struct tty_struct *tty) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 410 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 411 | struct usb_serial_port *port = tty->driver_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 412 | struct whiteheat_private *info = usb_get_serial_port_data(port); |
| 413 | unsigned int modem_signals = 0; |
| 414 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 415 | firm_get_dtr_rts(port); |
| 416 | if (info->mcr & UART_MCR_DTR) |
| 417 | modem_signals |= TIOCM_DTR; |
| 418 | if (info->mcr & UART_MCR_RTS) |
| 419 | modem_signals |= TIOCM_RTS; |
| 420 | |
| 421 | return modem_signals; |
| 422 | } |
| 423 | |
Alan Cox | 20b9d17 | 2011-02-14 16:26:50 +0000 | [diff] [blame] | 424 | static int whiteheat_tiocmset(struct tty_struct *tty, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 425 | unsigned int set, unsigned int clear) |
| 426 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 427 | struct usb_serial_port *port = tty->driver_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 428 | struct whiteheat_private *info = usb_get_serial_port_data(port); |
| 429 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 430 | if (set & TIOCM_RTS) |
| 431 | info->mcr |= UART_MCR_RTS; |
| 432 | if (set & TIOCM_DTR) |
| 433 | info->mcr |= UART_MCR_DTR; |
| 434 | |
| 435 | if (clear & TIOCM_RTS) |
| 436 | info->mcr &= ~UART_MCR_RTS; |
| 437 | if (clear & TIOCM_DTR) |
| 438 | info->mcr &= ~UART_MCR_DTR; |
| 439 | |
| 440 | firm_set_dtr(port, info->mcr & UART_MCR_DTR); |
| 441 | firm_set_rts(port, info->mcr & UART_MCR_RTS); |
| 442 | return 0; |
| 443 | } |
| 444 | |
| 445 | |
Alan Cox | 00a0d0d | 2011-02-14 16:27:06 +0000 | [diff] [blame] | 446 | static int whiteheat_ioctl(struct tty_struct *tty, |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 447 | unsigned int cmd, unsigned long arg) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 449 | struct usb_serial_port *port = tty->driver_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 450 | struct serial_struct serstruct; |
| 451 | void __user *user_arg = (void __user *)arg; |
| 452 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 453 | switch (cmd) { |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 454 | case TIOCGSERIAL: |
| 455 | memset(&serstruct, 0, sizeof(serstruct)); |
| 456 | serstruct.type = PORT_16654; |
Greg Kroah-Hartman | e5b1e20 | 2013-06-07 11:04:28 -0700 | [diff] [blame] | 457 | serstruct.line = port->minor; |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 458 | serstruct.port = port->port_number; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 459 | serstruct.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ; |
Johan Hovold | 5c0c758 | 2012-03-22 16:50:55 +0100 | [diff] [blame] | 460 | serstruct.xmit_fifo_size = kfifo_size(&port->write_fifo); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 461 | serstruct.custom_divisor = 0; |
| 462 | serstruct.baud_base = 460800; |
| 463 | serstruct.close_delay = CLOSING_DELAY; |
| 464 | serstruct.closing_wait = CLOSING_DELAY; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 465 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 466 | if (copy_to_user(user_arg, &serstruct, sizeof(serstruct))) |
| 467 | return -EFAULT; |
| 468 | break; |
| 469 | default: |
| 470 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 471 | } |
| 472 | |
| 473 | return -ENOIOCTLCMD; |
| 474 | } |
| 475 | |
| 476 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 477 | static void whiteheat_set_termios(struct tty_struct *tty, |
| 478 | struct usb_serial_port *port, struct ktermios *old_termios) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 479 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 480 | firm_setup_port(tty); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | } |
| 482 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 483 | static void whiteheat_break_ctl(struct tty_struct *tty, int break_state) |
| 484 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 485 | struct usb_serial_port *port = tty->driver_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 486 | firm_set_break(port, break_state); |
| 487 | } |
| 488 | |
| 489 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 490 | /***************************************************************************** |
| 491 | * Connect Tech's White Heat callback routines |
| 492 | *****************************************************************************/ |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 493 | static void command_port_write_callback(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 494 | { |
Greg Kroah-Hartman | 0540001 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 495 | int status = urb->status; |
| 496 | |
Greg Kroah-Hartman | 0540001 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 497 | if (status) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 498 | dev_dbg(&urb->dev->dev, "nonzero urb status: %d\n", status); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 499 | return; |
| 500 | } |
| 501 | } |
| 502 | |
| 503 | |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 504 | static void command_port_read_callback(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 505 | { |
Ming Lei | cdc9779 | 2008-02-24 18:41:47 +0800 | [diff] [blame] | 506 | struct usb_serial_port *command_port = urb->context; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 507 | struct whiteheat_command_private *command_info; |
Greg Kroah-Hartman | 0540001 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 508 | int status = urb->status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 509 | unsigned char *data = urb->transfer_buffer; |
| 510 | int result; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 511 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 512 | command_info = usb_get_serial_port_data(command_port); |
| 513 | if (!command_info) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 514 | dev_dbg(&urb->dev->dev, "%s - command_info is NULL, exiting.\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 515 | return; |
| 516 | } |
James Forshaw | 6817ae2 | 2014-08-23 14:39:48 -0700 | [diff] [blame] | 517 | if (!urb->actual_length) { |
| 518 | dev_dbg(&urb->dev->dev, "%s - empty response, exiting.\n", __func__); |
| 519 | return; |
| 520 | } |
Greg Kroah-Hartman | 0540001 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 521 | if (status) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 522 | dev_dbg(&urb->dev->dev, "%s - nonzero urb status: %d\n", __func__, status); |
Greg Kroah-Hartman | 0540001 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 523 | if (status != -ENOENT) |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 524 | command_info->command_finished = WHITEHEAT_CMD_FAILURE; |
| 525 | wake_up(&command_info->wait_command); |
| 526 | return; |
| 527 | } |
| 528 | |
Greg Kroah-Hartman | 59d33f2 | 2012-09-18 09:58:57 +0100 | [diff] [blame] | 529 | usb_serial_debug_data(&command_port->dev, __func__, urb->actual_length, data); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 530 | |
| 531 | if (data[0] == WHITEHEAT_CMD_COMPLETE) { |
| 532 | command_info->command_finished = WHITEHEAT_CMD_COMPLETE; |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 533 | wake_up(&command_info->wait_command); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 534 | } else if (data[0] == WHITEHEAT_CMD_FAILURE) { |
| 535 | command_info->command_finished = WHITEHEAT_CMD_FAILURE; |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 536 | wake_up(&command_info->wait_command); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 537 | } else if (data[0] == WHITEHEAT_EVENT) { |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 538 | /* These are unsolicited reports from the firmware, hence no |
| 539 | waiting command to wakeup */ |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 540 | dev_dbg(&urb->dev->dev, "%s - event received\n", __func__); |
James Forshaw | 6817ae2 | 2014-08-23 14:39:48 -0700 | [diff] [blame] | 541 | } else if ((data[0] == WHITEHEAT_GET_DTR_RTS) && |
| 542 | (urb->actual_length - 1 <= sizeof(command_info->result_buffer))) { |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 543 | memcpy(command_info->result_buffer, &data[1], |
| 544 | urb->actual_length - 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 545 | command_info->command_finished = WHITEHEAT_CMD_COMPLETE; |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 546 | wake_up(&command_info->wait_command); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 547 | } else |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 548 | dev_dbg(&urb->dev->dev, "%s - bad reply from firmware\n", __func__); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 549 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 550 | /* Continue trying to always read */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 | result = usb_submit_urb(command_port->read_urb, GFP_ATOMIC); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 552 | if (result) |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 553 | dev_dbg(&urb->dev->dev, "%s - failed resubmitting read urb, error %d\n", |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 554 | __func__, result); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 555 | } |
| 556 | |
| 557 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | /***************************************************************************** |
| 559 | * Connect Tech's White Heat firmware interface |
| 560 | *****************************************************************************/ |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 561 | static int firm_send_command(struct usb_serial_port *port, __u8 command, |
| 562 | __u8 *data, __u8 datasize) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | { |
| 564 | struct usb_serial_port *command_port; |
| 565 | struct whiteheat_command_private *command_info; |
| 566 | struct whiteheat_private *info; |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 567 | struct device *dev = &port->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 568 | __u8 *transfer_buffer; |
| 569 | int retval = 0; |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 570 | int t; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 571 | |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 572 | dev_dbg(dev, "%s - command %d\n", __func__, command); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 573 | |
| 574 | command_port = port->serial->port[COMMAND_PORT]; |
| 575 | command_info = usb_get_serial_port_data(command_port); |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 576 | mutex_lock(&command_info->mutex); |
Richard Knutsson | 38c3cb5 | 2007-03-26 22:00:28 -0800 | [diff] [blame] | 577 | command_info->command_finished = false; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 578 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 579 | transfer_buffer = (__u8 *)command_port->write_urb->transfer_buffer; |
| 580 | transfer_buffer[0] = command; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 581 | memcpy(&transfer_buffer[1], data, datasize); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 582 | command_port->write_urb->transfer_buffer_length = datasize + 1; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 583 | retval = usb_submit_urb(command_port->write_urb, GFP_NOIO); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 584 | if (retval) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 585 | dev_dbg(dev, "%s - submit urb failed\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 586 | goto exit; |
| 587 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 588 | |
| 589 | /* wait for the command to complete */ |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 590 | t = wait_event_timeout(command_info->wait_command, |
Richard Knutsson | 38c3cb5 | 2007-03-26 22:00:28 -0800 | [diff] [blame] | 591 | (bool)command_info->command_finished, COMMAND_TIMEOUT); |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 592 | if (!t) |
| 593 | usb_kill_urb(command_port->write_urb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 594 | |
Richard Knutsson | 38c3cb5 | 2007-03-26 22:00:28 -0800 | [diff] [blame] | 595 | if (command_info->command_finished == false) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 596 | dev_dbg(dev, "%s - command timed out.\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 597 | retval = -ETIMEDOUT; |
| 598 | goto exit; |
| 599 | } |
| 600 | |
| 601 | if (command_info->command_finished == WHITEHEAT_CMD_FAILURE) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 602 | dev_dbg(dev, "%s - command failed.\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 603 | retval = -EIO; |
| 604 | goto exit; |
| 605 | } |
| 606 | |
| 607 | if (command_info->command_finished == WHITEHEAT_CMD_COMPLETE) { |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 608 | dev_dbg(dev, "%s - command completed.\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 609 | switch (command) { |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 610 | case WHITEHEAT_GET_DTR_RTS: |
| 611 | info = usb_get_serial_port_data(port); |
| 612 | memcpy(&info->mcr, command_info->result_buffer, |
| 613 | sizeof(struct whiteheat_dr_info)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 614 | break; |
| 615 | } |
| 616 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 617 | exit: |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 618 | mutex_unlock(&command_info->mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 619 | return retval; |
| 620 | } |
| 621 | |
| 622 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 623 | static int firm_open(struct usb_serial_port *port) |
| 624 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 625 | struct whiteheat_simple open_command; |
| 626 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 627 | open_command.port = port->port_number + 1; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 628 | return firm_send_command(port, WHITEHEAT_OPEN, |
| 629 | (__u8 *)&open_command, sizeof(open_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 630 | } |
| 631 | |
| 632 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 633 | static int firm_close(struct usb_serial_port *port) |
| 634 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 635 | struct whiteheat_simple close_command; |
| 636 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 637 | close_command.port = port->port_number + 1; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 638 | return firm_send_command(port, WHITEHEAT_CLOSE, |
| 639 | (__u8 *)&close_command, sizeof(close_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 640 | } |
| 641 | |
| 642 | |
Alan Cox | fe1ae7f | 2009-09-19 13:13:33 -0700 | [diff] [blame] | 643 | static void firm_setup_port(struct tty_struct *tty) |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 644 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 645 | struct usb_serial_port *port = tty->driver_data; |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 646 | struct device *dev = &port->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 647 | struct whiteheat_port_settings port_settings; |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 648 | unsigned int cflag = tty->termios.c_cflag; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 650 | port_settings.port = port->port_number + 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 651 | |
| 652 | /* get the byte size */ |
| 653 | switch (cflag & CSIZE) { |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 654 | case CS5: port_settings.bits = 5; break; |
| 655 | case CS6: port_settings.bits = 6; break; |
| 656 | case CS7: port_settings.bits = 7; break; |
| 657 | default: |
| 658 | case CS8: port_settings.bits = 8; break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 659 | } |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 660 | dev_dbg(dev, "%s - data bits = %d\n", __func__, port_settings.bits); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 661 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 662 | /* determine the parity */ |
| 663 | if (cflag & PARENB) |
| 664 | if (cflag & CMSPAR) |
| 665 | if (cflag & PARODD) |
| 666 | port_settings.parity = WHITEHEAT_PAR_MARK; |
| 667 | else |
| 668 | port_settings.parity = WHITEHEAT_PAR_SPACE; |
| 669 | else |
| 670 | if (cflag & PARODD) |
| 671 | port_settings.parity = WHITEHEAT_PAR_ODD; |
| 672 | else |
| 673 | port_settings.parity = WHITEHEAT_PAR_EVEN; |
| 674 | else |
| 675 | port_settings.parity = WHITEHEAT_PAR_NONE; |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 676 | dev_dbg(dev, "%s - parity = %c\n", __func__, port_settings.parity); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 677 | |
| 678 | /* figure out the stop bits requested */ |
| 679 | if (cflag & CSTOPB) |
| 680 | port_settings.stop = 2; |
| 681 | else |
| 682 | port_settings.stop = 1; |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 683 | dev_dbg(dev, "%s - stop bits = %d\n", __func__, port_settings.stop); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 | |
| 685 | /* figure out the flow control settings */ |
| 686 | if (cflag & CRTSCTS) |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 687 | port_settings.hflow = (WHITEHEAT_HFLOW_CTS | |
| 688 | WHITEHEAT_HFLOW_RTS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 689 | else |
| 690 | port_settings.hflow = WHITEHEAT_HFLOW_NONE; |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 691 | dev_dbg(dev, "%s - hardware flow control = %s %s %s %s\n", __func__, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 692 | (port_settings.hflow & WHITEHEAT_HFLOW_CTS) ? "CTS" : "", |
| 693 | (port_settings.hflow & WHITEHEAT_HFLOW_RTS) ? "RTS" : "", |
| 694 | (port_settings.hflow & WHITEHEAT_HFLOW_DSR) ? "DSR" : "", |
| 695 | (port_settings.hflow & WHITEHEAT_HFLOW_DTR) ? "DTR" : ""); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 696 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 697 | /* determine software flow control */ |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 698 | if (I_IXOFF(tty)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 699 | port_settings.sflow = WHITEHEAT_SFLOW_RXTX; |
| 700 | else |
| 701 | port_settings.sflow = WHITEHEAT_SFLOW_NONE; |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 702 | dev_dbg(dev, "%s - software flow control = %c\n", __func__, port_settings.sflow); |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 703 | |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 704 | port_settings.xon = START_CHAR(tty); |
| 705 | port_settings.xoff = STOP_CHAR(tty); |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 706 | dev_dbg(dev, "%s - XON = %2x, XOFF = %2x\n", __func__, port_settings.xon, port_settings.xoff); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 707 | |
| 708 | /* get the baud rate wanted */ |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 709 | port_settings.baud = tty_get_baud_rate(tty); |
Greg Kroah-Hartman | 255b703 | 2012-09-14 11:50:35 -0700 | [diff] [blame] | 710 | dev_dbg(dev, "%s - baud rate = %d\n", __func__, port_settings.baud); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 711 | |
Alan Cox | 01d1df2 | 2007-10-18 01:24:23 -0700 | [diff] [blame] | 712 | /* fixme: should set validated settings */ |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 713 | tty_encode_baud_rate(tty, port_settings.baud, port_settings.baud); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 714 | /* handle any settings that aren't specified in the tty structure */ |
| 715 | port_settings.lloop = 0; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 716 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 717 | /* now send the message to the device */ |
Alan Cox | fe1ae7f | 2009-09-19 13:13:33 -0700 | [diff] [blame] | 718 | firm_send_command(port, WHITEHEAT_SETUP_PORT, |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 719 | (__u8 *)&port_settings, sizeof(port_settings)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 720 | } |
| 721 | |
| 722 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 723 | static int firm_set_rts(struct usb_serial_port *port, __u8 onoff) |
| 724 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 725 | struct whiteheat_set_rdb rts_command; |
| 726 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 727 | rts_command.port = port->port_number + 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 728 | rts_command.state = onoff; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 729 | return firm_send_command(port, WHITEHEAT_SET_RTS, |
| 730 | (__u8 *)&rts_command, sizeof(rts_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 731 | } |
| 732 | |
| 733 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 734 | static int firm_set_dtr(struct usb_serial_port *port, __u8 onoff) |
| 735 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 736 | struct whiteheat_set_rdb dtr_command; |
| 737 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 738 | dtr_command.port = port->port_number + 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 739 | dtr_command.state = onoff; |
Alan Cox | 72e2741 | 2008-07-22 11:09:29 +0100 | [diff] [blame] | 740 | return firm_send_command(port, WHITEHEAT_SET_DTR, |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 741 | (__u8 *)&dtr_command, sizeof(dtr_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 742 | } |
| 743 | |
| 744 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 745 | static int firm_set_break(struct usb_serial_port *port, __u8 onoff) |
| 746 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | struct whiteheat_set_rdb break_command; |
| 748 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 749 | break_command.port = port->port_number + 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 750 | break_command.state = onoff; |
Alan Cox | 72e2741 | 2008-07-22 11:09:29 +0100 | [diff] [blame] | 751 | return firm_send_command(port, WHITEHEAT_SET_BREAK, |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 752 | (__u8 *)&break_command, sizeof(break_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 753 | } |
| 754 | |
| 755 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 756 | static int firm_purge(struct usb_serial_port *port, __u8 rxtx) |
| 757 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 758 | struct whiteheat_purge purge_command; |
| 759 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 760 | purge_command.port = port->port_number + 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 761 | purge_command.what = rxtx; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 762 | return firm_send_command(port, WHITEHEAT_PURGE, |
| 763 | (__u8 *)&purge_command, sizeof(purge_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 764 | } |
| 765 | |
| 766 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 767 | static int firm_get_dtr_rts(struct usb_serial_port *port) |
| 768 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 769 | struct whiteheat_simple get_dr_command; |
| 770 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 771 | get_dr_command.port = port->port_number + 1; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 772 | return firm_send_command(port, WHITEHEAT_GET_DTR_RTS, |
| 773 | (__u8 *)&get_dr_command, sizeof(get_dr_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 774 | } |
| 775 | |
| 776 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 777 | static int firm_report_tx_done(struct usb_serial_port *port) |
| 778 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 779 | struct whiteheat_simple close_command; |
| 780 | |
Greg Kroah-Hartman | 1143832 | 2013-06-06 10:32:00 -0700 | [diff] [blame] | 781 | close_command.port = port->port_number + 1; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 782 | return firm_send_command(port, WHITEHEAT_REPORT_TX_DONE, |
| 783 | (__u8 *)&close_command, sizeof(close_command)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 784 | } |
| 785 | |
| 786 | |
| 787 | /***************************************************************************** |
| 788 | * Connect Tech's White Heat utility functions |
| 789 | *****************************************************************************/ |
| 790 | static int start_command_port(struct usb_serial *serial) |
| 791 | { |
| 792 | struct usb_serial_port *command_port; |
| 793 | struct whiteheat_command_private *command_info; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 794 | int retval = 0; |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 795 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 796 | command_port = serial->port[COMMAND_PORT]; |
| 797 | command_info = usb_get_serial_port_data(command_port); |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 798 | mutex_lock(&command_info->mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 799 | if (!command_info->port_running) { |
| 800 | /* Work around HCD bugs */ |
| 801 | usb_clear_halt(serial->dev, command_port->read_urb->pipe); |
| 802 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 803 | retval = usb_submit_urb(command_port->read_urb, GFP_KERNEL); |
| 804 | if (retval) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 805 | dev_err(&serial->dev->dev, |
| 806 | "%s - failed submitting read urb, error %d\n", |
| 807 | __func__, retval); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 808 | goto exit; |
| 809 | } |
| 810 | } |
| 811 | command_info->port_running++; |
| 812 | |
| 813 | exit: |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 814 | mutex_unlock(&command_info->mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 815 | return retval; |
| 816 | } |
| 817 | |
| 818 | |
| 819 | static void stop_command_port(struct usb_serial *serial) |
| 820 | { |
| 821 | struct usb_serial_port *command_port; |
| 822 | struct whiteheat_command_private *command_info; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 823 | |
| 824 | command_port = serial->port[COMMAND_PORT]; |
| 825 | command_info = usb_get_serial_port_data(command_port); |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 826 | mutex_lock(&command_info->mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 827 | command_info->port_running--; |
| 828 | if (!command_info->port_running) |
| 829 | usb_kill_urb(command_port->read_urb); |
Oliver Neukum | 08a2b3b | 2007-05-24 13:52:51 +0200 | [diff] [blame] | 830 | mutex_unlock(&command_info->mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 831 | } |
| 832 | |
Greg Kroah-Hartman | 68e2411 | 2012-05-08 15:46:14 -0700 | [diff] [blame] | 833 | module_usb_serial_driver(serial_drivers, id_table_combined); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 834 | |
Alan Cox | 80359a9 | 2008-07-22 11:09:16 +0100 | [diff] [blame] | 835 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 836 | MODULE_DESCRIPTION(DRIVER_DESC); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 | MODULE_LICENSE("GPL"); |
| 838 | |
David Woodhouse | ec6752f | 2008-05-31 01:35:29 +0300 | [diff] [blame] | 839 | MODULE_FIRMWARE("whiteheat.fw"); |
| 840 | MODULE_FIRMWARE("whiteheat_loader.fw"); |