diff options
Diffstat (limited to 'drivers/staging/quatech_usb2')
-rw-r--r-- | drivers/staging/quatech_usb2/Kconfig | 15 | ||||
-rw-r--r-- | drivers/staging/quatech_usb2/Makefile | 1 | ||||
-rw-r--r-- | drivers/staging/quatech_usb2/TODO | 8 | ||||
-rw-r--r-- | drivers/staging/quatech_usb2/quatech_usb2.c | 2008 |
4 files changed, 2032 insertions, 0 deletions
diff --git a/drivers/staging/quatech_usb2/Kconfig b/drivers/staging/quatech_usb2/Kconfig new file mode 100644 index 00000000000..1494f42f3da --- /dev/null +++ b/drivers/staging/quatech_usb2/Kconfig | |||
@@ -0,0 +1,15 @@ | |||
1 | config USB_SERIAL_QUATECH_USB2 | ||
2 | tristate "USB Quatech xSU2-[14]00 USB Serial Driver" | ||
3 | depends on USB_SERIAL | ||
4 | help | ||
5 | Say Y here if you want to use a Quatech USB2.0 to serial adaptor. This | ||
6 | driver supports the SSU2-100, DSU2-100, DSU2-400, QSU2-100, QSU2-400, | ||
7 | ESU2-400 and ESU2-100 USB2.0 to RS232 / 485 / 422 serial adaptors. | ||
8 | |||
9 | Some hardware has an incorrect product string and announces itself as | ||
10 | ESU-100 (which uses the serqt driver) even though it is an ESU2-100. | ||
11 | Check the label on the bottom of your device. | ||
12 | |||
13 | To compile this driver as a module, choose M here: the module will be | ||
14 | called quatech_usb2 . | ||
15 | |||
diff --git a/drivers/staging/quatech_usb2/Makefile b/drivers/staging/quatech_usb2/Makefile new file mode 100644 index 00000000000..bcd1f890d16 --- /dev/null +++ b/drivers/staging/quatech_usb2/Makefile | |||
@@ -0,0 +1 @@ | |||
obj-$(CONFIG_USB_SERIAL_QUATECH_USB2) += quatech_usb2.o | |||
diff --git a/drivers/staging/quatech_usb2/TODO b/drivers/staging/quatech_usb2/TODO new file mode 100644 index 00000000000..67f61dbe14a --- /dev/null +++ b/drivers/staging/quatech_usb2/TODO | |||
@@ -0,0 +1,8 @@ | |||
1 | Incomplete list of things that this driver does not yet implement completely or | ||
2 | at all. some of these may not be possible to implement because the hardware | ||
3 | support does not exist. Others may be possible, but the magic control codes to | ||
4 | make them happen are unknown, and some may just need the driver support to | ||
5 | implement them writing. | ||
6 | |||
7 | * Mark/Space parity is not implemented (reported back correctly) | ||
8 | * IXANY flow control mode is not implemented (flag ignored completely) | ||
diff --git a/drivers/staging/quatech_usb2/quatech_usb2.c b/drivers/staging/quatech_usb2/quatech_usb2.c new file mode 100644 index 00000000000..02fafecd477 --- /dev/null +++ b/drivers/staging/quatech_usb2/quatech_usb2.c | |||
@@ -0,0 +1,2008 @@ | |||
1 | /* | ||
2 | * Driver for Quatech Inc USB2.0 to serial adaptors. Largely unrelated to the | ||
3 | * serqt_usb driver, based on a re-write of the vendor supplied serqt_usb2 code, | ||
4 | * which is unrelated to the serqt_usb2 in the staging kernel | ||
5 | */ | ||
6 | |||
7 | #include <linux/errno.h> | ||
8 | #include <linux/init.h> | ||
9 | #include <linux/slab.h> | ||
10 | #include <linux/tty.h> | ||
11 | #include <linux/tty_driver.h> | ||
12 | #include <linux/tty_flip.h> | ||
13 | #include <linux/module.h> | ||
14 | #include <linux/serial.h> | ||
15 | #include <linux/usb.h> | ||
16 | #include <linux/usb/serial.h> | ||
17 | #include <linux/uaccess.h> | ||
18 | |||
19 | static int debug; | ||
20 | |||
21 | /* Version Information */ | ||
22 | #define DRIVER_VERSION "v2.00" | ||
23 | #define DRIVER_AUTHOR "Tim Gobeli, Quatech, Inc" | ||
24 | #define DRIVER_DESC "Quatech USB 2.0 to Serial Driver" | ||
25 | |||
26 | /* vendor and device IDs */ | ||
27 | #define USB_VENDOR_ID_QUATECH 0x061d /* Quatech VID */ | ||
28 | #define QUATECH_SSU2_100 0xC120 /* RS232 single port */ | ||
29 | #define QUATECH_DSU2_100 0xC140 /* RS232 dual port */ | ||
30 | #define QUATECH_DSU2_400 0xC150 /* RS232/422/485 dual port */ | ||
31 | #define QUATECH_QSU2_100 0xC160 /* RS232 four port */ | ||
32 | #define QUATECH_QSU2_400 0xC170 /* RS232/422/485 four port */ | ||
33 | #define QUATECH_ESU2_100 0xC1A0 /* RS232 eight port */ | ||
34 | #define QUATECH_ESU2_400 0xC180 /* RS232/422/485 eight port */ | ||
35 | |||
36 | /* magic numbers go here, when we find out which ones are needed */ | ||
37 | |||
38 | #define QU2BOXPWRON 0x8000 /* magic number to turn FPGA power on */ | ||
39 | #define QU2BOX232 0x40 /* RS232 mode on MEI devices */ | ||
40 | #define QU2BOXSPD9600 0x60 /* set speed to 9600 baud */ | ||
41 | #define QT2_FIFO_DEPTH 1024 /* size of hardware fifos */ | ||
42 | #define QT2_TX_HEADER_LENGTH 5 | ||
43 | /* length of the header sent to the box with each write URB */ | ||
44 | |||
45 | /* directions for USB transfers */ | ||
46 | #define USBD_TRANSFER_DIRECTION_IN 0xc0 | ||
47 | #define USBD_TRANSFER_DIRECTION_OUT 0x40 | ||
48 | |||
49 | /* special Quatech command IDs. These are pushed down the | ||
50 | USB control pipe to get the box on the end to do things */ | ||
51 | #define QT_SET_GET_DEVICE 0xc2 | ||
52 | #define QT_OPEN_CLOSE_CHANNEL 0xca | ||
53 | /*#define QT_GET_SET_PREBUF_TRIG_LVL 0xcc | ||
54 | #define QT_SET_ATF 0xcd*/ | ||
55 | #define QT2_GET_SET_REGISTER 0xc0 | ||
56 | #define QT2_GET_SET_UART 0xc1 | ||
57 | #define QT2_HW_FLOW_CONTROL_MASK 0xc5 | ||
58 | #define QT2_SW_FLOW_CONTROL_MASK 0xc6 | ||
59 | #define QT2_SW_FLOW_CONTROL_DISABLE 0xc7 | ||
60 | #define QT2_BREAK_CONTROL 0xc8 | ||
61 | #define QT2_STOP_RECEIVE 0xe0 | ||
62 | #define QT2_FLUSH_DEVICE 0xc4 | ||
63 | #define QT2_GET_SET_QMCR 0xe1 | ||
64 | |||
65 | /* sorts of flush we can do on */ | ||
66 | #define QT2_FLUSH_RX 0x00 | ||
67 | #define QT2_FLUSH_TX 0x01 | ||
68 | |||
69 | /* port setting constants, used to set up serial port speeds, flow | ||
70 | * control and so on */ | ||
71 | #define QT2_SERIAL_MCR_DTR 0x01 | ||
72 | #define QT2_SERIAL_MCR_RTS 0x02 | ||
73 | #define QT2_SERIAL_MCR_LOOP 0x10 | ||
74 | |||
75 | #define QT2_SERIAL_MSR_CTS 0x10 | ||
76 | #define QT2_SERIAL_MSR_CD 0x80 | ||
77 | #define QT2_SERIAL_MSR_RI 0x40 | ||
78 | #define QT2_SERIAL_MSR_DSR 0x20 | ||
79 | #define QT2_SERIAL_MSR_MASK 0xf0 | ||
80 | |||
81 | #define QT2_SERIAL_8_DATA 0x03 | ||
82 | #define QT2_SERIAL_7_DATA 0x02 | ||
83 | #define QT2_SERIAL_6_DATA 0x01 | ||
84 | #define QT2_SERIAL_5_DATA 0x00 | ||
85 | |||
86 | #define QT2_SERIAL_ODD_PARITY 0x08 | ||
87 | #define QT2_SERIAL_EVEN_PARITY 0x18 | ||
88 | #define QT2_SERIAL_TWO_STOPB 0x04 | ||
89 | #define QT2_SERIAL_ONE_STOPB 0x00 | ||
90 | |||
91 | #define QT2_MAX_BAUD_RATE 921600 | ||
92 | #define QT2_MAX_BAUD_REMAINDER 4608 | ||
93 | |||
94 | #define QT2_SERIAL_LSR_OE 0x02 | ||
95 | #define QT2_SERIAL_LSR_PE 0x04 | ||
96 | #define QT2_SERIAL_LSR_FE 0x08 | ||
97 | #define QT2_SERIAL_LSR_BI 0x10 | ||
98 | |||
99 | /* value of Line Status Register when UART has completed | ||
100 | * emptying data out on the line */ | ||
101 | #define QT2_LSR_TEMT 0x40 | ||
102 | |||
103 | /* register numbers on each UART, for use with qt2_box_[get|set]_register*/ | ||
104 | #define QT2_XMT_HOLD_REGISTER 0x00 | ||
105 | #define QT2_XVR_BUFFER_REGISTER 0x00 | ||
106 | #define QT2_FIFO_CONTROL_REGISTER 0x02 | ||
107 | #define QT2_LINE_CONTROL_REGISTER 0x03 | ||
108 | #define QT2_MODEM_CONTROL_REGISTER 0x04 | ||
109 | #define QT2_LINE_STATUS_REGISTER 0x05 | ||
110 | #define QT2_MODEM_STATUS_REGISTER 0x06 | ||
111 | |||
112 | /* handy macros for doing escape sequence parsing on data reads */ | ||
113 | #define THISCHAR ((unsigned char *)(urb->transfer_buffer))[i] | ||
114 | #define NEXTCHAR ((unsigned char *)(urb->transfer_buffer))[i + 1] | ||
115 | #define THIRDCHAR ((unsigned char *)(urb->transfer_buffer))[i + 2] | ||
116 | #define FOURTHCHAR ((unsigned char *)(urb->transfer_buffer))[i + 3] | ||
117 | #define FIFTHCHAR ((unsigned char *)(urb->transfer_buffer))[i + 4] | ||
118 | |||
119 | static const struct usb_device_id quausb2_id_table[] = { | ||
120 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_SSU2_100)}, | ||
121 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_DSU2_100)}, | ||
122 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_DSU2_400)}, | ||
123 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_QSU2_100)}, | ||
124 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_QSU2_400)}, | ||
125 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_ESU2_100)}, | ||
126 | {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_ESU2_400)}, | ||
127 | {} /* Terminating entry */ | ||
128 | }; | ||
129 | |||
130 | MODULE_DEVICE_TABLE(usb, quausb2_id_table); | ||
131 | |||
132 | /* custom structures we need go here */ | ||
133 | static struct usb_driver quausb2_usb_driver = { | ||
134 | .name = "quatech-usb2-serial", | ||
135 | .probe = usb_serial_probe, | ||
136 | .disconnect = usb_serial_disconnect, | ||
137 | .id_table = quausb2_id_table, | ||
138 | .no_dynamic_id = 1, | ||
139 | }; | ||
140 | |||
141 | /** | ||
142 | * quatech2_port: Structure in which to keep all the messy stuff that this | ||
143 | * driver needs alongside the usb_serial_port structure | ||
144 | * @read_urb_busy: Flag indicating that port->read_urb is in use | ||
145 | * @close_pending: flag indicating that this port is in the process of | ||
146 | * being closed (and so no new reads / writes should be started). | ||
147 | * @shadowLSR: Last received state of the line status register, holds the | ||
148 | * value of the line status flags from the port | ||
149 | * @shadowMSR: Last received state of the modem status register, holds | ||
150 | * the value of the modem status received from the port | ||
151 | * @rcv_flush: Flag indicating that a receive flush has occurred on | ||
152 | * the hardware. | ||
153 | * @xmit_flush: Flag indicating that a transmit flush has been processed by | ||
154 | * the hardware. | ||
155 | * @tx_pending_bytes: Number of bytes waiting to be sent. This total | ||
156 | * includes the size (excluding header) of URBs that have been submitted but | ||
157 | * have not yet been sent to to the device, and bytes that have been sent out | ||
158 | * of the port but not yet reported sent by the "xmit_empty" messages (which | ||
159 | * indicate the number of bytes sent each time they are received, despite the | ||
160 | * misleading name). | ||
161 | * - Starts at zero when port is initialised. | ||
162 | * - is incremented by the size of the data to be written (no headers) | ||
163 | * each time a write urb is dispatched. | ||
164 | * - is decremented each time a "transmit empty" message is received | ||
165 | * by the driver in the data stream. | ||
166 | * @lock: Mutex to lock access to this structure when we need to ensure that | ||
167 | * races don't occur to access bits of it. | ||
168 | * @open_count: The number of uses of the port currently having | ||
169 | * it open, i.e. the reference count. | ||
170 | */ | ||
171 | struct quatech2_port { | ||
172 | int magic; | ||
173 | bool read_urb_busy; | ||
174 | bool close_pending; | ||
175 | __u8 shadowLSR; | ||
176 | __u8 shadowMSR; | ||
177 | bool rcv_flush; | ||
178 | bool xmit_flush; | ||
179 | int tx_pending_bytes; | ||
180 | struct mutex modelock; | ||
181 | int open_count; | ||
182 | |||
183 | char active; /* someone has this device open */ | ||
184 | unsigned char *xfer_to_tty_buffer; | ||
185 | wait_queue_head_t wait; | ||
186 | __u8 shadowLCR; /* last LCR value received */ | ||
187 | __u8 shadowMCR; /* last MCR value received */ | ||
188 | char RxHolding; | ||
189 | struct semaphore pend_xmit_sem; /* locks this structure */ | ||
190 | spinlock_t lock; | ||
191 | }; | ||
192 | |||
193 | /** | ||
194 | * Structure to hold device-wide internal status information | ||
195 | * @param ReadBulkStopped The last bulk read attempt ended in tears | ||
196 | * @param open_ports The number of serial ports currently in use on the box | ||
197 | * @param current_port Pointer to the serial port structure of the port which | ||
198 | * the read stream is currently directed to. Escape sequences in the read | ||
199 | * stream will change this around as data arrives from different ports on the | ||
200 | * box | ||
201 | * @buffer_size: The max size buffer each URB can take, used to set the size of | ||
202 | * the buffers allocated for writing to each port on the device (we need to | ||
203 | * store this because it is known only to the endpoint, but used each time a | ||
204 | * port is opened and a new buffer is allocated. | ||
205 | */ | ||
206 | struct quatech2_dev { | ||
207 | bool ReadBulkStopped; | ||
208 | char open_ports; | ||
209 | struct usb_serial_port *current_port; | ||
210 | int buffer_size; | ||
211 | }; | ||
212 | |||
213 | /* structure which holds line and modem status flags */ | ||
214 | struct qt2_status_data { | ||
215 | __u8 line_status; | ||
216 | __u8 modem_status; | ||
217 | }; | ||
218 | |||
219 | /* Function prototypes */ | ||
220 | static int qt2_boxpoweron(struct usb_serial *serial); | ||
221 | static int qt2_boxsetQMCR(struct usb_serial *serial, __u16 Uart_Number, | ||
222 | __u8 QMCR_Value); | ||
223 | static int port_paranoia_check(struct usb_serial_port *port, | ||
224 | const char *function); | ||
225 | static int serial_paranoia_check(struct usb_serial *serial, | ||
226 | const char *function); | ||
227 | static inline struct quatech2_port *qt2_get_port_private(struct usb_serial_port | ||
228 | *port); | ||
229 | static inline void qt2_set_port_private(struct usb_serial_port *port, | ||
230 | struct quatech2_port *data); | ||
231 | static inline struct quatech2_dev *qt2_get_dev_private(struct usb_serial | ||
232 | *serial); | ||
233 | static inline void qt2_set_dev_private(struct usb_serial *serial, | ||
234 | struct quatech2_dev *data); | ||
235 | static int qt2_openboxchannel(struct usb_serial *serial, __u16 | ||
236 | Uart_Number, struct qt2_status_data *pDeviceData); | ||
237 | static int qt2_closeboxchannel(struct usb_serial *serial, __u16 | ||
238 | Uart_Number); | ||
239 | static int qt2_conf_uart(struct usb_serial *serial, unsigned short Uart_Number, | ||
240 | unsigned short divisor, unsigned char LCR); | ||
241 | static void qt2_read_bulk_callback(struct urb *urb); | ||
242 | static void qt2_write_bulk_callback(struct urb *urb); | ||
243 | static void qt2_process_line_status(struct usb_serial_port *port, | ||
244 | unsigned char LineStatus); | ||
245 | static void qt2_process_modem_status(struct usb_serial_port *port, | ||
246 | unsigned char ModemStatus); | ||
247 | static void qt2_process_xmit_empty(struct usb_serial_port *port, | ||
248 | unsigned char fourth_char, unsigned char fifth_char); | ||
249 | static void qt2_process_port_change(struct usb_serial_port *port, | ||
250 | unsigned char New_Current_Port); | ||
251 | static void qt2_process_rcv_flush(struct usb_serial_port *port); | ||
252 | static void qt2_process_xmit_flush(struct usb_serial_port *port); | ||
253 | static void qt2_process_rx_char(struct usb_serial_port *port, | ||
254 | unsigned char data); | ||
255 | static int qt2_box_get_register(struct usb_serial *serial, | ||
256 | unsigned char uart_number, unsigned short register_num, | ||
257 | __u8 *pValue); | ||
258 | static int qt2_box_set_register(struct usb_serial *serial, | ||
259 | unsigned short Uart_Number, unsigned short Register_Num, | ||
260 | unsigned short Value); | ||
261 | static int qt2_boxsetuart(struct usb_serial *serial, unsigned short Uart_Number, | ||
262 | unsigned short default_divisor, unsigned char default_LCR); | ||
263 | static int qt2_boxsethw_flowctl(struct usb_serial *serial, | ||
264 | unsigned int UartNumber, bool bSet); | ||
265 | static int qt2_boxsetsw_flowctl(struct usb_serial *serial, __u16 UartNumber, | ||
266 | unsigned char stop_char, unsigned char start_char); | ||
267 | static int qt2_boxunsetsw_flowctl(struct usb_serial *serial, __u16 UartNumber); | ||
268 | static int qt2_boxstoprx(struct usb_serial *serial, unsigned short uart_number, | ||
269 | unsigned short stop); | ||
270 | |||
271 | /* implementation functions, roughly in order of use, are here */ | ||
272 | static int qt2_calc_num_ports(struct usb_serial *serial) | ||
273 | { | ||
274 | int num_ports; | ||
275 | int flag_as_400; | ||
276 | switch (serial->dev->descriptor.idProduct) { | ||
277 | case QUATECH_SSU2_100: | ||
278 | num_ports = 1; | ||
279 | break; | ||
280 | |||
281 | case QUATECH_DSU2_400: | ||
282 | flag_as_400 = true; | ||
283 | case QUATECH_DSU2_100: | ||
284 | num_ports = 2; | ||
285 | break; | ||
286 | |||
287 | case QUATECH_QSU2_400: | ||
288 | flag_as_400 = true; | ||
289 | case QUATECH_QSU2_100: | ||
290 | num_ports = 4; | ||
291 | break; | ||
292 | |||
293 | case QUATECH_ESU2_400: | ||
294 | flag_as_400 = true; | ||
295 | case QUATECH_ESU2_100: | ||
296 | num_ports = 8; | ||
297 | break; | ||
298 | default: | ||
299 | num_ports = 1; | ||
300 | break; | ||
301 | } | ||
302 | return num_ports; | ||
303 | } | ||
304 | |||
305 | static int qt2_attach(struct usb_serial *serial) | ||
306 | { | ||
307 | struct usb_serial_port *port; | ||
308 | struct quatech2_port *qt2_port; /* port-specific private data pointer */ | ||
309 | struct quatech2_dev *qt2_dev; /* dev-specific private data pointer */ | ||
310 | int i; | ||
311 | /* stuff for storing endpoint addresses now */ | ||
312 | struct usb_endpoint_descriptor *endpoint; | ||
313 | struct usb_host_interface *iface_desc; | ||
314 | struct usb_serial_port *port0; /* first port structure on device */ | ||
315 | |||
316 | /* check how many endpoints there are on the device, for | ||
317 | * sanity's sake */ | ||
318 | dbg("%s(): Endpoints: %d bulk in, %d bulk out, %d interrupt in", | ||
319 | __func__, serial->num_bulk_in, | ||
320 | serial->num_bulk_out, serial->num_interrupt_in); | ||
321 | if ((serial->num_bulk_in != 1) || (serial->num_bulk_out != 1)) { | ||
322 | dbg("Device has wrong number of bulk endpoints!"); | ||
323 | return -ENODEV; | ||
324 | } | ||
325 | iface_desc = serial->interface->cur_altsetting; | ||
326 | |||
327 | /* Set up per-device private data, storing extra data alongside | ||
328 | * struct usb_serial */ | ||
329 | qt2_dev = kzalloc(sizeof(*qt2_dev), GFP_KERNEL); | ||
330 | if (!qt2_dev) { | ||
331 | dbg("%s: kmalloc for quatech2_dev failed!", | ||
332 | __func__); | ||
333 | return -ENOMEM; | ||
334 | } | ||
335 | qt2_dev->open_ports = 0; /* no ports open */ | ||
336 | qt2_set_dev_private(serial, qt2_dev); /* store private data */ | ||
337 | |||
338 | /* Now setup per port private data, which replaces all the things | ||
339 | * that quatech added to standard kernel structures in their driver */ | ||
340 | for (i = 0; i < serial->num_ports; i++) { | ||
341 | port = serial->port[i]; | ||
342 | qt2_port = kzalloc(sizeof(*qt2_port), GFP_KERNEL); | ||
343 | if (!qt2_port) { | ||
344 | dbg("%s: kmalloc for quatech2_port (%d) failed!.", | ||
345 | __func__, i); | ||
346 | return -ENOMEM; | ||
347 | } | ||
348 | /* initialise stuff in the structure */ | ||
349 | qt2_port->open_count = 0; /* port is not open */ | ||
350 | spin_lock_init(&qt2_port->lock); | ||
351 | mutex_init(&qt2_port->modelock); | ||
352 | qt2_set_port_private(port, qt2_port); | ||
353 | } | ||
354 | |||
355 | /* gain access to port[0]'s structure because we want to store | ||
356 | * device-level stuff in it */ | ||
357 | if (serial_paranoia_check(serial, __func__)) | ||
358 | return -ENODEV; | ||
359 | port0 = serial->port[0]; /* get the first port's device structure */ | ||
360 | |||
361 | /* print endpoint addresses so we can check them later | ||
362 | * by hand */ | ||
363 | for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) { | ||
364 | endpoint = &iface_desc->endpoint[i].desc; | ||
365 | if ((endpoint->bEndpointAddress & 0x80) && | ||
366 | ((endpoint->bmAttributes & 3) == 0x02)) { | ||
367 | /* we found a bulk in endpoint */ | ||
368 | dbg("found bulk in at %#.2x", | ||
369 | endpoint->bEndpointAddress); | ||
370 | } | ||
371 | |||
372 | if (((endpoint->bEndpointAddress & 0x80) == 0x00) && | ||
373 | ((endpoint->bmAttributes & 3) == 0x02)) { | ||
374 | /* we found a bulk out endpoint */ | ||
375 | dbg("found bulk out at %#.2x", | ||
376 | endpoint->bEndpointAddress); | ||
377 | qt2_dev->buffer_size = endpoint->wMaxPacketSize; | ||
378 | /* max size of URB needs recording for the device */ | ||
379 | } | ||
380 | } /* end printing endpoint addresses */ | ||
381 | |||
382 | /* switch on power to the hardware */ | ||
383 | if (qt2_boxpoweron(serial) < 0) { | ||
384 | dbg("qt2_boxpoweron() failed"); | ||
385 | goto startup_error; | ||
386 | } | ||
387 | /* set all ports to RS232 mode */ | ||
388 | for (i = 0; i < serial->num_ports; ++i) { | ||
389 | if (qt2_boxsetQMCR(serial, i, QU2BOX232) < 0) { | ||
390 | dbg("qt2_boxsetQMCR() on port %d failed", | ||
391 | i); | ||
392 | goto startup_error; | ||
393 | } | ||
394 | } | ||
395 | |||
396 | return 0; | ||
397 | |||
398 | startup_error: | ||
399 | for (i = 0; i < serial->num_ports; i++) { | ||
400 | port = serial->port[i]; | ||
401 | qt2_port = qt2_get_port_private(port); | ||
402 | kfree(qt2_port); | ||
403 | qt2_set_port_private(port, NULL); | ||
404 | } | ||
405 | qt2_dev = qt2_get_dev_private(serial); | ||
406 | kfree(qt2_dev); | ||
407 | qt2_set_dev_private(serial, NULL); | ||
408 | |||
409 | dbg("Exit fail %s\n", __func__); | ||
410 | return -EIO; | ||
411 | } | ||
412 | |||
413 | static void qt2_release(struct usb_serial *serial) | ||
414 | { | ||
415 | struct usb_serial_port *port; | ||
416 | struct quatech2_port *qt_port; | ||
417 | int i; | ||
418 | |||
419 | dbg("enterting %s", __func__); | ||
420 | |||
421 | for (i = 0; i < serial->num_ports; i++) { | ||
422 | port = serial->port[i]; | ||
423 | if (!port) | ||
424 | continue; | ||
425 | |||
426 | qt_port = usb_get_serial_port_data(port); | ||
427 | kfree(qt_port); | ||
428 | usb_set_serial_port_data(port, NULL); | ||
429 | } | ||
430 | } | ||
431 | /* This function is called once per serial port on the device, when | ||
432 | * that port is opened by a userspace application. | ||
433 | * The tty_struct and the usb_serial_port belong to this port, | ||
434 | * i.e. there are multiple ones for a multi-port device. | ||
435 | * However the usb_serial_port structure has a back-pointer | ||
436 | * to the parent usb_serial structure which belongs to the device, | ||
437 | * so we can access either the device-wide information or | ||
438 | * any other port's information (because there are also forward | ||
439 | * pointers) via that pointer. | ||
440 | * This is most helpful if the device shares resources (e.g. end | ||
441 | * points) between different ports | ||
442 | */ | ||
443 | int qt2_open(struct tty_struct *tty, struct usb_serial_port *port) | ||
444 | { | ||
445 | struct usb_serial *serial; /* device structure */ | ||
446 | struct usb_serial_port *port0; /* first port structure on device */ | ||
447 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
448 | struct quatech2_port *port0_extra; /* extra data for first port */ | ||
449 | struct quatech2_dev *dev_extra; /* extra data for the device */ | ||
450 | struct qt2_status_data ChannelData; | ||
451 | unsigned short default_divisor = QU2BOXSPD9600; | ||
452 | unsigned char default_LCR = QT2_SERIAL_8_DATA; | ||
453 | int status; | ||
454 | int result; | ||
455 | |||
456 | if (port_paranoia_check(port, __func__)) | ||
457 | return -ENODEV; | ||
458 | |||
459 | dbg("%s(): port %d", __func__, port->number); | ||
460 | |||
461 | serial = port->serial; /* get the parent device structure */ | ||
462 | if (serial_paranoia_check(serial, __func__)) { | ||
463 | dbg("usb_serial struct failed sanity check"); | ||
464 | return -ENODEV; | ||
465 | } | ||
466 | dev_extra = qt2_get_dev_private(serial); | ||
467 | /* get the device private data */ | ||
468 | if (dev_extra == NULL) { | ||
469 | dbg("device extra data pointer is null"); | ||
470 | return -ENODEV; | ||
471 | } | ||
472 | port0 = serial->port[0]; /* get the first port's device structure */ | ||
473 | if (port_paranoia_check(port0, __func__)) { | ||
474 | dbg("port0 usb_serial_port struct failed sanity check"); | ||
475 | return -ENODEV; | ||
476 | } | ||
477 | |||
478 | port_extra = qt2_get_port_private(port); | ||
479 | port0_extra = qt2_get_port_private(port0); | ||
480 | if (port_extra == NULL || port0_extra == NULL) { | ||
481 | dbg("failed to get private data for port or port0"); | ||
482 | return -ENODEV; | ||
483 | } | ||
484 | |||
485 | /* FIXME: are these needed? Does it even do anything useful? */ | ||
486 | /* get the modem and line status values from the UART */ | ||
487 | status = qt2_openboxchannel(serial, port->number, | ||
488 | &ChannelData); | ||
489 | if (status < 0) { | ||
490 | dbg("qt2_openboxchannel on channel %d failed", | ||
491 | port->number); | ||
492 | return status; | ||
493 | } | ||
494 | port_extra->shadowLSR = ChannelData.line_status & | ||
495 | (QT2_SERIAL_LSR_OE | QT2_SERIAL_LSR_PE | | ||
496 | QT2_SERIAL_LSR_FE | QT2_SERIAL_LSR_BI); | ||
497 | port_extra->shadowMSR = ChannelData.modem_status & | ||
498 | (QT2_SERIAL_MSR_CTS | QT2_SERIAL_MSR_DSR | | ||
499 | QT2_SERIAL_MSR_RI | QT2_SERIAL_MSR_CD); | ||
500 | |||
501 | /* port_extra->fifo_empty_flag = true;*/ | ||
502 | dbg("qt2_openboxchannel on channel %d completed.", | ||
503 | port->number); | ||
504 | |||
505 | /* Set Baud rate to default and turn off flow control here */ | ||
506 | status = qt2_conf_uart(serial, port->number, default_divisor, | ||
507 | default_LCR); | ||
508 | if (status < 0) { | ||
509 | dbg("qt2_conf_uart() failed on channel %d", | ||
510 | port->number); | ||
511 | return status; | ||
512 | } | ||
513 | dbg("qt2_conf_uart() completed on channel %d", | ||
514 | port->number); | ||
515 | |||
516 | /* | ||
517 | * At this point we will need some end points to make further progress. | ||
518 | * Handlily, the correct endpoint addresses have been filled out into | ||
519 | * the usb_serial_port structure for us by the driver core, so we | ||
520 | * already have access to them. | ||
521 | * As there is only one bulk in and one bulk out end-point, these are in | ||
522 | * port[0]'s structure, and the rest are uninitialised. Handily, | ||
523 | * when we do a write to a port, we will use the same endpoint | ||
524 | * regardless of the port, with a 5-byte header added on to | ||
525 | * tell the box which port it should eventually come out of, so we only | ||
526 | * need the one set of endpoints. We will have one URB per port for | ||
527 | * writing, so that multiple ports can be writing at once. | ||
528 | * Finally we need a bulk in URB to use for background reads from the | ||
529 | * device, which will deal with uplink data from the box to host. | ||
530 | */ | ||
531 | dbg("port0 bulk in endpoint is %#.2x", port0->bulk_in_endpointAddress); | ||
532 | dbg("port0 bulk out endpoint is %#.2x", | ||
533 | port0->bulk_out_endpointAddress); | ||
534 | |||
535 | /* set up write_urb for bulk out transfers on this port. The USB | ||
536 | * serial framework will have allocated a blank URB, buffer etc for | ||
537 | * port0 when it put the endpoints there, but not for any of the other | ||
538 | * ports on the device because there are no more endpoints. Thus we | ||
539 | * have to allocate our own URBs for ports 1-7 | ||
540 | */ | ||
541 | if (port->write_urb == NULL) { | ||
542 | dbg("port->write_urb == NULL, allocating one"); | ||
543 | port->write_urb = usb_alloc_urb(0, GFP_KERNEL); | ||
544 | if (!port->write_urb) { | ||
545 | err("Allocating write URB failed"); | ||
546 | return -ENOMEM; | ||
547 | } | ||
548 | /* buffer same size as port0 */ | ||
549 | port->bulk_out_size = dev_extra->buffer_size; | ||
550 | port->bulk_out_buffer = kmalloc(port->bulk_out_size, | ||
551 | GFP_KERNEL); | ||
552 | if (!port->bulk_out_buffer) { | ||
553 | err("Couldn't allocate bulk_out_buffer"); | ||
554 | return -ENOMEM; | ||
555 | } | ||
556 | } | ||
557 | if (serial->dev == NULL) | ||
558 | dbg("serial->dev == NULL"); | ||
559 | dbg("port->bulk_out_size is %d", port->bulk_out_size); | ||
560 | |||
561 | usb_fill_bulk_urb(port->write_urb, serial->dev, | ||
562 | usb_sndbulkpipe(serial->dev, | ||
563 | port0->bulk_out_endpointAddress), | ||
564 | port->bulk_out_buffer, | ||
565 | port->bulk_out_size, | ||
566 | qt2_write_bulk_callback, | ||
567 | port); | ||
568 | port_extra->tx_pending_bytes = 0; | ||
569 | |||
570 | if (dev_extra->open_ports == 0) { | ||
571 | /* this is first port to be opened, so need the read URB | ||
572 | * initialised for bulk in transfers (this is shared amongst | ||
573 | * all the ports on the device) */ | ||
574 | usb_fill_bulk_urb(port0->read_urb, serial->dev, | ||
575 | usb_rcvbulkpipe(serial->dev, | ||
576 | port0->bulk_in_endpointAddress), | ||
577 | port0->bulk_in_buffer, | ||
578 | port0->bulk_in_size, | ||
579 | qt2_read_bulk_callback, serial); | ||
580 | dbg("port0 bulk in URB initialised"); | ||
581 | |||
582 | /* submit URB, i.e. start reading from device (async) */ | ||
583 | dev_extra->ReadBulkStopped = false; | ||
584 | port_extra->read_urb_busy = true; | ||
585 | result = usb_submit_urb(port->read_urb, GFP_KERNEL); | ||
586 | if (result) { | ||
587 | dev_err(&port->dev, | ||
588 | "%s(): Error %d submitting bulk in urb", | ||
589 | __func__, result); | ||
590 | port_extra->read_urb_busy = false; | ||
591 | dev_extra->ReadBulkStopped = true; | ||
592 | } | ||
593 | |||
594 | /* When the first port is opened, initialise the value of | ||
595 | * current_port in dev_extra to this port, so it is set | ||
596 | * to something. Once the box sends data it will send the | ||
597 | * relevant escape sequences to get it to the right port anyway | ||
598 | */ | ||
599 | dev_extra->current_port = port; | ||
600 | } | ||
601 | |||
602 | /* initialize our wait queues */ | ||
603 | init_waitqueue_head(&port_extra->wait); | ||
604 | /* increment the count of openings of this port by one */ | ||
605 | port_extra->open_count++; | ||
606 | |||
607 | /* remember to store dev_extra, port_extra and port0_extra back again at | ||
608 | * end !*/ | ||
609 | qt2_set_port_private(port, port_extra); | ||
610 | qt2_set_port_private(serial->port[0], port0_extra); | ||
611 | qt2_set_dev_private(serial, dev_extra); | ||
612 | |||
613 | dev_extra->open_ports++; /* one more port opened */ | ||
614 | |||
615 | return 0; | ||
616 | } | ||
617 | |||
618 | /* called when a port is closed by userspace. It won't be called, however, | ||
619 | * until calls to chars_in_buffer() reveal that the port has completed | ||
620 | * sending buffered data, and there is nothing else to do. Thus we don't have | ||
621 | * to rely on forcing data through in this function. */ | ||
622 | /* Setting close_pending should keep new data from being written out, | ||
623 | * once all the data in the enpoint buffers is moved out we won't get | ||
624 | * any more. */ | ||
625 | /* BoxStopReceive would keep any more data from coming from a given | ||
626 | * port, but isn't called by the vendor driver, although their comments | ||
627 | * mention it. Should it be used here to stop the inbound data | ||
628 | * flow? | ||
629 | */ | ||
630 | static void qt2_close(struct usb_serial_port *port) | ||
631 | { | ||
632 | /* time out value for flush loops */ | ||
633 | unsigned long jift; | ||
634 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
635 | struct usb_serial *serial; /* device structure */ | ||
636 | struct quatech2_dev *dev_extra; /* extra data for the device */ | ||
637 | __u8 lsr_value = 0; /* value of Line Status Register */ | ||
638 | int status; /* result of last USB comms function */ | ||
639 | |||
640 | dbg("%s(): port %d", __func__, port->number); | ||
641 | serial = port->serial; /* get the parent device structure */ | ||
642 | dev_extra = qt2_get_dev_private(serial); | ||
643 | /* get the device private data */ | ||
644 | port_extra = qt2_get_port_private(port); /* port private data */ | ||
645 | |||
646 | /* we can now (and only now) stop reading data */ | ||
647 | port_extra->close_pending = true; | ||
648 | dbg("%s(): port_extra->close_pending = true", __func__); | ||
649 | /* although the USB side is now empty, the UART itself may | ||
650 | * still be pushing characters out over the line, so we have to | ||
651 | * wait testing the actual line status until the lines change | ||
652 | * indicating that the data is done transferring. */ | ||
653 | /* FIXME: slow this polling down so it doesn't run the USB bus flat out | ||
654 | * if it actually has to spend any time in this loop (which it normally | ||
655 | * doesn't because the buffer is nearly empty) */ | ||
656 | jift = jiffies + (10 * HZ); /* 10 sec timeout */ | ||
657 | do { | ||
658 | status = qt2_box_get_register(serial, port->number, | ||
659 | QT2_LINE_STATUS_REGISTER, &lsr_value); | ||
660 | if (status < 0) { | ||
661 | dbg("%s(): qt2_box_get_register failed", __func__); | ||
662 | break; | ||
663 | } | ||
664 | if ((lsr_value & QT2_LSR_TEMT)) { | ||
665 | dbg("UART done sending"); | ||
666 | break; | ||
667 | } | ||
668 | schedule(); | ||
669 | } while (jiffies <= jift); | ||
670 | |||
671 | status = qt2_closeboxchannel(serial, port->number); | ||
672 | if (status < 0) | ||
673 | dbg("%s(): port %d qt2_box_open_close_channel failed", | ||
674 | __func__, port->number); | ||
675 | /* to avoid leaking URBs, we should now free the write_urb for this | ||
676 | * port and set the pointer to null so that next time the port is opened | ||
677 | * a new URB is allocated. This avoids leaking URBs when the device is | ||
678 | * removed */ | ||
679 | usb_free_urb(port->write_urb); | ||
680 | kfree(port->bulk_out_buffer); | ||
681 | port->bulk_out_buffer = NULL; | ||
682 | port->bulk_out_size = 0; | ||
683 | |||
684 | /* decrement the count of openings of this port by one */ | ||
685 | port_extra->open_count--; | ||
686 | /* one less overall open as well */ | ||
687 | dev_extra->open_ports--; | ||
688 | dbg("%s(): Exit, dev_extra->open_ports = %d", __func__, | ||
689 | dev_extra->open_ports); | ||
690 | } | ||
691 | |||
692 | /** | ||
693 | * qt2_write - write bytes from the tty layer out to the USB device. | ||
694 | * @buf: The data to be written, size at least count. | ||
695 | * @count: The number of bytes requested for transmission. | ||
696 | * @return The number of bytes actually accepted for transmission to the device. | ||
697 | */ | ||
698 | static int qt2_write(struct tty_struct *tty, struct usb_serial_port *port, | ||
699 | const unsigned char *buf, int count) | ||
700 | { | ||
701 | struct usb_serial *serial; /* parent device struct */ | ||
702 | __u8 header_array[5]; /* header used to direct writes to the correct | ||
703 | port on the device */ | ||
704 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
705 | int result; | ||
706 | |||
707 | serial = port->serial; /* get the parent device of the port */ | ||
708 | port_extra = qt2_get_port_private(port); /* port extra info */ | ||
709 | if (serial == NULL) | ||
710 | return -ENODEV; | ||
711 | dbg("%s(): port %d, requested to write %d bytes, %d already pending", | ||
712 | __func__, port->number, count, port_extra->tx_pending_bytes); | ||
713 | |||
714 | if (count <= 0) { | ||
715 | dbg("%s(): write request of <= 0 bytes", __func__); | ||
716 | return 0; /* no bytes written */ | ||
717 | } | ||
718 | |||
719 | /* check if the write urb is already in use, i.e. data already being | ||
720 | * sent to this port */ | ||
721 | if ((port->write_urb->status == -EINPROGRESS)) { | ||
722 | /* Fifo hasn't been emptied since last write to this port */ | ||
723 | dbg("%s(): already writing, port->write_urb->status == " | ||
724 | "-EINPROGRESS", __func__); | ||
725 | /* schedule_work(&port->work); commented in vendor driver */ | ||
726 | return 0; | ||
727 | } else if (port_extra->tx_pending_bytes >= QT2_FIFO_DEPTH) { | ||
728 | /* buffer is full (==). > should not occur, but would indicate | ||
729 | * that an overflow had occurred */ | ||
730 | dbg("%s(): port transmit buffer is full!", __func__); | ||
731 | /* schedule_work(&port->work); commented in vendor driver */ | ||
732 | return 0; | ||
733 | } | ||
734 | |||
735 | /* We must fill the first 5 bytes of anything we sent with a transmit | ||
736 | * header which directes the data to the correct port. The maximum | ||
737 | * size we can send out in one URB is port->bulk_out_size, which caps | ||
738 | * the number of bytes of real data we can send in each write. As the | ||
739 | * semantics of write allow us to write less than we were give, we cap | ||
740 | * the maximum we will ever write to the device as 5 bytes less than | ||
741 | * one URB's worth, by reducing the value of the count argument | ||
742 | * appropriately*/ | ||
743 | if (count > port->bulk_out_size - QT2_TX_HEADER_LENGTH) { | ||
744 | count = port->bulk_out_size - QT2_TX_HEADER_LENGTH; | ||
745 | dbg("%s(): write request bigger than urb, only accepting " | ||
746 | "%d bytes", __func__, count); | ||
747 | } | ||
748 | /* we must also ensure that the FIFO at the other end can cope with the | ||
749 | * URB we send it, otherwise it will have problems. As above, we can | ||
750 | * restrict the write size by just shrinking count.*/ | ||
751 | if (count > (QT2_FIFO_DEPTH - port_extra->tx_pending_bytes)) { | ||
752 | count = QT2_FIFO_DEPTH - port_extra->tx_pending_bytes; | ||
753 | dbg("%s(): not enough room in buffer, only accepting %d bytes", | ||
754 | __func__, count); | ||
755 | } | ||
756 | /* now build the header for transmission */ | ||
757 | header_array[0] = 0x1b; | ||
758 | header_array[1] = 0x1b; | ||
759 | header_array[2] = (__u8)port->number; | ||
760 | header_array[3] = (__u8)count; | ||
761 | header_array[4] = (__u8)count >> 8; | ||
762 | /* copy header into URB */ | ||
763 | memcpy(port->write_urb->transfer_buffer, header_array, | ||
764 | QT2_TX_HEADER_LENGTH); | ||
765 | /* and actual data to write */ | ||
766 | memcpy(port->write_urb->transfer_buffer + 5, buf, count); | ||
767 | |||
768 | dbg("%s(): first data byte to send = %#.2x", __func__, *buf); | ||
769 | |||
770 | /* set up our urb */ | ||
771 | usb_fill_bulk_urb(port->write_urb, serial->dev, | ||
772 | usb_sndbulkpipe(serial->dev, | ||
773 | port->bulk_out_endpointAddress), | ||
774 | port->write_urb->transfer_buffer, count + 5, | ||
775 | (qt2_write_bulk_callback), port); | ||
776 | /* send the data out the bulk port */ | ||
777 | result = usb_submit_urb(port->write_urb, GFP_ATOMIC); | ||
778 | if (result) { | ||
779 | /* error couldn't submit urb */ | ||
780 | result = 0; /* return 0 as nothing got written */ | ||
781 | dbg("%s(): failed submitting write urb, error %d", | ||
782 | __func__, result); | ||
783 | } else { | ||
784 | port_extra->tx_pending_bytes += count; | ||
785 | result = count; /* return number of bytes written, i.e. count */ | ||
786 | dbg("%s(): submitted write urb, wrote %d bytes, " | ||
787 | "total pending bytes %d", | ||
788 | __func__, result, port_extra->tx_pending_bytes); | ||
789 | } | ||
790 | return result; | ||
791 | } | ||
792 | |||
793 | /* This is used by the next layer up to know how much space is available | ||
794 | * in the buffer on the device. It is used on a device closure to avoid | ||
795 | * calling close() until the buffer is reported to be empty. | ||
796 | * The returned value must never go down by more than the number of bytes | ||
797 | * written for correct behaviour further up the driver stack, i.e. if I call | ||
798 | * it, then write 6 bytes, then call again I should get 6 less, or possibly | ||
799 | * only 5 less if one was written in the meantime, etc. I should never get 7 | ||
800 | * less (or any bigger number) because I only wrote 6 bytes. | ||
801 | */ | ||
802 | static int qt2_write_room(struct tty_struct *tty) | ||
803 | { | ||
804 | struct usb_serial_port *port = tty->driver_data; | ||
805 | /* parent usb_serial_port pointer */ | ||
806 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
807 | int room = 0; | ||
808 | port_extra = qt2_get_port_private(port); | ||
809 | |||
810 | if (port_extra->close_pending == true) { | ||
811 | dbg("%s(): port_extra->close_pending == true", __func__); | ||
812 | return -ENODEV; | ||
813 | } | ||
814 | /* Q: how many bytes would a write() call actually succeed in writing | ||
815 | * if it happened now? | ||
816 | * A: one QT2_FIFO_DEPTH, less the number of bytes waiting to be sent | ||
817 | * out of the port, unless this is more than the size of the | ||
818 | * write_urb output buffer less the header, which is the maximum | ||
819 | * size write we can do. | ||
820 | |||
821 | * Most of the implementation of this is done when writes to the device | ||
822 | * are started or terminate. When we send a write to the device, we | ||
823 | * reduce the free space count by the size of the dispatched write. | ||
824 | * When a "transmit empty" message comes back up the USB read stream, | ||
825 | * we decrement the count by the number of bytes reported sent, thus | ||
826 | * keeping track of the difference between sent and received bytes. | ||
827 | */ | ||
828 | |||
829 | room = (QT2_FIFO_DEPTH - port_extra->tx_pending_bytes); | ||
830 | /* space in FIFO */ | ||
831 | if (room > port->bulk_out_size - QT2_TX_HEADER_LENGTH) | ||
832 | room = port->bulk_out_size - QT2_TX_HEADER_LENGTH; | ||
833 | /* if more than the URB can hold, then cap to that limit */ | ||
834 | |||
835 | dbg("%s(): port %d: write room is %d", __func__, port->number, room); | ||
836 | return room; | ||
837 | } | ||
838 | |||
839 | static int qt2_chars_in_buffer(struct tty_struct *tty) | ||
840 | { | ||
841 | struct usb_serial_port *port = tty->driver_data; | ||
842 | /* parent usb_serial_port pointer */ | ||
843 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
844 | port_extra = qt2_get_port_private(port); | ||
845 | |||
846 | dbg("%s(): port %d: chars_in_buffer = %d", __func__, | ||
847 | port->number, port_extra->tx_pending_bytes); | ||
848 | return port_extra->tx_pending_bytes; | ||
849 | } | ||
850 | |||
851 | /* called when userspace does an ioctl() on the device. Note that | ||
852 | * TIOCMGET and TIOCMSET are filtered off to their own methods before they get | ||
853 | * here, so we don't have to handle them. | ||
854 | */ | ||
855 | static int qt2_ioctl(struct tty_struct *tty, | ||
856 | unsigned int cmd, unsigned long arg) | ||
857 | { | ||
858 | struct usb_serial_port *port = tty->driver_data; | ||
859 | struct usb_serial *serial = port->serial; | ||
860 | __u8 mcr_value; /* Modem Control Register value */ | ||
861 | __u8 msr_value; /* Modem Status Register value */ | ||
862 | unsigned short prev_msr_value; /* Previous value of Modem Status | ||
863 | * Register used to implement waiting for a line status change to | ||
864 | * occur */ | ||
865 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
866 | DECLARE_WAITQUEUE(wait, current); | ||
867 | /* Declare a wait queue named "wait" */ | ||
868 | |||
869 | unsigned int value; | ||
870 | unsigned int UartNumber; | ||
871 | |||
872 | if (serial == NULL) | ||
873 | return -ENODEV; | ||
874 | UartNumber = tty->index - serial->minor; | ||
875 | port_extra = qt2_get_port_private(port); | ||
876 | |||
877 | dbg("%s(): port %d, UartNumber %d, tty =0x%p", __func__, | ||
878 | port->number, UartNumber, tty); | ||
879 | |||
880 | if (cmd == TIOCMBIS || cmd == TIOCMBIC) { | ||
881 | if (qt2_box_get_register(port->serial, UartNumber, | ||
882 | QT2_MODEM_CONTROL_REGISTER, &mcr_value) < 0) | ||
883 | return -ESPIPE; | ||
884 | if (copy_from_user(&value, (unsigned int *)arg, | ||
885 | sizeof(value))) | ||
886 | return -EFAULT; | ||
887 | |||
888 | switch (cmd) { | ||
889 | case TIOCMBIS: | ||
890 | if (value & TIOCM_RTS) | ||
891 | mcr_value |= QT2_SERIAL_MCR_RTS; | ||
892 | if (value & TIOCM_DTR) | ||
893 | mcr_value |= QT2_SERIAL_MCR_DTR; | ||
894 | if (value & TIOCM_LOOP) | ||
895 | mcr_value |= QT2_SERIAL_MCR_LOOP; | ||
896 | break; | ||
897 | case TIOCMBIC: | ||
898 | if (value & TIOCM_RTS) | ||
899 | mcr_value &= ~QT2_SERIAL_MCR_RTS; | ||
900 | if (value & TIOCM_DTR) | ||
901 | mcr_value &= ~QT2_SERIAL_MCR_DTR; | ||
902 | if (value & TIOCM_LOOP) | ||
903 | mcr_value &= ~QT2_SERIAL_MCR_LOOP; | ||
904 | break; | ||
905 | default: | ||
906 | break; | ||
907 | } /* end of local switch on cmd */ | ||
908 | if (qt2_box_set_register(port->serial, UartNumber, | ||
909 | QT2_MODEM_CONTROL_REGISTER, mcr_value) < 0) { | ||
910 | return -ESPIPE; | ||
911 | } else { | ||
912 | port_extra->shadowMCR = mcr_value; | ||
913 | return 0; | ||
914 | } | ||
915 | } else if (cmd == TIOCMIWAIT) { | ||
916 | dbg("%s() port %d, cmd == TIOCMIWAIT enter", | ||
917 | __func__, port->number); | ||
918 | prev_msr_value = port_extra->shadowMSR & QT2_SERIAL_MSR_MASK; | ||
919 | barrier(); | ||
920 | __set_current_state(TASK_INTERRUPTIBLE); | ||
921 | while (1) { | ||
922 | add_wait_queue(&port_extra->wait, &wait); | ||
923 | schedule(); | ||
924 | dbg("%s(): port %d, cmd == TIOCMIWAIT here\n", | ||
925 | __func__, port->number); | ||
926 | remove_wait_queue(&port_extra->wait, &wait); | ||
927 | /* see if a signal woke us up */ | ||
928 | if (signal_pending(current)) | ||
929 | return -ERESTARTSYS; | ||
930 | set_current_state(TASK_INTERRUPTIBLE); | ||
931 | msr_value = port_extra->shadowMSR & QT2_SERIAL_MSR_MASK; | ||
932 | if (msr_value == prev_msr_value) { | ||
933 | __set_current_state(TASK_RUNNING); | ||
934 | return -EIO; /* no change - error */ | ||
935 | } | ||
936 | if ((arg & TIOCM_RNG && | ||
937 | ((prev_msr_value & QT2_SERIAL_MSR_RI) == | ||
938 | (msr_value & QT2_SERIAL_MSR_RI))) || | ||
939 | (arg & TIOCM_DSR && | ||
940 | ((prev_msr_value & QT2_SERIAL_MSR_DSR) == | ||
941 | (msr_value & QT2_SERIAL_MSR_DSR))) || | ||
942 | (arg & TIOCM_CD && | ||
943 | ((prev_msr_value & QT2_SERIAL_MSR_CD) == | ||
944 | (msr_value & QT2_SERIAL_MSR_CD))) || | ||
945 | (arg & TIOCM_CTS && | ||
946 | ((prev_msr_value & QT2_SERIAL_MSR_CTS) == | ||
947 | (msr_value & QT2_SERIAL_MSR_CTS)))) { | ||
948 | __set_current_state(TASK_RUNNING); | ||
949 | return 0; | ||
950 | } | ||
951 | } /* end inifinite while */ | ||
952 | /* FIXME: This while loop needs a way to break out if the device | ||
953 | * is disconnected while a process is waiting for the MSR to | ||
954 | * change, because once it's disconnected, it isn't going to | ||
955 | * change state ... */ | ||
956 | } else { | ||
957 | /* any other ioctls we don't know about come here */ | ||
958 | dbg("%s(): No ioctl for that one. port = %d", __func__, | ||
959 | port->number); | ||
960 | return -ENOIOCTLCMD; | ||
961 | } | ||
962 | } | ||
963 | |||
964 | /* Called when the user wishes to change the port settings using the termios | ||
965 | * userspace interface */ | ||
966 | static void qt2_set_termios(struct tty_struct *tty, | ||
967 | struct usb_serial_port *port, struct ktermios *old_termios) | ||
968 | { | ||
969 | struct usb_serial *serial; /* parent serial device */ | ||
970 | int baud, divisor, remainder; | ||
971 | unsigned char LCR_change_to = 0; | ||
972 | int status; | ||
973 | __u16 UartNumber; | ||
974 | |||
975 | dbg("%s(): port %d", __func__, port->number); | ||
976 | |||
977 | serial = port->serial; | ||
978 | |||
979 | UartNumber = port->number; | ||
980 | |||
981 | if (old_termios && !tty_termios_hw_change(old_termios, tty->termios)) | ||
982 | return; | ||
983 | |||
984 | switch (tty->termios->c_cflag) { | ||
985 | case CS5: | ||
986 | LCR_change_to |= QT2_SERIAL_5_DATA; | ||
987 | break; | ||
988 | case CS6: | ||
989 | LCR_change_to |= QT2_SERIAL_6_DATA; | ||
990 | break; | ||
991 | case CS7: | ||
992 | LCR_change_to |= QT2_SERIAL_7_DATA; | ||
993 | break; | ||
994 | default: | ||
995 | case CS8: | ||
996 | LCR_change_to |= QT2_SERIAL_8_DATA; | ||
997 | break; | ||
998 | } | ||
999 | |||
1000 | /* Parity stuff */ | ||
1001 | if (tty->termios->c_cflag & PARENB) { | ||
1002 | if (tty->termios->c_cflag & PARODD) | ||
1003 | LCR_change_to |= QT2_SERIAL_ODD_PARITY; | ||
1004 | else | ||
1005 | LCR_change_to |= QT2_SERIAL_EVEN_PARITY; | ||
1006 | } | ||
1007 | /* Because LCR_change_to is initialised to zero, we don't have to worry | ||
1008 | * about the case where PARENB is not set or clearing bits, because by | ||
1009 | * default all of them are cleared, turning parity off. | ||
1010 | * as we don't support mark/space parity, we should clear the | ||
1011 | * mark/space parity bit in c_cflag, so the caller can tell we have | ||
1012 | * ignored the request */ | ||
1013 | tty->termios->c_cflag &= ~CMSPAR; | ||
1014 | |||
1015 | if (tty->termios->c_cflag & CSTOPB) | ||
1016 | LCR_change_to |= QT2_SERIAL_TWO_STOPB; | ||
1017 | else | ||
1018 | LCR_change_to |= QT2_SERIAL_ONE_STOPB; | ||
1019 | |||
1020 | /* Thats the LCR stuff, next we need to work out the divisor as the | ||
1021 | * LCR and the divisor are set together */ | ||
1022 | baud = tty_get_baud_rate(tty); | ||
1023 | if (!baud) { | ||
1024 | /* pick a default, any default... */ | ||
1025 | baud = 9600; | ||
1026 | } | ||
1027 | dbg("%s(): got baud = %d", __func__, baud); | ||
1028 | |||
1029 | divisor = QT2_MAX_BAUD_RATE / baud; | ||
1030 | remainder = QT2_MAX_BAUD_RATE % baud; | ||
1031 | /* Round to nearest divisor */ | ||
1032 | if (((remainder * 2) >= baud) && (baud != 110)) | ||
1033 | divisor++; | ||
1034 | dbg("%s(): setting divisor = %d, QT2_MAX_BAUD_RATE = %d , LCR = %#.2x", | ||
1035 | __func__, divisor, QT2_MAX_BAUD_RATE, LCR_change_to); | ||
1036 | |||
1037 | status = qt2_boxsetuart(serial, UartNumber, (unsigned short) divisor, | ||
1038 | LCR_change_to); | ||
1039 | if (status < 0) { | ||
1040 | dbg("qt2_boxsetuart() failed"); | ||
1041 | return; | ||
1042 | } else { | ||
1043 | /* now encode the baud rate we actually set, which may be | ||
1044 | * different to the request */ | ||
1045 | baud = QT2_MAX_BAUD_RATE / divisor; | ||
1046 | tty_encode_baud_rate(tty, baud, baud); | ||
1047 | } | ||
1048 | |||
1049 | /* Now determine flow control */ | ||
1050 | if (tty->termios->c_cflag & CRTSCTS) { | ||
1051 | dbg("%s(): Enabling HW flow control port %d", __func__, | ||
1052 | port->number); | ||
1053 | /* Enable RTS/CTS flow control */ | ||
1054 | status = qt2_boxsethw_flowctl(serial, UartNumber, true); | ||
1055 | if (status < 0) { | ||
1056 | dbg("qt2_boxsethw_flowctl() failed"); | ||
1057 | return; | ||
1058 | } | ||
1059 | } else { | ||
1060 | /* Disable RTS/CTS flow control */ | ||
1061 | dbg("%s(): disabling HW flow control port %d", __func__, | ||
1062 | port->number); | ||
1063 | status = qt2_boxsethw_flowctl(serial, UartNumber, false); | ||
1064 | if (status < 0) { | ||
1065 | dbg("qt2_boxsethw_flowctl failed"); | ||
1066 | return; | ||
1067 | } | ||
1068 | } | ||
1069 | /* if we are implementing XON/XOFF, set the start and stop character | ||
1070 | * in the device */ | ||
1071 | if (I_IXOFF(tty) || I_IXON(tty)) { | ||
1072 | unsigned char stop_char = STOP_CHAR(tty); | ||
1073 | unsigned char start_char = START_CHAR(tty); | ||
1074 | status = qt2_boxsetsw_flowctl(serial, UartNumber, stop_char, | ||
1075 | start_char); | ||
1076 | if (status < 0) | ||
1077 | dbg("qt2_boxsetsw_flowctl (enabled) failed"); | ||
1078 | } else { | ||
1079 | /* disable SW flow control */ | ||
1080 | status = qt2_boxunsetsw_flowctl(serial, UartNumber); | ||
1081 | if (status < 0) | ||
1082 | dbg("qt2_boxunsetsw_flowctl (disabling) failed"); | ||
1083 | } | ||
1084 | } | ||
1085 | |||
1086 | static int qt2_tiocmget(struct tty_struct *tty) | ||
1087 | { | ||
1088 | struct usb_serial_port *port = tty->driver_data; | ||
1089 | struct usb_serial *serial = port->serial; | ||
1090 | |||
1091 | __u8 mcr_value; /* Modem Control Register value */ | ||
1092 | __u8 msr_value; /* Modem Status Register value */ | ||
1093 | unsigned int result = 0; | ||
1094 | int status; | ||
1095 | unsigned int UartNumber; | ||
1096 | |||
1097 | if (serial == NULL) | ||
1098 | return -ENODEV; | ||
1099 | |||
1100 | dbg("%s(): port %d, tty =0x%p", __func__, port->number, tty); | ||
1101 | UartNumber = tty->index - serial->minor; | ||
1102 | dbg("UartNumber is %d", UartNumber); | ||
1103 | |||
1104 | status = qt2_box_get_register(port->serial, UartNumber, | ||
1105 | QT2_MODEM_CONTROL_REGISTER, &mcr_value); | ||
1106 | if (status >= 0) { | ||
1107 | status = qt2_box_get_register(port->serial, UartNumber, | ||
1108 | QT2_MODEM_STATUS_REGISTER, &msr_value); | ||
1109 | } | ||
1110 | if (status >= 0) { | ||
1111 | result = ((mcr_value & QT2_SERIAL_MCR_DTR) ? TIOCM_DTR : 0) | ||
1112 | /*DTR set */ | ||
1113 | | ((mcr_value & QT2_SERIAL_MCR_RTS) ? TIOCM_RTS : 0) | ||
1114 | /*RTS set */ | ||
1115 | | ((msr_value & QT2_SERIAL_MSR_CTS) ? TIOCM_CTS : 0) | ||
1116 | /* CTS set */ | ||
1117 | | ((msr_value & QT2_SERIAL_MSR_CD) ? TIOCM_CAR : 0) | ||
1118 | /*Carrier detect set */ | ||
1119 | | ((msr_value & QT2_SERIAL_MSR_RI) ? TIOCM_RI : 0) | ||
1120 | /* Ring indicator set */ | ||
1121 | | ((msr_value & QT2_SERIAL_MSR_DSR) ? TIOCM_DSR : 0); | ||
1122 | /* DSR set */ | ||
1123 | return result; | ||
1124 | } else { | ||
1125 | return -ESPIPE; | ||
1126 | } | ||
1127 | } | ||
1128 | |||
1129 | static int qt2_tiocmset(struct tty_struct *tty, | ||
1130 | unsigned int set, unsigned int clear) | ||
1131 | { | ||
1132 | struct usb_serial_port *port = tty->driver_data; | ||
1133 | struct usb_serial *serial = port->serial; | ||
1134 | __u8 mcr_value; /* Modem Control Register value */ | ||
1135 | int status; | ||
1136 | unsigned int UartNumber; | ||
1137 | |||
1138 | if (serial == NULL) | ||
1139 | return -ENODEV; | ||
1140 | |||
1141 | UartNumber = tty->index - serial->minor; | ||
1142 | dbg("%s(): port %d, UartNumber %d", __func__, port->number, UartNumber); | ||
1143 | |||
1144 | status = qt2_box_get_register(port->serial, UartNumber, | ||
1145 | QT2_MODEM_CONTROL_REGISTER, &mcr_value); | ||
1146 | if (status < 0) | ||
1147 | return -ESPIPE; | ||
1148 | |||
1149 | /* Turn off RTS, DTR and loopback, then only turn on what was asked | ||
1150 | * for */ | ||
1151 | mcr_value &= ~(QT2_SERIAL_MCR_RTS | QT2_SERIAL_MCR_DTR | | ||
1152 | QT2_SERIAL_MCR_LOOP); | ||
1153 | if (set & TIOCM_RTS) | ||
1154 | mcr_value |= QT2_SERIAL_MCR_RTS; | ||
1155 | if (set & TIOCM_DTR) | ||
1156 | mcr_value |= QT2_SERIAL_MCR_DTR; | ||
1157 | if (set & TIOCM_LOOP) | ||
1158 | mcr_value |= QT2_SERIAL_MCR_LOOP; | ||
1159 | |||
1160 | status = qt2_box_set_register(port->serial, UartNumber, | ||
1161 | QT2_MODEM_CONTROL_REGISTER, mcr_value); | ||
1162 | if (status < 0) | ||
1163 | return -ESPIPE; | ||
1164 | else | ||
1165 | return 0; | ||
1166 | } | ||
1167 | |||
1168 | /** qt2_break - Turn BREAK on and off on the UARTs | ||
1169 | */ | ||
1170 | static void qt2_break(struct tty_struct *tty, int break_state) | ||
1171 | { | ||
1172 | struct usb_serial_port *port = tty->driver_data; /* parent port */ | ||
1173 | struct usb_serial *serial = port->serial; /* parent device */ | ||
1174 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
1175 | __u16 break_value; | ||
1176 | unsigned int result; | ||
1177 | |||
1178 | port_extra = qt2_get_port_private(port); | ||
1179 | if (!serial) { | ||
1180 | dbg("%s(): port %d: no serial object", __func__, port->number); | ||
1181 | return; | ||
1182 | } | ||
1183 | |||
1184 | if (break_state == -1) | ||
1185 | break_value = 1; | ||
1186 | else | ||
1187 | break_value = 0; | ||
1188 | dbg("%s(): port %d, break_value %d", __func__, port->number, | ||
1189 | break_value); | ||
1190 | |||
1191 | mutex_lock(&port_extra->modelock); | ||
1192 | if (!port_extra->open_count) { | ||
1193 | dbg("%s(): port not open", __func__); | ||
1194 | goto exit; | ||
1195 | } | ||
1196 | |||
1197 | result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1198 | QT2_BREAK_CONTROL, 0x40, break_value, | ||
1199 | port->number, NULL, 0, 300); | ||
1200 | exit: | ||
1201 | mutex_unlock(&port_extra->modelock); | ||
1202 | dbg("%s(): exit port %d", __func__, port->number); | ||
1203 | |||
1204 | } | ||
1205 | /** | ||
1206 | * qt2_throttle: - stop reading new data from the port | ||
1207 | */ | ||
1208 | static void qt2_throttle(struct tty_struct *tty) | ||
1209 | { | ||
1210 | struct usb_serial_port *port = tty->driver_data; | ||
1211 | struct usb_serial *serial = port->serial; | ||
1212 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
1213 | dbg("%s(): port %d", __func__, port->number); | ||
1214 | |||
1215 | port_extra = qt2_get_port_private(port); | ||
1216 | if (!serial) { | ||
1217 | dbg("%s(): enter port %d no serial object", __func__, | ||
1218 | port->number); | ||
1219 | return; | ||
1220 | } | ||
1221 | |||
1222 | mutex_lock(&port_extra->modelock); /* lock structure */ | ||
1223 | if (!port_extra->open_count) { | ||
1224 | dbg("%s(): port not open", __func__); | ||
1225 | goto exit; | ||
1226 | } | ||
1227 | /* Send command to box to stop receiving stuff. This will stop this | ||
1228 | * particular UART from filling the endpoint - in the multiport case the | ||
1229 | * FPGA UART will handle any flow control implemented, but for the single | ||
1230 | * port it's handed differently and we just quit submitting urbs | ||
1231 | */ | ||
1232 | if (serial->dev->descriptor.idProduct != QUATECH_SSU2_100) | ||
1233 | qt2_boxstoprx(serial, port->number, 1); | ||
1234 | |||
1235 | port->throttled = 1; | ||
1236 | exit: | ||
1237 | mutex_unlock(&port_extra->modelock); | ||
1238 | dbg("%s(): port %d: setting port->throttled", __func__, port->number); | ||
1239 | return; | ||
1240 | } | ||
1241 | |||
1242 | /** | ||
1243 | * qt2_unthrottle: - start receiving data through the port again after being | ||
1244 | * throttled | ||
1245 | */ | ||
1246 | static void qt2_unthrottle(struct tty_struct *tty) | ||
1247 | { | ||
1248 | struct usb_serial_port *port = tty->driver_data; | ||
1249 | struct usb_serial *serial = port->serial; | ||
1250 | struct quatech2_port *port_extra; /* extra data for this port */ | ||
1251 | struct usb_serial_port *port0; /* first port structure on device */ | ||
1252 | struct quatech2_dev *dev_extra; /* extra data for the device */ | ||
1253 | |||
1254 | if (!serial) { | ||
1255 | dbg("%s() enter port %d no serial object!", __func__, | ||
1256 | port->number); | ||
1257 | return; | ||
1258 | } | ||
1259 | dbg("%s(): enter port %d", __func__, port->number); | ||
1260 | dev_extra = qt2_get_dev_private(serial); | ||
1261 | port_extra = qt2_get_port_private(port); | ||
1262 | port0 = serial->port[0]; /* get the first port's device structure */ | ||
1263 | |||
1264 | mutex_lock(&port_extra->modelock); | ||
1265 | if (!port_extra->open_count) { | ||
1266 | dbg("%s(): port %d not open", __func__, port->number); | ||
1267 | goto exit; | ||
1268 | } | ||
1269 | |||
1270 | if (port->throttled != 0) { | ||
1271 | dbg("%s(): port %d: unsetting port->throttled", __func__, | ||
1272 | port->number); | ||
1273 | port->throttled = 0; | ||
1274 | /* Send command to box to start receiving stuff */ | ||
1275 | if (serial->dev->descriptor.idProduct != QUATECH_SSU2_100) { | ||
1276 | qt2_boxstoprx(serial, port->number, 0); | ||
1277 | } else if (dev_extra->ReadBulkStopped == true) { | ||
1278 | usb_fill_bulk_urb(port0->read_urb, serial->dev, | ||
1279 | usb_rcvbulkpipe(serial->dev, | ||
1280 | port0->bulk_in_endpointAddress), | ||
1281 | port0->bulk_in_buffer, | ||
1282 | port0->bulk_in_size, | ||
1283 | qt2_read_bulk_callback, | ||
1284 | serial); | ||
1285 | } | ||
1286 | } | ||
1287 | exit: | ||
1288 | mutex_unlock(&port_extra->modelock); | ||
1289 | dbg("%s(): exit port %d", __func__, port->number); | ||
1290 | return; | ||
1291 | } | ||
1292 | |||
1293 | /* internal, private helper functions for the driver */ | ||
1294 | |||
1295 | /* Power up the FPGA in the box to get it working */ | ||
1296 | static int qt2_boxpoweron(struct usb_serial *serial) | ||
1297 | { | ||
1298 | int result; | ||
1299 | __u8 Direcion; | ||
1300 | unsigned int pipe; | ||
1301 | Direcion = USBD_TRANSFER_DIRECTION_OUT; | ||
1302 | pipe = usb_rcvctrlpipe(serial->dev, 0); | ||
1303 | result = usb_control_msg(serial->dev, pipe, QT_SET_GET_DEVICE, | ||
1304 | Direcion, QU2BOXPWRON, 0x00, NULL, 0x00, | ||
1305 | 5000); | ||
1306 | return result; | ||
1307 | } | ||
1308 | |||
1309 | /* | ||
1310 | * qt2_boxsetQMCR Issue a QT2_GET_SET_QMCR vendor-spcific request on the | ||
1311 | * default control pipe. If successful return the number of bytes written, | ||
1312 | * otherwise return a negative error number of the problem. | ||
1313 | */ | ||
1314 | static int qt2_boxsetQMCR(struct usb_serial *serial, __u16 Uart_Number, | ||
1315 | __u8 QMCR_Value) | ||
1316 | { | ||
1317 | int result; | ||
1318 | __u16 PortSettings; | ||
1319 | |||
1320 | PortSettings = (__u16)(QMCR_Value); | ||
1321 | |||
1322 | dbg("%s(): Port = %d, PortSettings = 0x%x", __func__, | ||
1323 | Uart_Number, PortSettings); | ||
1324 | |||
1325 | result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1326 | QT2_GET_SET_QMCR, 0x40, PortSettings, | ||
1327 | (__u16)Uart_Number, NULL, 0, 5000); | ||
1328 | return result; | ||
1329 | } | ||
1330 | |||
1331 | static int port_paranoia_check(struct usb_serial_port *port, | ||
1332 | const char *function) | ||
1333 | { | ||
1334 | if (!port) { | ||
1335 | dbg("%s - port == NULL", function); | ||
1336 | return -1; | ||
1337 | } | ||
1338 | if (!port->serial) { | ||
1339 | dbg("%s - port->serial == NULL\n", function); | ||
1340 | return -1; | ||
1341 | } | ||
1342 | return 0; | ||
1343 | } | ||
1344 | |||
1345 | static int serial_paranoia_check(struct usb_serial *serial, | ||
1346 | const char *function) | ||
1347 | { | ||
1348 | if (!serial) { | ||
1349 | dbg("%s - serial == NULL\n", function); | ||
1350 | return -1; | ||
1351 | } | ||
1352 | |||
1353 | if (!serial->type) { | ||
1354 | dbg("%s - serial->type == NULL!", function); | ||
1355 | return -1; | ||
1356 | } | ||
1357 | |||
1358 | return 0; | ||
1359 | } | ||
1360 | |||
1361 | static inline struct quatech2_port *qt2_get_port_private(struct usb_serial_port | ||
1362 | *port) | ||
1363 | { | ||
1364 | return (struct quatech2_port *)usb_get_serial_port_data(port); | ||
1365 | } | ||
1366 | |||
1367 | static inline void qt2_set_port_private(struct usb_serial_port *port, | ||
1368 | struct quatech2_port *data) | ||
1369 | { | ||
1370 | usb_set_serial_port_data(port, (void *)data); | ||
1371 | } | ||
1372 | |||
1373 | static inline struct quatech2_dev *qt2_get_dev_private(struct usb_serial | ||
1374 | *serial) | ||
1375 | { | ||
1376 | return (struct quatech2_dev *)usb_get_serial_data(serial); | ||
1377 | } | ||
1378 | static inline void qt2_set_dev_private(struct usb_serial *serial, | ||
1379 | struct quatech2_dev *data) | ||
1380 | { | ||
1381 | usb_set_serial_data(serial, (void *)data); | ||
1382 | } | ||
1383 | |||
1384 | static int qt2_openboxchannel(struct usb_serial *serial, __u16 | ||
1385 | Uart_Number, struct qt2_status_data *status) | ||
1386 | { | ||
1387 | int result; | ||
1388 | __u16 length; | ||
1389 | __u8 Direcion; | ||
1390 | unsigned int pipe; | ||
1391 | length = sizeof(struct qt2_status_data); | ||
1392 | Direcion = USBD_TRANSFER_DIRECTION_IN; | ||
1393 | pipe = usb_rcvctrlpipe(serial->dev, 0); | ||
1394 | result = usb_control_msg(serial->dev, pipe, QT_OPEN_CLOSE_CHANNEL, | ||
1395 | Direcion, 0x00, Uart_Number, status, length, 5000); | ||
1396 | return result; | ||
1397 | } | ||
1398 | static int qt2_closeboxchannel(struct usb_serial *serial, __u16 Uart_Number) | ||
1399 | { | ||
1400 | int result; | ||
1401 | __u8 direcion; | ||
1402 | unsigned int pipe; | ||
1403 | direcion = USBD_TRANSFER_DIRECTION_OUT; | ||
1404 | pipe = usb_sndctrlpipe(serial->dev, 0); | ||
1405 | result = usb_control_msg(serial->dev, pipe, QT_OPEN_CLOSE_CHANNEL, | ||
1406 | direcion, 0, Uart_Number, NULL, 0, 5000); | ||
1407 | return result; | ||
1408 | } | ||
1409 | |||
1410 | /* qt2_conf_uart Issue a SET_UART vendor-spcific request on the default | ||
1411 | * control pipe. If successful sets baud rate divisor and LCR value | ||
1412 | */ | ||
1413 | static int qt2_conf_uart(struct usb_serial *serial, unsigned short Uart_Number, | ||
1414 | unsigned short divisor, unsigned char LCR) | ||
1415 | { | ||
1416 | int result; | ||
1417 | unsigned short UartNumandLCR; | ||
1418 | |||
1419 | UartNumandLCR = (LCR << 8) + Uart_Number; | ||
1420 | |||
1421 | result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1422 | QT2_GET_SET_UART, 0x40, divisor, UartNumandLCR, | ||
1423 | NULL, 0, 300); | ||
1424 | return result; | ||
1425 | } | ||
1426 | |||
1427 | /** @brief Callback for asynchronous submission of read URBs on bulk in | ||
1428 | * endpoints | ||
1429 | * | ||
1430 | * Registered in qt2_open_port(), used to deal with incomming data | ||
1431 | * from the box. | ||
1432 | */ | ||
1433 | static void qt2_read_bulk_callback(struct urb *urb) | ||
1434 | { | ||
1435 | /* Get the device pointer (struct usb_serial) back out of the URB */ | ||
1436 | struct usb_serial *serial = urb->context; | ||
1437 | /* get the extra struct for the device */ | ||
1438 | struct quatech2_dev *dev_extra = qt2_get_dev_private(serial); | ||
1439 | /* Get first port structure from the device */ | ||
1440 | struct usb_serial_port *port0 = serial->port[0]; | ||
1441 | /* Get the currently active port structure from serial struct */ | ||
1442 | struct usb_serial_port *active = dev_extra->current_port; | ||
1443 | /* get the extra struct for port 0 */ | ||
1444 | struct quatech2_port *port0_extra = qt2_get_port_private(port0); | ||
1445 | /* and for the currently active port */ | ||
1446 | struct quatech2_port *active_extra = qt2_get_port_private(active); | ||
1447 | /* When we finally get to doing some tty stuff, we will need this */ | ||
1448 | struct tty_struct *tty_st; | ||
1449 | unsigned int RxCount; /* the length of the data to process */ | ||
1450 | unsigned int i; /* loop counter over the data to process */ | ||
1451 | int result; /* return value cache variable */ | ||
1452 | bool escapeflag; /* flag set to true if this loop iteration is | ||
1453 | * parsing an escape sequence, rather than | ||
1454 | * ordinary data */ | ||
1455 | dbg("%s(): callback running, active port is %d", __func__, | ||
1456 | active->number); | ||
1457 | |||
1458 | if (urb->status) { | ||
1459 | /* read didn't go well */ | ||
1460 | dev_extra->ReadBulkStopped = true; | ||
1461 | dbg("%s(): nonzero bulk read status received: %d", | ||
1462 | __func__, urb->status); | ||
1463 | return; | ||
1464 | } | ||
1465 | |||
1466 | /* inline port_sofrint() here */ | ||
1467 | if (port_paranoia_check(port0, __func__) != 0) { | ||
1468 | dbg("%s - port_paranoia_check on port0 failed, exiting\n", | ||
1469 | __func__); | ||
1470 | return; | ||
1471 | } | ||
1472 | if (port_paranoia_check(active, __func__) != 0) { | ||
1473 | dbg("%s - port_paranoia_check on current_port " | ||
1474 | "failed, exiting", __func__); | ||
1475 | return; | ||
1476 | } | ||
1477 | |||
1478 | /* This single callback function has to do for all the ports on | ||
1479 | * the device. Data being read up the USB can contain certain | ||
1480 | * escape sequences which are used to communicate out-of-band | ||
1481 | * information from the serial port in-band over the USB. | ||
1482 | * These escapes include sending modem and flow control line | ||
1483 | * status, and switching the port. The concept of a "Current Port" | ||
1484 | * is used, which is where data is going until a port change | ||
1485 | * escape seqence is received. This Current Port is kept between | ||
1486 | * callbacks so that when this function enters we know which the | ||
1487 | * currently active port is and can get to work right away without | ||
1488 | * the box having to send repeat escape sequences (anyway, how | ||
1489 | * would it know to do so?). | ||
1490 | */ | ||
1491 | |||
1492 | if (active_extra->close_pending == true) { | ||
1493 | /* We are closing , stop reading */ | ||
1494 | dbg("%s - (active->close_pending == true", __func__); | ||
1495 | if (dev_extra->open_ports <= 0) { | ||
1496 | /* If this is the only port left open - stop the | ||
1497 | * bulk read */ | ||
1498 | dev_extra->ReadBulkStopped = true; | ||
1499 | dbg("%s - (ReadBulkStopped == true;", __func__); | ||
1500 | return; | ||
1501 | } | ||
1502 | } | ||
1503 | |||
1504 | /* | ||
1505 | * RxHolding is asserted by throttle, if we assert it, we're not | ||
1506 | * receiving any more characters and let the box handle the flow | ||
1507 | * control | ||
1508 | */ | ||
1509 | if ((port0_extra->RxHolding == true) && | ||
1510 | (serial->dev->descriptor.idProduct == QUATECH_SSU2_100)) { | ||
1511 | /* single port device, input is already stopped, so we don't | ||
1512 | * need any more input data */ | ||
1513 | dev_extra->ReadBulkStopped = true; | ||
1514 | return; | ||
1515 | } | ||
1516 | /* finally, we are in a situation where we might consider the data | ||
1517 | * that is contained within the URB, and what to do about it. | ||
1518 | * This is likely to involved communicating up to the TTY layer, so | ||
1519 | * we will need to get hold of the tty for the port we are currently | ||
1520 | * dealing with */ | ||
1521 | |||
1522 | /* active is a usb_serial_port. It has a member port which is a | ||
1523 | * tty_port. From this we get a tty_struct pointer which is what we | ||
1524 | * actually wanted, and keep it on tty_st */ | ||
1525 | tty_st = tty_port_tty_get(&active->port); | ||
1526 | if (!tty_st) { | ||
1527 | dbg("%s - bad tty pointer - exiting", __func__); | ||
1528 | return; | ||
1529 | } | ||
1530 | RxCount = urb->actual_length; /* grab length of data handy */ | ||
1531 | |||
1532 | if (RxCount) { | ||
1533 | /* skip all this if no data to process */ | ||
1534 | for (i = 0; i < RxCount ; ++i) { | ||
1535 | /* Look ahead code here -works on several bytes at onc*/ | ||
1536 | if ((i <= (RxCount - 3)) && (THISCHAR == 0x1b) | ||
1537 | && (NEXTCHAR == 0x1b)) { | ||
1538 | /* we are in an escape sequence, type | ||
1539 | * determined by the 3rd char */ | ||
1540 | escapeflag = false; | ||
1541 | switch (THIRDCHAR) { | ||
1542 | case 0x00: | ||
1543 | /* Line status change 4th byte must | ||
1544 | * follow */ | ||
1545 | if (i > (RxCount - 4)) { | ||
1546 | dbg("Illegal escape sequences " | ||
1547 | "in received data"); | ||
1548 | break; | ||
1549 | } | ||
1550 | qt2_process_line_status(active, | ||
1551 | FOURTHCHAR); | ||
1552 | i += 3; | ||
1553 | escapeflag = true; | ||
1554 | break; | ||
1555 | case 0x01: | ||
1556 | /* Modem status status change 4th byte | ||
1557 | * must follow */ | ||
1558 | if (i > (RxCount - 4)) { | ||
1559 | dbg("Illegal escape sequences " | ||
1560 | "in received data"); | ||
1561 | break; | ||
1562 | } | ||
1563 | qt2_process_modem_status(active, | ||
1564 | FOURTHCHAR); | ||
1565 | i += 3; | ||
1566 | escapeflag = true; | ||
1567 | break; | ||
1568 | case 0x02: | ||
1569 | /* xmit hold empty 4th byte | ||
1570 | * must follow */ | ||
1571 | if (i > (RxCount - 4)) { | ||
1572 | dbg("Illegal escape sequences " | ||
1573 | "in received data"); | ||
1574 | break; | ||
1575 | } | ||
1576 | qt2_process_xmit_empty(active, | ||
1577 | FOURTHCHAR, FIFTHCHAR); | ||
1578 | i += 4; | ||
1579 | escapeflag = true; | ||
1580 | break; | ||
1581 | case 0x03: | ||
1582 | /* Port number change 4th byte | ||
1583 | * must follow */ | ||
1584 | if (i > (RxCount - 4)) { | ||
1585 | dbg("Illegal escape sequences " | ||
1586 | "in received data"); | ||
1587 | break; | ||
1588 | } | ||
1589 | /* Port change. If port open push | ||
1590 | * current data up to tty layer */ | ||
1591 | if (active_extra->open_count > 0) | ||
1592 | tty_flip_buffer_push(tty_st); | ||
1593 | |||
1594 | dbg("Port Change: new port = %d", | ||
1595 | FOURTHCHAR); | ||
1596 | qt2_process_port_change(active, | ||
1597 | FOURTHCHAR); | ||
1598 | i += 3; | ||
1599 | escapeflag = true; | ||
1600 | /* having changed port, the pointers for | ||
1601 | * the currently active port are all out | ||
1602 | * of date and need updating */ | ||
1603 | active = dev_extra->current_port; | ||
1604 | active_extra = | ||
1605 | qt2_get_port_private(active); | ||
1606 | tty_st = tty_port_tty_get( | ||
1607 | &active->port); | ||
1608 | break; | ||
1609 | case 0x04: | ||
1610 | /* Recv flush 3rd byte must | ||
1611 | * follow */ | ||
1612 | if (i > (RxCount - 3)) { | ||
1613 | dbg("Illegal escape sequences " | ||
1614 | "in received data"); | ||
1615 | break; | ||
1616 | } | ||
1617 | qt2_process_rcv_flush(active); | ||
1618 | i += 2; | ||
1619 | escapeflag = true; | ||
1620 | break; | ||
1621 | case 0x05: | ||
1622 | /* xmit flush 3rd byte must follow */ | ||
1623 | if (i > (RxCount - 3)) { | ||
1624 | dbg("Illegal escape sequences " | ||
1625 | "in received data"); | ||
1626 | break; | ||
1627 | } | ||
1628 | qt2_process_xmit_flush(active); | ||
1629 | i += 2; | ||
1630 | escapeflag = true; | ||
1631 | break; | ||
1632 | case 0xff: | ||
1633 | dbg("No status sequence"); | ||
1634 | qt2_process_rx_char(active, THISCHAR); | ||
1635 | qt2_process_rx_char(active, NEXTCHAR); | ||
1636 | i += 2; | ||
1637 | break; | ||
1638 | default: | ||
1639 | qt2_process_rx_char(active, THISCHAR); | ||
1640 | i += 1; | ||
1641 | break; | ||
1642 | } /*end switch*/ | ||
1643 | if (escapeflag == true) | ||
1644 | continue; | ||
1645 | /* if we did an escape char, we don't need | ||
1646 | * to mess around pushing data through the | ||
1647 | * tty layer, and can go round again */ | ||
1648 | } /*endif*/ | ||
1649 | if (tty_st && urb->actual_length) { | ||
1650 | tty_buffer_request_room(tty_st, 1); | ||
1651 | tty_insert_flip_string(tty_st, &( | ||
1652 | (unsigned char *) | ||
1653 | (urb->transfer_buffer) | ||
1654 | )[i], 1); | ||
1655 | } | ||
1656 | } /*endfor*/ | ||
1657 | tty_flip_buffer_push(tty_st); | ||
1658 | } /*endif*/ | ||
1659 | |||
1660 | /* at this point we have complete dealing with the data for this | ||
1661 | * callback. All we have to do now is to start the async read process | ||
1662 | * back off again. */ | ||
1663 | |||
1664 | usb_fill_bulk_urb(port0->read_urb, serial->dev, | ||
1665 | usb_rcvbulkpipe(serial->dev, port0->bulk_in_endpointAddress), | ||
1666 | port0->bulk_in_buffer, port0->bulk_in_size, | ||
1667 | qt2_read_bulk_callback, serial); | ||
1668 | result = usb_submit_urb(port0->read_urb, GFP_ATOMIC); | ||
1669 | if (result) { | ||
1670 | dbg("%s(): failed resubmitting read urb, error %d", | ||
1671 | __func__, result); | ||
1672 | } else { | ||
1673 | dbg("%s() successfully resubmitted read urb", __func__); | ||
1674 | if (tty_st && RxCount) { | ||
1675 | /* if some inbound data was processed, then | ||
1676 | * we need to push that through the tty layer | ||
1677 | */ | ||
1678 | tty_flip_buffer_push(tty_st); | ||
1679 | tty_schedule_flip(tty_st); | ||
1680 | } | ||
1681 | } | ||
1682 | |||
1683 | /* cribbed from serqt_usb2 driver, but not sure which work needs | ||
1684 | * scheduling - port0 or currently active port? */ | ||
1685 | /* schedule_work(&port->work); */ | ||
1686 | dbg("%s() completed", __func__); | ||
1687 | return; | ||
1688 | } | ||
1689 | |||
1690 | /** @brief Callback for asynchronous submission of write URBs on bulk in | ||
1691 | * endpoints | ||
1692 | * | ||
1693 | * Registered in qt2_write(), used to deal with outgoing data | ||
1694 | * to the box. | ||
1695 | */ | ||
1696 | static void qt2_write_bulk_callback(struct urb *urb) | ||
1697 | { | ||
1698 | struct usb_serial_port *port = (struct usb_serial_port *)urb->context; | ||
1699 | struct usb_serial *serial = port->serial; | ||
1700 | dbg("%s(): port %d", __func__, port->number); | ||
1701 | if (!serial) { | ||
1702 | dbg("%s(): bad serial pointer, exiting", __func__); | ||
1703 | return; | ||
1704 | } | ||
1705 | if (urb->status) { | ||
1706 | dbg("%s(): nonzero write bulk status received: %d", | ||
1707 | __func__, urb->status); | ||
1708 | return; | ||
1709 | } | ||
1710 | /* FIXME What is supposed to be going on here? | ||
1711 | * does this actually do anything useful, and should it? | ||
1712 | */ | ||
1713 | /*port_softint((void *) serial); commented in vendor driver */ | ||
1714 | schedule_work(&port->work); | ||
1715 | dbg("%s(): port %d exit", __func__, port->number); | ||
1716 | return; | ||
1717 | } | ||
1718 | |||
1719 | static void qt2_process_line_status(struct usb_serial_port *port, | ||
1720 | unsigned char LineStatus) | ||
1721 | { | ||
1722 | /* obtain the private structure for the port */ | ||
1723 | struct quatech2_port *port_extra = qt2_get_port_private(port); | ||
1724 | port_extra->shadowLSR = LineStatus & (QT2_SERIAL_LSR_OE | | ||
1725 | QT2_SERIAL_LSR_PE | QT2_SERIAL_LSR_FE | QT2_SERIAL_LSR_BI); | ||
1726 | } | ||
1727 | static void qt2_process_modem_status(struct usb_serial_port *port, | ||
1728 | unsigned char ModemStatus) | ||
1729 | { | ||
1730 | /* obtain the private structure for the port */ | ||
1731 | struct quatech2_port *port_extra = qt2_get_port_private(port); | ||
1732 | port_extra->shadowMSR = ModemStatus; | ||
1733 | wake_up_interruptible(&port_extra->wait); | ||
1734 | /* this wakes up the otherwise indefinitely waiting code for | ||
1735 | * the TIOCMIWAIT ioctl, so that it can notice that | ||
1736 | * port_extra->shadowMSR has changed and the ioctl needs to return. | ||
1737 | */ | ||
1738 | } | ||
1739 | |||
1740 | static void qt2_process_xmit_empty(struct usb_serial_port *port, | ||
1741 | unsigned char fourth_char, unsigned char fifth_char) | ||
1742 | { | ||
1743 | int byte_count; | ||
1744 | /* obtain the private structure for the port */ | ||
1745 | struct quatech2_port *port_extra = qt2_get_port_private(port); | ||
1746 | |||
1747 | byte_count = (int)(fifth_char * 16); | ||
1748 | byte_count += (int)fourth_char; | ||
1749 | /* byte_count indicates how many bytes the device has written out. This | ||
1750 | * message appears to occur regularly, and is used in the vendor driver | ||
1751 | * to keep track of the fill state of the port transmit buffer */ | ||
1752 | port_extra->tx_pending_bytes -= byte_count; | ||
1753 | /* reduce the stored data queue length by the known number of bytes | ||
1754 | * sent */ | ||
1755 | dbg("port %d: %d bytes reported sent, %d still pending", port->number, | ||
1756 | byte_count, port_extra->tx_pending_bytes); | ||
1757 | |||
1758 | /*port_extra->xmit_fifo_room_bytes = FIFO_DEPTH; ???*/ | ||
1759 | } | ||
1760 | |||
1761 | static void qt2_process_port_change(struct usb_serial_port *port, | ||
1762 | unsigned char New_Current_Port) | ||
1763 | { | ||
1764 | /* obtain the parent usb serial device structure */ | ||
1765 | struct usb_serial *serial = port->serial; | ||
1766 | /* obtain the private structure for the device */ | ||
1767 | struct quatech2_dev *dev_extra = qt2_get_dev_private(serial); | ||
1768 | dev_extra->current_port = serial->port[New_Current_Port]; | ||
1769 | /* what should I do with this? commented out in upstream | ||
1770 | * driver */ | ||
1771 | /*schedule_work(&port->work);*/ | ||
1772 | } | ||
1773 | |||
1774 | static void qt2_process_rcv_flush(struct usb_serial_port *port) | ||
1775 | { | ||
1776 | /* obtain the private structure for the port */ | ||
1777 | struct quatech2_port *port_extra = qt2_get_port_private(port); | ||
1778 | port_extra->rcv_flush = true; | ||
1779 | } | ||
1780 | static void qt2_process_xmit_flush(struct usb_serial_port *port) | ||
1781 | { | ||
1782 | /* obtain the private structure for the port */ | ||
1783 | struct quatech2_port *port_extra = qt2_get_port_private(port); | ||
1784 | port_extra->xmit_flush = true; | ||
1785 | } | ||
1786 | |||
1787 | static void qt2_process_rx_char(struct usb_serial_port *port, | ||
1788 | unsigned char data) | ||
1789 | { | ||
1790 | /* get the tty_struct for this port */ | ||
1791 | struct tty_struct *tty = tty_port_tty_get(&(port->port)); | ||
1792 | /* get the URB with the data in to push */ | ||
1793 | struct urb *urb = port->serial->port[0]->read_urb; | ||
1794 | |||
1795 | if (tty && urb->actual_length) { | ||
1796 | tty_buffer_request_room(tty, 1); | ||
1797 | tty_insert_flip_string(tty, &data, 1); | ||
1798 | /* should this be commented out here? */ | ||
1799 | /*tty_flip_buffer_push(tty);*/ | ||
1800 | } | ||
1801 | } | ||
1802 | |||
1803 | /** @brief Retrieve the value of a register from the device | ||
1804 | * | ||
1805 | * Issues a GET_REGISTER vendor-spcific request over the USB control | ||
1806 | * pipe to obtain a value back from a specific register on a specific | ||
1807 | * UART | ||
1808 | * @param serial Serial device handle to access the device through | ||
1809 | * @param uart_number Which UART the value is wanted from | ||
1810 | * @param register_num Which register to read the value from | ||
1811 | * @param pValue Pointer to somewhere to put the retrieved value | ||
1812 | */ | ||
1813 | static int qt2_box_get_register(struct usb_serial *serial, | ||
1814 | unsigned char uart_number, unsigned short register_num, | ||
1815 | __u8 *pValue) | ||
1816 | { | ||
1817 | int result; | ||
1818 | result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0), | ||
1819 | QT2_GET_SET_REGISTER, 0xC0, register_num, | ||
1820 | uart_number, (void *)pValue, sizeof(*pValue), 300); | ||
1821 | return result; | ||
1822 | } | ||
1823 | |||
1824 | /** qt2_box_set_register | ||
1825 | * Issue a SET_REGISTER vendor-specific request on the default control pipe | ||
1826 | */ | ||
1827 | static int qt2_box_set_register(struct usb_serial *serial, | ||
1828 | unsigned short Uart_Number, unsigned short Register_Num, | ||
1829 | unsigned short Value) | ||
1830 | { | ||
1831 | int result; | ||
1832 | unsigned short reg_and_byte; | ||
1833 | |||
1834 | reg_and_byte = Value; | ||
1835 | reg_and_byte = reg_and_byte << 8; | ||
1836 | reg_and_byte = reg_and_byte + Register_Num; | ||
1837 | |||
1838 | result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1839 | QT2_GET_SET_REGISTER, 0x40, reg_and_byte, | ||
1840 | Uart_Number, NULL, 0, 300); | ||
1841 | return result; | ||
1842 | } | ||
1843 | |||
1844 | /** qt2_boxsetuart - Issue a SET_UART vendor-spcific request on the default | ||
1845 | * control pipe. If successful sets baud rate divisor and LCR value. | ||
1846 | */ | ||
1847 | static int qt2_boxsetuart(struct usb_serial *serial, unsigned short Uart_Number, | ||
1848 | unsigned short default_divisor, unsigned char default_LCR) | ||
1849 | { | ||
1850 | unsigned short UartNumandLCR; | ||
1851 | |||
1852 | UartNumandLCR = (default_LCR << 8) + Uart_Number; | ||
1853 | |||
1854 | return usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1855 | QT2_GET_SET_UART, 0x40, default_divisor, UartNumandLCR, | ||
1856 | NULL, 0, 300); | ||
1857 | } | ||
1858 | |||
1859 | /** qt2_boxsethw_flowctl - Turn hardware (RTS/CTS) flow control on and off for | ||
1860 | * a hardware UART. | ||
1861 | */ | ||
1862 | static int qt2_boxsethw_flowctl(struct usb_serial *serial, | ||
1863 | unsigned int UartNumber, bool bSet) | ||
1864 | { | ||
1865 | __u8 MCR_Value = 0; | ||
1866 | __u8 MSR_Value = 0; | ||
1867 | __u16 MOUT_Value = 0; | ||
1868 | |||
1869 | if (bSet == true) { | ||
1870 | MCR_Value = QT2_SERIAL_MCR_RTS; | ||
1871 | /* flow control, box will clear RTS line to prevent remote | ||
1872 | * device from transmitting more chars */ | ||
1873 | } else { | ||
1874 | /* no flow control to remote device */ | ||
1875 | MCR_Value = 0; | ||
1876 | } | ||
1877 | MOUT_Value = MCR_Value << 8; | ||
1878 | |||
1879 | if (bSet == true) { | ||
1880 | MSR_Value = QT2_SERIAL_MSR_CTS; | ||
1881 | /* flow control on, box will inhibit tx data if CTS line is | ||
1882 | * asserted */ | ||
1883 | } else { | ||
1884 | /* Box will not inhibit tx data due to CTS line */ | ||
1885 | MSR_Value = 0; | ||
1886 | } | ||
1887 | MOUT_Value |= MSR_Value; | ||
1888 | return usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1889 | QT2_HW_FLOW_CONTROL_MASK, 0x40, MOUT_Value, UartNumber, | ||
1890 | NULL, 0, 300); | ||
1891 | } | ||
1892 | |||
1893 | /** qt2_boxsetsw_flowctl - Turn software (XON/XOFF) flow control on for | ||
1894 | * a hardware UART, and set the XON and XOFF characters. | ||
1895 | */ | ||
1896 | static int qt2_boxsetsw_flowctl(struct usb_serial *serial, __u16 UartNumber, | ||
1897 | unsigned char stop_char, unsigned char start_char) | ||
1898 | { | ||
1899 | __u16 nSWflowout; | ||
1900 | |||
1901 | nSWflowout = start_char << 8; | ||
1902 | nSWflowout = (unsigned short)stop_char; | ||
1903 | return usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1904 | QT2_SW_FLOW_CONTROL_MASK, 0x40, nSWflowout, UartNumber, | ||
1905 | NULL, 0, 300); | ||
1906 | } | ||
1907 | |||
1908 | /** qt2_boxunsetsw_flowctl - Turn software (XON/XOFF) flow control off for | ||
1909 | * a hardware UART. | ||
1910 | */ | ||
1911 | static int qt2_boxunsetsw_flowctl(struct usb_serial *serial, __u16 UartNumber) | ||
1912 | { | ||
1913 | return usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1914 | QT2_SW_FLOW_CONTROL_DISABLE, 0x40, 0, UartNumber, NULL, | ||
1915 | 0, 300); | ||
1916 | } | ||
1917 | |||
1918 | /** | ||
1919 | * qt2_boxstoprx - Start and stop reception of data by the FPGA UART in | ||
1920 | * response to requests from the tty layer | ||
1921 | * @serial: pointer to the usb_serial structure for the parent device | ||
1922 | * @uart_number: which UART on the device we are addressing | ||
1923 | * @stop: Whether to start or stop data reception. Set to 1 to stop data being | ||
1924 | * received, and to 0 to start it being received. | ||
1925 | */ | ||
1926 | static int qt2_boxstoprx(struct usb_serial *serial, unsigned short uart_number, | ||
1927 | unsigned short stop) | ||
1928 | { | ||
1929 | return usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), | ||
1930 | QT2_STOP_RECEIVE, 0x40, stop, uart_number, NULL, 0, 300); | ||
1931 | } | ||
1932 | |||
1933 | |||
1934 | /* | ||
1935 | * last things in file: stuff to register this driver into the generic | ||
1936 | * USB serial framework. | ||
1937 | */ | ||
1938 | |||
1939 | static struct usb_serial_driver quatech2_device = { | ||
1940 | .driver = { | ||
1941 | .owner = THIS_MODULE, | ||
1942 | .name = "quatech_usb2", | ||
1943 | }, | ||
1944 | .description = DRIVER_DESC, | ||
1945 | .usb_driver = &quausb2_usb_driver, | ||
1946 | .id_table = quausb2_id_table, | ||
1947 | .num_ports = 8, | ||
1948 | .open = qt2_open, | ||
1949 | .close = qt2_close, | ||
1950 | .write = qt2_write, | ||
1951 | .write_room = qt2_write_room, | ||
1952 | .chars_in_buffer = qt2_chars_in_buffer, | ||
1953 | .throttle = qt2_throttle, | ||
1954 | .unthrottle = qt2_unthrottle, | ||
1955 | .calc_num_ports = qt2_calc_num_ports, | ||
1956 | .ioctl = qt2_ioctl, | ||
1957 | .set_termios = qt2_set_termios, | ||
1958 | .break_ctl = qt2_break, | ||
1959 | .tiocmget = qt2_tiocmget, | ||
1960 | .tiocmset = qt2_tiocmset, | ||
1961 | .attach = qt2_attach, | ||
1962 | .release = qt2_release, | ||
1963 | .read_bulk_callback = qt2_read_bulk_callback, | ||
1964 | .write_bulk_callback = qt2_write_bulk_callback, | ||
1965 | }; | ||
1966 | |||
1967 | static int __init quausb2_usb_init(void) | ||
1968 | { | ||
1969 | int retval; | ||
1970 | |||
1971 | dbg("%s\n", __func__); | ||
1972 | |||
1973 | /* register with usb-serial */ | ||
1974 | retval = usb_serial_register(&quatech2_device); | ||
1975 | |||
1976 | if (retval) | ||
1977 | goto failed_usb_serial_register; | ||
1978 | |||
1979 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" | ||
1980 | DRIVER_DESC "\n"); | ||
1981 | |||
1982 | /* register with usb */ | ||
1983 | |||
1984 | retval = usb_register(&quausb2_usb_driver); | ||
1985 | if (retval == 0) | ||
1986 | return 0; | ||
1987 | |||
1988 | /* if we're here, usb_register() failed */ | ||
1989 | usb_serial_deregister(&quatech2_device); | ||
1990 | failed_usb_serial_register: | ||
1991 | return retval; | ||
1992 | } | ||
1993 | |||
1994 | static void __exit quausb2_usb_exit(void) | ||
1995 | { | ||
1996 | usb_deregister(&quausb2_usb_driver); | ||
1997 | usb_serial_deregister(&quatech2_device); | ||
1998 | } | ||
1999 | |||
2000 | module_init(quausb2_usb_init); | ||
2001 | module_exit(quausb2_usb_exit); | ||
2002 | |||
2003 | MODULE_AUTHOR(DRIVER_AUTHOR); | ||
2004 | MODULE_DESCRIPTION(DRIVER_DESC); | ||
2005 | MODULE_LICENSE("GPL"); | ||
2006 | |||
2007 | module_param(debug, bool, S_IRUGO | S_IWUSR); | ||
2008 | MODULE_PARM_DESC(debug, "Debug enabled or not"); | ||