projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
usb: pl2303: fix+improve the divsor based baud rate encoding method
[deliverable/linux.git] / drivers / usb / serial / pl2303.c
1 /*
2 * Prolific PL2303 USB to serial adaptor driver
3 *
4 * Copyright (C) 2001-2007 Greg Kroah-Hartman (greg@kroah.com)
5 * Copyright (C) 2003 IBM Corp.
6 *
7 * Copyright (C) 2009, 2013 Frank Schäfer <fschaefer.oss@googlemail.com>
8 * - fixes, improvements and documentation for the baud rate encoding methods
9 * Copyright (C) 2013 Reinhard Max <max@suse.de>
10 * - fixes and improvements for the divisor based baud rate encoding method
11 *
12 * Original driver for 2.2.x by anonymous
13 *
14 * This program is free software; you can redistribute it and/or
15 * modify it under the terms of the GNU General Public License version
16 * 2 as published by the Free Software Foundation.
17 *
18 * See Documentation/usb/usb-serial.txt for more information on using this
19 * driver
20 *
21 */
22
23 #include <linux/kernel.h>
24 #include <linux/errno.h>
25 #include <linux/init.h>
26 #include <linux/slab.h>
27 #include <linux/tty.h>
28 #include <linux/tty_driver.h>
29 #include <linux/tty_flip.h>
30 #include <linux/serial.h>
31 #include <linux/module.h>
32 #include <linux/moduleparam.h>
33 #include <linux/spinlock.h>
34 #include <linux/uaccess.h>
35 #include <linux/usb.h>
36 #include <linux/usb/serial.h>
37 #include <asm/unaligned.h>
38 #include "pl2303.h"
39
40 /*
41 * Version Information
42 */
43 #define DRIVER_DESC "Prolific PL2303 USB to serial adaptor driver"
44
45 static const struct usb_device_id id_table[] = {
46 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID) },
47 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_RSAQ2) },
48 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_DCU11) },
49 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_RSAQ3) },
50 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_PHAROS) },
51 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_ALDIGA) },
52 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_MMX) },
53 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_GPRS) },
54 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_HCR331) },
55 { USB_DEVICE(PL2303_VENDOR_ID, PL2303_PRODUCT_ID_MOTOROLA) },
56 { USB_DEVICE(IODATA_VENDOR_ID, IODATA_PRODUCT_ID) },
57 { USB_DEVICE(IODATA_VENDOR_ID, IODATA_PRODUCT_ID_RSAQ5) },
58 { USB_DEVICE(ATEN_VENDOR_ID, ATEN_PRODUCT_ID) },
59 { USB_DEVICE(ATEN_VENDOR_ID2, ATEN_PRODUCT_ID) },
60 { USB_DEVICE(ELCOM_VENDOR_ID, ELCOM_PRODUCT_ID) },
61 { USB_DEVICE(ELCOM_VENDOR_ID, ELCOM_PRODUCT_ID_UCSGT) },
62 { USB_DEVICE(ITEGNO_VENDOR_ID, ITEGNO_PRODUCT_ID) },
63 { USB_DEVICE(ITEGNO_VENDOR_ID, ITEGNO_PRODUCT_ID_2080) },
64 { USB_DEVICE(MA620_VENDOR_ID, MA620_PRODUCT_ID) },
65 { USB_DEVICE(RATOC_VENDOR_ID, RATOC_PRODUCT_ID) },
66 { USB_DEVICE(TRIPP_VENDOR_ID, TRIPP_PRODUCT_ID) },
67 { USB_DEVICE(RADIOSHACK_VENDOR_ID, RADIOSHACK_PRODUCT_ID) },
68 { USB_DEVICE(DCU10_VENDOR_ID, DCU10_PRODUCT_ID) },
69 { USB_DEVICE(SITECOM_VENDOR_ID, SITECOM_PRODUCT_ID) },
70 { USB_DEVICE(ALCATEL_VENDOR_ID, ALCATEL_PRODUCT_ID) },
71 { USB_DEVICE(SAMSUNG_VENDOR_ID, SAMSUNG_PRODUCT_ID) },
72 { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_SX1) },
73 { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_X65) },
74 { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_X75) },
75 { USB_DEVICE(SIEMENS_VENDOR_ID, SIEMENS_PRODUCT_ID_EF81) },
76 { USB_DEVICE(BENQ_VENDOR_ID, BENQ_PRODUCT_ID_S81) }, /* Benq/Siemens S81 */
77 { USB_DEVICE(SYNTECH_VENDOR_ID, SYNTECH_PRODUCT_ID) },
78 { USB_DEVICE(NOKIA_CA42_VENDOR_ID, NOKIA_CA42_PRODUCT_ID) },
79 { USB_DEVICE(CA_42_CA42_VENDOR_ID, CA_42_CA42_PRODUCT_ID) },
80 { USB_DEVICE(SAGEM_VENDOR_ID, SAGEM_PRODUCT_ID) },
81 { USB_DEVICE(LEADTEK_VENDOR_ID, LEADTEK_9531_PRODUCT_ID) },
82 { USB_DEVICE(SPEEDDRAGON_VENDOR_ID, SPEEDDRAGON_PRODUCT_ID) },
83 { USB_DEVICE(DATAPILOT_U2_VENDOR_ID, DATAPILOT_U2_PRODUCT_ID) },
84 { USB_DEVICE(BELKIN_VENDOR_ID, BELKIN_PRODUCT_ID) },
85 { USB_DEVICE(ALCOR_VENDOR_ID, ALCOR_PRODUCT_ID) },
86 { USB_DEVICE(WS002IN_VENDOR_ID, WS002IN_PRODUCT_ID) },
87 { USB_DEVICE(COREGA_VENDOR_ID, COREGA_PRODUCT_ID) },
88 { USB_DEVICE(YCCABLE_VENDOR_ID, YCCABLE_PRODUCT_ID) },
89 { USB_DEVICE(SUPERIAL_VENDOR_ID, SUPERIAL_PRODUCT_ID) },
90 { USB_DEVICE(HP_VENDOR_ID, HP_LD220_PRODUCT_ID) },
91 { USB_DEVICE(CRESSI_VENDOR_ID, CRESSI_EDY_PRODUCT_ID) },
92 { USB_DEVICE(ZEAGLE_VENDOR_ID, ZEAGLE_N2ITION3_PRODUCT_ID) },
93 { USB_DEVICE(SONY_VENDOR_ID, SONY_QN3USB_PRODUCT_ID) },
94 { USB_DEVICE(SANWA_VENDOR_ID, SANWA_PRODUCT_ID) },
95 { USB_DEVICE(ADLINK_VENDOR_ID, ADLINK_ND6530_PRODUCT_ID) },
96 { USB_DEVICE(SMART_VENDOR_ID, SMART_PRODUCT_ID) },
97 { } /* Terminating entry */
98 };
99
100 MODULE_DEVICE_TABLE(usb, id_table);
101
102 #define SET_LINE_REQUEST_TYPE 0x21
103 #define SET_LINE_REQUEST 0x20
104
105 #define SET_CONTROL_REQUEST_TYPE 0x21
106 #define SET_CONTROL_REQUEST 0x22
107 #define CONTROL_DTR 0x01
108 #define CONTROL_RTS 0x02
109
110 #define BREAK_REQUEST_TYPE 0x21
111 #define BREAK_REQUEST 0x23
112 #define BREAK_ON 0xffff
113 #define BREAK_OFF 0x0000
114
115 #define GET_LINE_REQUEST_TYPE 0xa1
116 #define GET_LINE_REQUEST 0x21
117
118 #define VENDOR_WRITE_REQUEST_TYPE 0x40
119 #define VENDOR_WRITE_REQUEST 0x01
120
121 #define VENDOR_READ_REQUEST_TYPE 0xc0
122 #define VENDOR_READ_REQUEST 0x01
123
124 #define UART_STATE 0x08
125 #define UART_STATE_TRANSIENT_MASK 0x74
126 #define UART_DCD 0x01
127 #define UART_DSR 0x02
128 #define UART_BREAK_ERROR 0x04
129 #define UART_RING 0x08
130 #define UART_FRAME_ERROR 0x10
131 #define UART_PARITY_ERROR 0x20
132 #define UART_OVERRUN_ERROR 0x40
133 #define UART_CTS 0x80
134
135
136 enum pl2303_type {
137 type_0, /* don't know the difference between type 0 and */
138 type_1, /* type 1, until someone from prolific tells us... */
139 HX, /* HX version of the pl2303 chip */
140 };
141
142 struct pl2303_serial_private {
143 enum pl2303_type type;
144 };
145
146 struct pl2303_private {
147 spinlock_t lock;
148 u8 line_control;
149 u8 line_status;
150 };
151
152 static int pl2303_vendor_read(__u16 value, __u16 index,
153 struct usb_serial *serial, unsigned char *buf)
154 {
155 int res = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
156 VENDOR_READ_REQUEST, VENDOR_READ_REQUEST_TYPE,
157 value, index, buf, 1, 100);
158 dev_dbg(&serial->interface->dev, "0x%x:0x%x:0x%x:0x%x %d - %x\n",
159 VENDOR_READ_REQUEST_TYPE, VENDOR_READ_REQUEST, value, index,
160 res, buf[0]);
161 return res;
162 }
163
164 static int pl2303_vendor_write(__u16 value, __u16 index,
165 struct usb_serial *serial)
166 {
167 int res = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
168 VENDOR_WRITE_REQUEST, VENDOR_WRITE_REQUEST_TYPE,
169 value, index, NULL, 0, 100);
170 dev_dbg(&serial->interface->dev, "0x%x:0x%x:0x%x:0x%x %d\n",
171 VENDOR_WRITE_REQUEST_TYPE, VENDOR_WRITE_REQUEST, value, index,
172 res);
173 return res;
174 }
175
176 static int pl2303_startup(struct usb_serial *serial)
177 {
178 struct pl2303_serial_private *spriv;
179 enum pl2303_type type = type_0;
180 unsigned char *buf;
181
182 spriv = kzalloc(sizeof(*spriv), GFP_KERNEL);
183 if (!spriv)
184 return -ENOMEM;
185
186 buf = kmalloc(10, GFP_KERNEL);
187 if (!buf) {
188 kfree(spriv);
189 return -ENOMEM;
190 }
191
192 if (serial->dev->descriptor.bDeviceClass == 0x02)
193 type = type_0;
194 else if (serial->dev->descriptor.bMaxPacketSize0 == 0x40)
195 type = HX;
196 else if (serial->dev->descriptor.bDeviceClass == 0x00)
197 type = type_1;
198 else if (serial->dev->descriptor.bDeviceClass == 0xFF)
199 type = type_1;
200 dev_dbg(&serial->interface->dev, "device type: %d\n", type);
201
202 spriv->type = type;
203 usb_set_serial_data(serial, spriv);
204
205 pl2303_vendor_read(0x8484, 0, serial, buf);
206 pl2303_vendor_write(0x0404, 0, serial);
207 pl2303_vendor_read(0x8484, 0, serial, buf);
208 pl2303_vendor_read(0x8383, 0, serial, buf);
209 pl2303_vendor_read(0x8484, 0, serial, buf);
210 pl2303_vendor_write(0x0404, 1, serial);
211 pl2303_vendor_read(0x8484, 0, serial, buf);
212 pl2303_vendor_read(0x8383, 0, serial, buf);
213 pl2303_vendor_write(0, 1, serial);
214 pl2303_vendor_write(1, 0, serial);
215 if (type == HX)
216 pl2303_vendor_write(2, 0x44, serial);
217 else
218 pl2303_vendor_write(2, 0x24, serial);
219
220 kfree(buf);
221 return 0;
222 }
223
224 static void pl2303_release(struct usb_serial *serial)
225 {
226 struct pl2303_serial_private *spriv;
227
228 spriv = usb_get_serial_data(serial);
229 kfree(spriv);
230 }
231
232 static int pl2303_port_probe(struct usb_serial_port *port)
233 {
234 struct pl2303_private *priv;
235
236 priv = kzalloc(sizeof(*priv), GFP_KERNEL);
237 if (!priv)
238 return -ENOMEM;
239
240 spin_lock_init(&priv->lock);
241
242 usb_set_serial_port_data(port, priv);
243
244 port->port.drain_delay = 256;
245
246 return 0;
247 }
248
249 static int pl2303_port_remove(struct usb_serial_port *port)
250 {
251 struct pl2303_private *priv;
252
253 priv = usb_get_serial_port_data(port);
254 kfree(priv);
255
256 return 0;
257 }
258
259 static int pl2303_set_control_lines(struct usb_serial_port *port, u8 value)
260 {
261 struct usb_device *dev = port->serial->dev;
262 int retval;
263
264 retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
265 SET_CONTROL_REQUEST, SET_CONTROL_REQUEST_TYPE,
266 value, 0, NULL, 0, 100);
267 dev_dbg(&port->dev, "%s - value = %d, retval = %d\n", __func__,
268 value, retval);
269 return retval;
270 }
271
272 static void pl2303_encode_baudrate(struct tty_struct *tty,
273 struct usb_serial_port *port,
274 u8 buf[4])
275 {
276 const int baud_sup[] = { 75, 150, 300, 600, 1200, 1800, 2400, 3600,
277 4800, 7200, 9600, 14400, 19200, 28800, 38400,
278 57600, 115200, 230400, 460800, 500000, 614400,
279 921600, 1228800, 2457600, 3000000, 6000000 };
280
281 struct usb_serial *serial = port->serial;
282 struct pl2303_serial_private *spriv = usb_get_serial_data(serial);
283 int baud;
284 int i;
285
286 /*
287 * NOTE: Only the values defined in baud_sup are supported!
288 * => if unsupported values are set, the PL2303 seems to use
289 * 9600 baud (at least my PL2303X always does)
290 */
291 baud = tty_get_baud_rate(tty);
292 dev_dbg(&port->dev, "baud requested = %d\n", baud);
293 if (!baud)
294 return;
295
296 /* Set baudrate to nearest supported value */
297 for (i = 0; i < ARRAY_SIZE(baud_sup); ++i) {
298 if (baud_sup[i] > baud)
299 break;
300 }
301
302 if (i == ARRAY_SIZE(baud_sup))
303 baud = baud_sup[i - 1];
304 else if (i > 0 && (baud_sup[i] - baud) > (baud - baud_sup[i - 1]))
305 baud = baud_sup[i - 1];
306 else
307 baud = baud_sup[i];
308
309 /* type_0, type_1 only support up to 1228800 baud */
310 if (spriv->type != HX)
311 baud = min_t(int, baud, 1228800);
312
313 if (spriv->type != HX || baud <= 115200) {
314 /* Direct (standard) baud rate encoding method */
315 put_unaligned_le32(baud, buf);
316 } else {
317 /*
318 * Divisor based baud rate encoding method
319 *
320 * NOTE: it's not clear if the type_0/1 chips
321 * support this method
322 *
323 * divisor = 12MHz * 32 / baudrate = 2^A * B
324 *
325 * with
326 *
327 * A = buf[1] & 0x0e
328 * B = buf[0] + (buf[1] & 0x01) << 8
329 *
330 * Special cases:
331 * => 8 < B < 16: device seems to work not properly
332 * => B <= 8: device uses the max. value B = 512 instead
333 */
334
335 /* Determine factors A and B */
336 unsigned int A = 0;
337 unsigned int B = 12000000 * 32 / baud; /* 12MHz */
338 B <<= 1; /* Add one bit for rounding */
339 while (B > (512 << 1) && A <= 14) {
340 A += 2;
341 B >>= 2;
342 }
343 if (A > 14) { /* max. divisor = min. baudrate reached */
344 A = 14;
345 B = 512;
346 /* => ~45.78 baud */
347 } else {
348 B = (B + 1) >> 1; /* Round the last bit */
349 }
350 /* Handle special cases */
351 if (B == 512)
352 B = 0; /* also: 1 to 8 */
353 else if (B < 16)
354 /*
355 * NOTE: With the current algorithm this happens
356 * only for A=0 and means that the min. divisor
357 * (respectively: the max. baudrate) is reached.
358 */
359 B = 16; /* => 24 MBaud */
360 /* Encode the baud rate */
361 buf[3] = 0x80; /* Select divisor encoding method */
362 buf[2] = 0;
363 buf[1] = (A & 0x0e); /* A */
364 buf[1] |= ((B & 0x100) >> 8); /* MSB of B */
365 buf[0] = B & 0xff; /* 8 LSBs of B */
366 /* Calculate the actual/resulting baud rate */
367 if (B <= 8)
368 B = 512;
369 baud = 12000000 * 32 / ((1 << A) * B);
370 }
371
372 /* Save resulting baud rate */
373 tty_encode_baud_rate(tty, baud, baud);
374 dev_dbg(&port->dev, "baud set = %d\n", baud);
375 }
376
377 static void pl2303_set_termios(struct tty_struct *tty,
378 struct usb_serial_port *port, struct ktermios *old_termios)
379 {
380 struct usb_serial *serial = port->serial;
381 struct pl2303_serial_private *spriv = usb_get_serial_data(serial);
382 struct pl2303_private *priv = usb_get_serial_port_data(port);
383 unsigned long flags;
384 unsigned char *buf;
385 int i;
386 u8 control;
387
388 /*
389 * The PL2303 is reported to lose bytes if you change serial settings
390 * even to the same values as before. Thus we actually need to filter
391 * in this specific case.
392 */
393 if (old_termios && !tty_termios_hw_change(&tty->termios, old_termios))
394 return;
395
396 buf = kzalloc(7, GFP_KERNEL);
397 if (!buf) {
398 dev_err(&port->dev, "%s - out of memory.\n", __func__);
399 /* Report back no change occurred */
400 if (old_termios)
401 tty->termios = *old_termios;
402 return;
403 }
404
405 i = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
406 GET_LINE_REQUEST, GET_LINE_REQUEST_TYPE,
407 0, 0, buf, 7, 100);
408 dev_dbg(&port->dev, "0xa1:0x21:0:0 %d - %7ph\n", i, buf);
409
410 if (C_CSIZE(tty)) {
411 switch (C_CSIZE(tty)) {
412 case CS5:
413 buf[6] = 5;
414 break;
415 case CS6:
416 buf[6] = 6;
417 break;
418 case CS7:
419 buf[6] = 7;
420 break;
421 default:
422 case CS8:
423 buf[6] = 8;
424 }
425 dev_dbg(&port->dev, "data bits = %d\n", buf[6]);
426 }
427
428 /* For reference buf[0]:buf[3] baud rate value */
429 pl2303_encode_baudrate(tty, port, &buf[0]);
430
431 /* For reference buf[4]=0 is 1 stop bits */
432 /* For reference buf[4]=1 is 1.5 stop bits */
433 /* For reference buf[4]=2 is 2 stop bits */
434 if (C_CSTOPB(tty)) {
435 /*
436 * NOTE: Comply with "real" UARTs / RS232:
437 * use 1.5 instead of 2 stop bits with 5 data bits
438 */
439 if (C_CSIZE(tty) == CS5) {
440 buf[4] = 1;
441 dev_dbg(&port->dev, "stop bits = 1.5\n");
442 } else {
443 buf[4] = 2;
444 dev_dbg(&port->dev, "stop bits = 2\n");
445 }
446 } else {
447 buf[4] = 0;
448 dev_dbg(&port->dev, "stop bits = 1\n");
449 }
450
451 if (C_PARENB(tty)) {
452 /* For reference buf[5]=0 is none parity */
453 /* For reference buf[5]=1 is odd parity */
454 /* For reference buf[5]=2 is even parity */
455 /* For reference buf[5]=3 is mark parity */
456 /* For reference buf[5]=4 is space parity */
457 if (C_PARODD(tty)) {
458 if (tty->termios.c_cflag & CMSPAR) {
459 buf[5] = 3;
460 dev_dbg(&port->dev, "parity = mark\n");
461 } else {
462 buf[5] = 1;
463 dev_dbg(&port->dev, "parity = odd\n");
464 }
465 } else {
466 if (tty->termios.c_cflag & CMSPAR) {
467 buf[5] = 4;
468 dev_dbg(&port->dev, "parity = space\n");
469 } else {
470 buf[5] = 2;
471 dev_dbg(&port->dev, "parity = even\n");
472 }
473 }
474 } else {
475 buf[5] = 0;
476 dev_dbg(&port->dev, "parity = none\n");
477 }
478
479 i = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
480 SET_LINE_REQUEST, SET_LINE_REQUEST_TYPE,
481 0, 0, buf, 7, 100);
482 dev_dbg(&port->dev, "0x21:0x20:0:0 %d\n", i);
483
484 /* change control lines if we are switching to or from B0 */
485 spin_lock_irqsave(&priv->lock, flags);
486 control = priv->line_control;
487 if (C_BAUD(tty) == B0)
488 priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
489 else if (old_termios && (old_termios->c_cflag & CBAUD) == B0)
490 priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
491 if (control != priv->line_control) {
492 control = priv->line_control;
493 spin_unlock_irqrestore(&priv->lock, flags);
494 pl2303_set_control_lines(port, control);
495 } else {
496 spin_unlock_irqrestore(&priv->lock, flags);
497 }
498
499 memset(buf, 0, 7);
500 i = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
501 GET_LINE_REQUEST, GET_LINE_REQUEST_TYPE,
502 0, 0, buf, 7, 100);
503 dev_dbg(&port->dev, "0xa1:0x21:0:0 %d - %7ph\n", i, buf);
504
505 if (C_CRTSCTS(tty)) {
506 if (spriv->type == HX)
507 pl2303_vendor_write(0x0, 0x61, serial);
508 else
509 pl2303_vendor_write(0x0, 0x41, serial);
510 } else {
511 pl2303_vendor_write(0x0, 0x0, serial);
512 }
513
514 kfree(buf);
515 }
516
517 static void pl2303_dtr_rts(struct usb_serial_port *port, int on)
518 {
519 struct pl2303_private *priv = usb_get_serial_port_data(port);
520 unsigned long flags;
521 u8 control;
522
523 spin_lock_irqsave(&priv->lock, flags);
524 /* Change DTR and RTS */
525 if (on)
526 priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
527 else
528 priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
529 control = priv->line_control;
530 spin_unlock_irqrestore(&priv->lock, flags);
531 pl2303_set_control_lines(port, control);
532 }
533
534 static void pl2303_close(struct usb_serial_port *port)
535 {
536 usb_serial_generic_close(port);
537 usb_kill_urb(port->interrupt_in_urb);
538 }
539
540 static int pl2303_open(struct tty_struct *tty, struct usb_serial_port *port)
541 {
542 struct usb_serial *serial = port->serial;
543 struct pl2303_serial_private *spriv = usb_get_serial_data(serial);
544 int result;
545
546 if (spriv->type != HX) {
547 usb_clear_halt(serial->dev, port->write_urb->pipe);
548 usb_clear_halt(serial->dev, port->read_urb->pipe);
549 } else {
550 /* reset upstream data pipes */
551 pl2303_vendor_write(8, 0, serial);
552 pl2303_vendor_write(9, 0, serial);
553 }
554
555 /* Setup termios */
556 if (tty)
557 pl2303_set_termios(tty, port, NULL);
558
559 result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
560 if (result) {
561 dev_err(&port->dev, "%s - failed submitting interrupt urb,"
562 " error %d\n", __func__, result);
563 return result;
564 }
565
566 result = usb_serial_generic_open(tty, port);
567 if (result) {
568 usb_kill_urb(port->interrupt_in_urb);
569 return result;
570 }
571
572 return 0;
573 }
574
575 static int pl2303_tiocmset(struct tty_struct *tty,
576 unsigned int set, unsigned int clear)
577 {
578 struct usb_serial_port *port = tty->driver_data;
579 struct pl2303_private *priv = usb_get_serial_port_data(port);
580 unsigned long flags;
581 u8 control;
582 int ret;
583
584 spin_lock_irqsave(&priv->lock, flags);
585 if (set & TIOCM_RTS)
586 priv->line_control |= CONTROL_RTS;
587 if (set & TIOCM_DTR)
588 priv->line_control |= CONTROL_DTR;
589 if (clear & TIOCM_RTS)
590 priv->line_control &= ~CONTROL_RTS;
591 if (clear & TIOCM_DTR)
592 priv->line_control &= ~CONTROL_DTR;
593 control = priv->line_control;
594 spin_unlock_irqrestore(&priv->lock, flags);
595
596 ret = pl2303_set_control_lines(port, control);
597 if (ret)
598 return usb_translate_errors(ret);
599
600 return 0;
601 }
602
603 static int pl2303_tiocmget(struct tty_struct *tty)
604 {
605 struct usb_serial_port *port = tty->driver_data;
606 struct pl2303_private *priv = usb_get_serial_port_data(port);
607 unsigned long flags;
608 unsigned int mcr;
609 unsigned int status;
610 unsigned int result;
611
612 spin_lock_irqsave(&priv->lock, flags);
613 mcr = priv->line_control;
614 status = priv->line_status;
615 spin_unlock_irqrestore(&priv->lock, flags);
616
617 result = ((mcr & CONTROL_DTR) ? TIOCM_DTR : 0)
618 | ((mcr & CONTROL_RTS) ? TIOCM_RTS : 0)
619 | ((status & UART_CTS) ? TIOCM_CTS : 0)
620 | ((status & UART_DSR) ? TIOCM_DSR : 0)
621 | ((status & UART_RING) ? TIOCM_RI : 0)
622 | ((status & UART_DCD) ? TIOCM_CD : 0);
623
624 dev_dbg(&port->dev, "%s - result = %x\n", __func__, result);
625
626 return result;
627 }
628
629 static int pl2303_carrier_raised(struct usb_serial_port *port)
630 {
631 struct pl2303_private *priv = usb_get_serial_port_data(port);
632 if (priv->line_status & UART_DCD)
633 return 1;
634 return 0;
635 }
636
637 static int pl2303_tiocmiwait(struct tty_struct *tty, unsigned long arg)
638 {
639 struct usb_serial_port *port = tty->driver_data;
640 struct pl2303_private *priv = usb_get_serial_port_data(port);
641 unsigned long flags;
642 unsigned int prevstatus;
643 unsigned int status;
644 unsigned int changed;
645
646 spin_lock_irqsave(&priv->lock, flags);
647 prevstatus = priv->line_status;
648 spin_unlock_irqrestore(&priv->lock, flags);
649
650 while (1) {
651 interruptible_sleep_on(&port->port.delta_msr_wait);
652 /* see if a signal did it */
653 if (signal_pending(current))
654 return -ERESTARTSYS;
655
656 if (port->serial->disconnected)
657 return -EIO;
658
659 spin_lock_irqsave(&priv->lock, flags);
660 status = priv->line_status;
661 spin_unlock_irqrestore(&priv->lock, flags);
662
663 changed = prevstatus ^ status;
664
665 if (((arg & TIOCM_RNG) && (changed & UART_RING)) ||
666 ((arg & TIOCM_DSR) && (changed & UART_DSR)) ||
667 ((arg & TIOCM_CD) && (changed & UART_DCD)) ||
668 ((arg & TIOCM_CTS) && (changed & UART_CTS))) {
669 return 0;
670 }
671 prevstatus = status;
672 }
673 /* NOTREACHED */
674 return 0;
675 }
676
677 static int pl2303_ioctl(struct tty_struct *tty,
678 unsigned int cmd, unsigned long arg)
679 {
680 struct serial_struct ser;
681 struct usb_serial_port *port = tty->driver_data;
682
683 dev_dbg(&port->dev, "%s cmd = 0x%04x\n", __func__, cmd);
684
685 switch (cmd) {
686 case TIOCGSERIAL:
687 memset(&ser, 0, sizeof ser);
688 ser.type = PORT_16654;
689 ser.line = port->minor;
690 ser.port = port->port_number;
691 ser.baud_base = 460800;
692
693 if (copy_to_user((void __user *)arg, &ser, sizeof ser))
694 return -EFAULT;
695
696 return 0;
697 default:
698 dev_dbg(&port->dev, "%s not supported = 0x%04x\n", __func__, cmd);
699 break;
700 }
701 return -ENOIOCTLCMD;
702 }
703
704 static void pl2303_break_ctl(struct tty_struct *tty, int break_state)
705 {
706 struct usb_serial_port *port = tty->driver_data;
707 struct usb_serial *serial = port->serial;
708 u16 state;
709 int result;
710
711 if (break_state == 0)
712 state = BREAK_OFF;
713 else
714 state = BREAK_ON;
715 dev_dbg(&port->dev, "%s - turning break %s\n", __func__,
716 state == BREAK_OFF ? "off" : "on");
717
718 result = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
719 BREAK_REQUEST, BREAK_REQUEST_TYPE, state,
720 0, NULL, 0, 100);
721 if (result)
722 dev_err(&port->dev, "error sending break = %d\n", result);
723 }
724
725 static void pl2303_update_line_status(struct usb_serial_port *port,
726 unsigned char *data,
727 unsigned int actual_length)
728 {
729
730 struct pl2303_private *priv = usb_get_serial_port_data(port);
731 struct tty_struct *tty;
732 unsigned long flags;
733 u8 status_idx = UART_STATE;
734 u8 length = UART_STATE + 1;
735 u8 prev_line_status;
736 u16 idv, idp;
737
738 idv = le16_to_cpu(port->serial->dev->descriptor.idVendor);
739 idp = le16_to_cpu(port->serial->dev->descriptor.idProduct);
740
741
742 if (idv == SIEMENS_VENDOR_ID) {
743 if (idp == SIEMENS_PRODUCT_ID_X65 ||
744 idp == SIEMENS_PRODUCT_ID_SX1 ||
745 idp == SIEMENS_PRODUCT_ID_X75) {
746
747 length = 1;
748 status_idx = 0;
749 }
750 }
751
752 if (actual_length < length)
753 return;
754
755 /* Save off the uart status for others to look at */
756 spin_lock_irqsave(&priv->lock, flags);
757 prev_line_status = priv->line_status;
758 priv->line_status = data[status_idx];
759 spin_unlock_irqrestore(&priv->lock, flags);
760 if (priv->line_status & UART_BREAK_ERROR)
761 usb_serial_handle_break(port);
762 wake_up_interruptible(&port->port.delta_msr_wait);
763
764 tty = tty_port_tty_get(&port->port);
765 if (!tty)
766 return;
767 if ((priv->line_status ^ prev_line_status) & UART_DCD)
768 usb_serial_handle_dcd_change(port, tty,
769 priv->line_status & UART_DCD);
770 tty_kref_put(tty);
771 }
772
773 static void pl2303_read_int_callback(struct urb *urb)
774 {
775 struct usb_serial_port *port = urb->context;
776 unsigned char *data = urb->transfer_buffer;
777 unsigned int actual_length = urb->actual_length;
778 int status = urb->status;
779 int retval;
780
781 switch (status) {
782 case 0:
783 /* success */
784 break;
785 case -ECONNRESET:
786 case -ENOENT:
787 case -ESHUTDOWN:
788 /* this urb is terminated, clean up */
789 dev_dbg(&port->dev, "%s - urb shutting down with status: %d\n",
790 __func__, status);
791 return;
792 default:
793 dev_dbg(&port->dev, "%s - nonzero urb status received: %d\n",
794 __func__, status);
795 goto exit;
796 }
797
798 usb_serial_debug_data(&port->dev, __func__,
799 urb->actual_length, urb->transfer_buffer);
800
801 pl2303_update_line_status(port, data, actual_length);
802
803 exit:
804 retval = usb_submit_urb(urb, GFP_ATOMIC);
805 if (retval)
806 dev_err(&port->dev,
807 "%s - usb_submit_urb failed with result %d\n",
808 __func__, retval);
809 }
810
811 static void pl2303_process_read_urb(struct urb *urb)
812 {
813 struct usb_serial_port *port = urb->context;
814 struct pl2303_private *priv = usb_get_serial_port_data(port);
815 unsigned char *data = urb->transfer_buffer;
816 char tty_flag = TTY_NORMAL;
817 unsigned long flags;
818 u8 line_status;
819 int i;
820
821 /* update line status */
822 spin_lock_irqsave(&priv->lock, flags);
823 line_status = priv->line_status;
824 priv->line_status &= ~UART_STATE_TRANSIENT_MASK;
825 spin_unlock_irqrestore(&priv->lock, flags);
826 wake_up_interruptible(&port->port.delta_msr_wait);
827
828 if (!urb->actual_length)
829 return;
830
831 /* break takes precedence over parity, */
832 /* which takes precedence over framing errors */
833 if (line_status & UART_BREAK_ERROR)
834 tty_flag = TTY_BREAK;
835 else if (line_status & UART_PARITY_ERROR)
836 tty_flag = TTY_PARITY;
837 else if (line_status & UART_FRAME_ERROR)
838 tty_flag = TTY_FRAME;
839
840 if (tty_flag != TTY_NORMAL)
841 dev_dbg(&port->dev, "%s - tty_flag = %d\n", __func__,
842 tty_flag);
843 /* overrun is special, not associated with a char */
844 if (line_status & UART_OVERRUN_ERROR)
845 tty_insert_flip_char(&port->port, 0, TTY_OVERRUN);
846
847 if (port->port.console && port->sysrq) {
848 for (i = 0; i < urb->actual_length; ++i)
849 if (!usb_serial_handle_sysrq_char(port, data[i]))
850 tty_insert_flip_char(&port->port, data[i],
851 tty_flag);
852 } else {
853 tty_insert_flip_string_fixed_flag(&port->port, data, tty_flag,
854 urb->actual_length);
855 }
856
857 tty_flip_buffer_push(&port->port);
858 }
859
860 /* All of the device info needed for the PL2303 SIO serial converter */
861 static struct usb_serial_driver pl2303_device = {
862 .driver = {
863 .owner = THIS_MODULE,
864 .name = "pl2303",
865 },
866 .id_table = id_table,
867 .num_ports = 1,
868 .bulk_in_size = 256,
869 .bulk_out_size = 256,
870 .open = pl2303_open,
871 .close = pl2303_close,
872 .dtr_rts = pl2303_dtr_rts,
873 .carrier_raised = pl2303_carrier_raised,
874 .ioctl = pl2303_ioctl,
875 .break_ctl = pl2303_break_ctl,
876 .set_termios = pl2303_set_termios,
877 .tiocmget = pl2303_tiocmget,
878 .tiocmset = pl2303_tiocmset,
879 .tiocmiwait = pl2303_tiocmiwait,
880 .process_read_urb = pl2303_process_read_urb,
881 .read_int_callback = pl2303_read_int_callback,
882 .attach = pl2303_startup,
883 .release = pl2303_release,
884 .port_probe = pl2303_port_probe,
885 .port_remove = pl2303_port_remove,
886 };
887
888 static struct usb_serial_driver * const serial_drivers[] = {
889 &pl2303_device, NULL
890 };
891
892 module_usb_serial_driver(serial_drivers, id_table);
893
894 MODULE_DESCRIPTION(DRIVER_DESC);
895 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.072664 seconds and 5 git commands to generate.