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 bool 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 */
qt2_calc_num_ports(struct usb_serial * serial)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 
qt2_attach(struct usb_serial * serial)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 
qt2_release(struct usb_serial * serial)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  */
qt2_open(struct tty_struct * tty,struct usb_serial_port * port)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  */
qt2_close(struct usb_serial_port * port)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  */
qt2_write(struct tty_struct * tty,struct usb_serial_port * port,const unsigned char * buf,int count)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  */
qt2_write_room(struct tty_struct * tty)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 
qt2_chars_in_buffer(struct tty_struct * tty)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  */
qt2_ioctl(struct tty_struct * tty,unsigned int cmd,unsigned long arg)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 */
qt2_set_termios(struct tty_struct * tty,struct usb_serial_port * port,struct ktermios * old_termios)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 
qt2_tiocmget(struct tty_struct * tty)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 
qt2_tiocmset(struct tty_struct * tty,unsigned int set,unsigned int clear)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  */
qt2_break(struct tty_struct * tty,int break_state)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  */
qt2_throttle(struct tty_struct * tty)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  */
qt2_unthrottle(struct tty_struct * tty)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 */
qt2_boxpoweron(struct usb_serial * serial)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  */
qt2_boxsetQMCR(struct usb_serial * serial,__u16 Uart_Number,__u8 QMCR_Value)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 
port_paranoia_check(struct usb_serial_port * port,const char * function)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 
serial_paranoia_check(struct usb_serial * serial,const char * function)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 
qt2_get_port_private(struct usb_serial_port * port)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 
qt2_set_port_private(struct usb_serial_port * port,struct quatech2_port * data)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 
qt2_get_dev_private(struct usb_serial * serial)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 }
qt2_set_dev_private(struct usb_serial * serial,struct quatech2_dev * data)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 
qt2_openboxchannel(struct usb_serial * serial,__u16 Uart_Number,struct qt2_status_data * status)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 }
qt2_closeboxchannel(struct usb_serial * serial,__u16 Uart_Number)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  */
qt2_conf_uart(struct usb_serial * serial,unsigned short Uart_Number,unsigned short divisor,unsigned char LCR)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  */
qt2_read_bulk_callback(struct urb * urb)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  */
qt2_write_bulk_callback(struct urb * urb)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 
qt2_process_line_status(struct usb_serial_port * port,unsigned char LineStatus)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 }
qt2_process_modem_status(struct usb_serial_port * port,unsigned char ModemStatus)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 
qt2_process_xmit_empty(struct usb_serial_port * port,unsigned char fourth_char,unsigned char fifth_char)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 
qt2_process_port_change(struct usb_serial_port * port,unsigned char New_Current_Port)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 
qt2_process_rcv_flush(struct usb_serial_port * port)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 }
qt2_process_xmit_flush(struct usb_serial_port * port)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 
qt2_process_rx_char(struct usb_serial_port * port,unsigned char data)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  */
qt2_box_get_register(struct usb_serial * serial,unsigned char uart_number,unsigned short register_num,__u8 * pValue)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  */
qt2_box_set_register(struct usb_serial * serial,unsigned short Uart_Number,unsigned short Register_Num,unsigned short Value)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  */
qt2_boxsetuart(struct usb_serial * serial,unsigned short Uart_Number,unsigned short default_divisor,unsigned char default_LCR)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  */
qt2_boxsethw_flowctl(struct usb_serial * serial,unsigned int UartNumber,bool bSet)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  */
qt2_boxsetsw_flowctl(struct usb_serial * serial,__u16 UartNumber,unsigned char stop_char,unsigned char start_char)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  */
qt2_boxunsetsw_flowctl(struct usb_serial * serial,__u16 UartNumber)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  */
qt2_boxstoprx(struct usb_serial * serial,unsigned short uart_number,unsigned short stop)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 
quausb2_usb_init(void)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 
quausb2_usb_exit(void)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");
2009