?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge tag 'drivers-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/arm...
[linux-2.6.git] / drivers / usb / serial / keyspan.c
blob5a979729f8ec4695a1fa4e4395b86a430184e1c9
1 /*
2 Keyspan USB to Serial Converter driver
3
4 (C) Copyright (C) 2000-2001 Hugh Blemings <hugh@blemings.org>
5 (C) Copyright (C) 2002 Greg Kroah-Hartman <greg@kroah.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License as published by
9 the Free Software Foundation; either version 2 of the License, or
10 (at your option) any later version.
11
12 See http://blemings.org/hugh/keyspan.html for more information.
13
14 Code in this driver inspired by and in a number of places taken
15 from Brian Warner's original Keyspan-PDA driver.
16
17 This driver has been put together with the support of Innosys, Inc.
18 and Keyspan, Inc the manufacturers of the Keyspan USB-serial products.
19 Thanks Guys :)
20
21 Thanks to Paulus for miscellaneous tidy ups, some largish chunks
22 of much nicer and/or completely new code and (perhaps most uniquely)
23 having the patience to sit down and explain why and where he'd changed
24 stuff.
25
26 Tip 'o the hat to IBM (and previously Linuxcare :) for supporting
27 staff in their work on open source projects.
28 */
29
30
31 #include <linux/kernel.h>
32 #include <linux/jiffies.h>
33 #include <linux/errno.h>
34 #include <linux/init.h>
35 #include <linux/slab.h>
36 #include <linux/tty.h>
37 #include <linux/tty_driver.h>
38 #include <linux/tty_flip.h>
39 #include <linux/module.h>
40 #include <linux/spinlock.h>
41 #include <linux/uaccess.h>
42 #include <linux/usb.h>
43 #include <linux/usb/serial.h>
44 #include <linux/usb/ezusb.h>
45 #include "keyspan.h"
46
47 #define DRIVER_AUTHOR "Hugh Blemings <hugh@misc.nu"
48 #define DRIVER_DESC "Keyspan USB to Serial Converter Driver"
49
50 #define INSTAT_BUFLEN 32
51 #define GLOCONT_BUFLEN 64
52 #define INDAT49W_BUFLEN 512
53
54 /* Per device and per port private data */
55 struct keyspan_serial_private {
56 const struct keyspan_device_details *device_details;
57
58 struct urb *instat_urb;
59 char instat_buf[INSTAT_BUFLEN];
60
61 /* added to support 49wg, where data from all 4 ports comes in
62 on 1 EP and high-speed supported */
63 struct urb *indat_urb;
64 char indat_buf[INDAT49W_BUFLEN];
65
66 /* XXX this one probably will need a lock */
67 struct urb *glocont_urb;
68 char glocont_buf[GLOCONT_BUFLEN];
69 char ctrl_buf[8]; /* for EP0 control message */
70 };
71
72 struct keyspan_port_private {
73 /* Keep track of which input & output endpoints to use */
74 int in_flip;
75 int out_flip;
76
77 /* Keep duplicate of device details in each port
78 structure as well - simplifies some of the
79 callback functions etc. */
80 const struct keyspan_device_details *device_details;
81
82 /* Input endpoints and buffer for this port */
83 struct urb *in_urbs[2];
84 char in_buffer[2][64];
85 /* Output endpoints and buffer for this port */
86 struct urb *out_urbs[2];
87 char out_buffer[2][64];
88
89 /* Input ack endpoint */
90 struct urb *inack_urb;
91 char inack_buffer[1];
92
93 /* Output control endpoint */
94 struct urb *outcont_urb;
95 char outcont_buffer[64];
96
97 /* Settings for the port */
98 int baud;
99 int old_baud;
100 unsigned int cflag;
101 unsigned int old_cflag;
102 enum {flow_none, flow_cts, flow_xon} flow_control;
103 int rts_state; /* Handshaking pins (outputs) */
104 int dtr_state;
105 int cts_state; /* Handshaking pins (inputs) */
106 int dsr_state;
107 int dcd_state;
108 int ri_state;
109 int break_on;
110
111 unsigned long tx_start_time[2];
112 int resend_cont; /* need to resend control packet */
113 };
114
115 /* Include Keyspan message headers. All current Keyspan Adapters
116 make use of one of five message formats which are referred
117 to as USA-26, USA-28, USA-49, USA-90, USA-67 by Keyspan and
118 within this driver. */
119 #include "keyspan_usa26msg.h"
120 #include "keyspan_usa28msg.h"
121 #include "keyspan_usa49msg.h"
122 #include "keyspan_usa90msg.h"
123 #include "keyspan_usa67msg.h"
124
125
126 module_usb_serial_driver(serial_drivers, keyspan_ids_combined);
127
128 static void keyspan_break_ctl(struct tty_struct *tty, int break_state)
129 {
130 struct usb_serial_port *port = tty->driver_data;
131 struct keyspan_port_private *p_priv;
132
133 p_priv = usb_get_serial_port_data(port);
134
135 if (break_state == -1)
136 p_priv->break_on = 1;
137 else
138 p_priv->break_on = 0;
139
140 keyspan_send_setup(port, 0);
141 }
142
143
144 static void keyspan_set_termios(struct tty_struct *tty,
145 struct usb_serial_port *port, struct ktermios *old_termios)
146 {
147 int baud_rate, device_port;
148 struct keyspan_port_private *p_priv;
149 const struct keyspan_device_details *d_details;
150 unsigned int cflag;
151
152 p_priv = usb_get_serial_port_data(port);
153 d_details = p_priv->device_details;
154 cflag = tty->termios.c_cflag;
155 device_port = port->port_number;
156
157 /* Baud rate calculation takes baud rate as an integer
158 so other rates can be generated if desired. */
159 baud_rate = tty_get_baud_rate(tty);
160 /* If no match or invalid, don't change */
161 if (d_details->calculate_baud_rate(port, baud_rate, d_details->baudclk,
162 NULL, NULL, NULL, device_port) == KEYSPAN_BAUD_RATE_OK) {
163 /* FIXME - more to do here to ensure rate changes cleanly */
164 /* FIXME - calcuate exact rate from divisor ? */
165 p_priv->baud = baud_rate;
166 } else
167 baud_rate = tty_termios_baud_rate(old_termios);
168
169 tty_encode_baud_rate(tty, baud_rate, baud_rate);
170 /* set CTS/RTS handshake etc. */
171 p_priv->cflag = cflag;
172 p_priv->flow_control = (cflag & CRTSCTS) ? flow_cts : flow_none;
173
174 /* Mark/Space not supported */
175 tty->termios.c_cflag &= ~CMSPAR;
176
177 keyspan_send_setup(port, 0);
178 }
179
180 static int keyspan_tiocmget(struct tty_struct *tty)
181 {
182 struct usb_serial_port *port = tty->driver_data;
183 struct keyspan_port_private *p_priv = usb_get_serial_port_data(port);
184 unsigned int value;
185
186 value = ((p_priv->rts_state) ? TIOCM_RTS : 0) |
187 ((p_priv->dtr_state) ? TIOCM_DTR : 0) |
188 ((p_priv->cts_state) ? TIOCM_CTS : 0) |
189 ((p_priv->dsr_state) ? TIOCM_DSR : 0) |
190 ((p_priv->dcd_state) ? TIOCM_CAR : 0) |
191 ((p_priv->ri_state) ? TIOCM_RNG : 0);
192
193 return value;
194 }
195
196 static int keyspan_tiocmset(struct tty_struct *tty,
197 unsigned int set, unsigned int clear)
198 {
199 struct usb_serial_port *port = tty->driver_data;
200 struct keyspan_port_private *p_priv = usb_get_serial_port_data(port);
201
202 if (set & TIOCM_RTS)
203 p_priv->rts_state = 1;
204 if (set & TIOCM_DTR)
205 p_priv->dtr_state = 1;
206 if (clear & TIOCM_RTS)
207 p_priv->rts_state = 0;
208 if (clear & TIOCM_DTR)
209 p_priv->dtr_state = 0;
210 keyspan_send_setup(port, 0);
211 return 0;
212 }
213
214 /* Write function is similar for the four protocols used
215 with only a minor change for usa90 (usa19hs) required */
216 static int keyspan_write(struct tty_struct *tty,
217 struct usb_serial_port *port, const unsigned char *buf, int count)
218 {
219 struct keyspan_port_private *p_priv;
220 const struct keyspan_device_details *d_details;
221 int flip;
222 int left, todo;
223 struct urb *this_urb;
224 int err, maxDataLen, dataOffset;
225
226 p_priv = usb_get_serial_port_data(port);
227 d_details = p_priv->device_details;
228
229 if (d_details->msg_format == msg_usa90) {
230 maxDataLen = 64;
231 dataOffset = 0;
232 } else {
233 maxDataLen = 63;
234 dataOffset = 1;
235 }
236
237 dev_dbg(&port->dev, "%s - %d chars, flip=%d\n", __func__, count,
238 p_priv->out_flip);
239
240 for (left = count; left > 0; left -= todo) {
241 todo = left;
242 if (todo > maxDataLen)
243 todo = maxDataLen;
244
245 flip = p_priv->out_flip;
246
247 /* Check we have a valid urb/endpoint before we use it... */
248 this_urb = p_priv->out_urbs[flip];
249 if (this_urb == NULL) {
250 /* no bulk out, so return 0 bytes written */
251 dev_dbg(&port->dev, "%s - no output urb :(\n", __func__);
252 return count;
253 }
254
255 dev_dbg(&port->dev, "%s - endpoint %d flip %d\n",
256 __func__, usb_pipeendpoint(this_urb->pipe), flip);
257
258 if (this_urb->status == -EINPROGRESS) {
259 if (time_before(jiffies,
260 p_priv->tx_start_time[flip] + 10 * HZ))
261 break;
262 usb_unlink_urb(this_urb);
263 break;
264 }
265
266 /* First byte in buffer is "last flag" (except for usa19hx)
267 - unused so for now so set to zero */
268 ((char *)this_urb->transfer_buffer)[0] = 0;
269
270 memcpy(this_urb->transfer_buffer + dataOffset, buf, todo);
271 buf += todo;
272
273 /* send the data out the bulk port */
274 this_urb->transfer_buffer_length = todo + dataOffset;
275
276 err = usb_submit_urb(this_urb, GFP_ATOMIC);
277 if (err != 0)
278 dev_dbg(&port->dev, "usb_submit_urb(write bulk) failed (%d)\n", err);
279 p_priv->tx_start_time[flip] = jiffies;
280
281 /* Flip for next time if usa26 or usa28 interface
282 (not used on usa49) */
283 p_priv->out_flip = (flip + 1) & d_details->outdat_endp_flip;
284 }
285
286 return count - left;
287 }
288
289 static void usa26_indat_callback(struct urb *urb)
290 {
291 int i, err;
292 int endpoint;
293 struct usb_serial_port *port;
294 unsigned char *data = urb->transfer_buffer;
295 int status = urb->status;
296
297 endpoint = usb_pipeendpoint(urb->pipe);
298
299 if (status) {
300 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x on endpoint %d.\n",
301 __func__, status, endpoint);
302 return;
303 }
304
305 port = urb->context;
306 if (urb->actual_length) {
307 /* 0x80 bit is error flag */
308 if ((data[0] & 0x80) == 0) {
309 /* no errors on individual bytes, only
310 possible overrun err */
311 if (data[0] & RXERROR_OVERRUN)
312 err = TTY_OVERRUN;
313 else
314 err = 0;
315 for (i = 1; i < urb->actual_length ; ++i)
316 tty_insert_flip_char(&port->port, data[i], err);
317 } else {
318 /* some bytes had errors, every byte has status */
319 dev_dbg(&port->dev, "%s - RX error!!!!\n", __func__);
320 for (i = 0; i + 1 < urb->actual_length; i += 2) {
321 int stat = data[i], flag = 0;
322 if (stat & RXERROR_OVERRUN)
323 flag |= TTY_OVERRUN;
324 if (stat & RXERROR_FRAMING)
325 flag |= TTY_FRAME;
326 if (stat & RXERROR_PARITY)
327 flag |= TTY_PARITY;
328 /* XXX should handle break (0x10) */
329 tty_insert_flip_char(&port->port, data[i+1],
330 flag);
331 }
332 }
333 tty_flip_buffer_push(&port->port);
334 }
335
336 /* Resubmit urb so we continue receiving */
337 err = usb_submit_urb(urb, GFP_ATOMIC);
338 if (err != 0)
339 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
340 }
341
342 /* Outdat handling is common for all devices */
343 static void usa2x_outdat_callback(struct urb *urb)
344 {
345 struct usb_serial_port *port;
346 struct keyspan_port_private *p_priv;
347
348 port = urb->context;
349 p_priv = usb_get_serial_port_data(port);
350 dev_dbg(&port->dev, "%s - urb %d\n", __func__, urb == p_priv->out_urbs[1]);
351
352 usb_serial_port_softint(port);
353 }
354
355 static void usa26_inack_callback(struct urb *urb)
356 {
357 }
358
359 static void usa26_outcont_callback(struct urb *urb)
360 {
361 struct usb_serial_port *port;
362 struct keyspan_port_private *p_priv;
363
364 port = urb->context;
365 p_priv = usb_get_serial_port_data(port);
366
367 if (p_priv->resend_cont) {
368 dev_dbg(&port->dev, "%s - sending setup\n", __func__);
369 keyspan_usa26_send_setup(port->serial, port,
370 p_priv->resend_cont - 1);
371 }
372 }
373
374 static void usa26_instat_callback(struct urb *urb)
375 {
376 unsigned char *data = urb->transfer_buffer;
377 struct keyspan_usa26_portStatusMessage *msg;
378 struct usb_serial *serial;
379 struct usb_serial_port *port;
380 struct keyspan_port_private *p_priv;
381 int old_dcd_state, err;
382 int status = urb->status;
383
384 serial = urb->context;
385
386 if (status) {
387 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x\n", __func__, status);
388 return;
389 }
390 if (urb->actual_length != 9) {
391 dev_dbg(&urb->dev->dev, "%s - %d byte report??\n", __func__, urb->actual_length);
392 goto exit;
393 }
394
395 msg = (struct keyspan_usa26_portStatusMessage *)data;
396
397 #if 0
398 dev_dbg(&urb->dev->dev,
399 "%s - port status: port %d cts %d dcd %d dsr %d ri %d toff %d txoff %d rxen %d cr %d",
400 __func__, msg->port, msg->hskia_cts, msg->gpia_dcd, msg->dsr,
401 msg->ri, msg->_txOff, msg->_txXoff, msg->rxEnabled,
402 msg->controlResponse);
403 #endif
404
405 /* Now do something useful with the data */
406
407
408 /* Check port number from message and retrieve private data */
409 if (msg->port >= serial->num_ports) {
410 dev_dbg(&urb->dev->dev, "%s - Unexpected port number %d\n", __func__, msg->port);
411 goto exit;
412 }
413 port = serial->port[msg->port];
414 p_priv = usb_get_serial_port_data(port);
415
416 /* Update handshaking pin state information */
417 old_dcd_state = p_priv->dcd_state;
418 p_priv->cts_state = ((msg->hskia_cts) ? 1 : 0);
419 p_priv->dsr_state = ((msg->dsr) ? 1 : 0);
420 p_priv->dcd_state = ((msg->gpia_dcd) ? 1 : 0);
421 p_priv->ri_state = ((msg->ri) ? 1 : 0);
422
423 if (old_dcd_state != p_priv->dcd_state)
424 tty_port_tty_hangup(&port->port, true);
425
426 /* Resubmit urb so we continue receiving */
427 err = usb_submit_urb(urb, GFP_ATOMIC);
428 if (err != 0)
429 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
430 exit: ;
431 }
432
433 static void usa26_glocont_callback(struct urb *urb)
434 {
435 }
436
437
438 static void usa28_indat_callback(struct urb *urb)
439 {
440 int err;
441 struct usb_serial_port *port;
442 unsigned char *data;
443 struct keyspan_port_private *p_priv;
444 int status = urb->status;
445
446 port = urb->context;
447 p_priv = usb_get_serial_port_data(port);
448 data = urb->transfer_buffer;
449
450 if (urb != p_priv->in_urbs[p_priv->in_flip])
451 return;
452
453 do {
454 if (status) {
455 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x on endpoint %d.\n",
456 __func__, status, usb_pipeendpoint(urb->pipe));
457 return;
458 }
459
460 port = urb->context;
461 p_priv = usb_get_serial_port_data(port);
462 data = urb->transfer_buffer;
463
464 if (urb->actual_length) {
465 tty_insert_flip_string(&port->port, data,
466 urb->actual_length);
467 tty_flip_buffer_push(&port->port);
468 }
469
470 /* Resubmit urb so we continue receiving */
471 err = usb_submit_urb(urb, GFP_ATOMIC);
472 if (err != 0)
473 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n",
474 __func__, err);
475 p_priv->in_flip ^= 1;
476
477 urb = p_priv->in_urbs[p_priv->in_flip];
478 } while (urb->status != -EINPROGRESS);
479 }
480
481 static void usa28_inack_callback(struct urb *urb)
482 {
483 }
484
485 static void usa28_outcont_callback(struct urb *urb)
486 {
487 struct usb_serial_port *port;
488 struct keyspan_port_private *p_priv;
489
490 port = urb->context;
491 p_priv = usb_get_serial_port_data(port);
492
493 if (p_priv->resend_cont) {
494 dev_dbg(&port->dev, "%s - sending setup\n", __func__);
495 keyspan_usa28_send_setup(port->serial, port,
496 p_priv->resend_cont - 1);
497 }
498 }
499
500 static void usa28_instat_callback(struct urb *urb)
501 {
502 int err;
503 unsigned char *data = urb->transfer_buffer;
504 struct keyspan_usa28_portStatusMessage *msg;
505 struct usb_serial *serial;
506 struct usb_serial_port *port;
507 struct keyspan_port_private *p_priv;
508 int old_dcd_state;
509 int status = urb->status;
510
511 serial = urb->context;
512
513 if (status) {
514 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x\n", __func__, status);
515 return;
516 }
517
518 if (urb->actual_length != sizeof(struct keyspan_usa28_portStatusMessage)) {
519 dev_dbg(&urb->dev->dev, "%s - bad length %d\n", __func__, urb->actual_length);
520 goto exit;
521 }
522
523 /*dev_dbg(&urb->dev->dev, "%s %12ph", __func__, data);*/
524
525 /* Now do something useful with the data */
526 msg = (struct keyspan_usa28_portStatusMessage *)data;
527
528 /* Check port number from message and retrieve private data */
529 if (msg->port >= serial->num_ports) {
530 dev_dbg(&urb->dev->dev, "%s - Unexpected port number %d\n", __func__, msg->port);
531 goto exit;
532 }
533 port = serial->port[msg->port];
534 p_priv = usb_get_serial_port_data(port);
535
536 /* Update handshaking pin state information */
537 old_dcd_state = p_priv->dcd_state;
538 p_priv->cts_state = ((msg->cts) ? 1 : 0);
539 p_priv->dsr_state = ((msg->dsr) ? 1 : 0);
540 p_priv->dcd_state = ((msg->dcd) ? 1 : 0);
541 p_priv->ri_state = ((msg->ri) ? 1 : 0);
542
543 if (old_dcd_state != p_priv->dcd_state && old_dcd_state)
544 tty_port_tty_hangup(&port->port, true);
545
546 /* Resubmit urb so we continue receiving */
547 err = usb_submit_urb(urb, GFP_ATOMIC);
548 if (err != 0)
549 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
550 exit: ;
551 }
552
553 static void usa28_glocont_callback(struct urb *urb)
554 {
555 }
556
557
558 static void usa49_glocont_callback(struct urb *urb)
559 {
560 struct usb_serial *serial;
561 struct usb_serial_port *port;
562 struct keyspan_port_private *p_priv;
563 int i;
564
565 serial = urb->context;
566 for (i = 0; i < serial->num_ports; ++i) {
567 port = serial->port[i];
568 p_priv = usb_get_serial_port_data(port);
569
570 if (p_priv->resend_cont) {
571 dev_dbg(&port->dev, "%s - sending setup\n", __func__);
572 keyspan_usa49_send_setup(serial, port,
573 p_priv->resend_cont - 1);
574 break;
575 }
576 }
577 }
578
579 /* This is actually called glostat in the Keyspan
580 doco */
581 static void usa49_instat_callback(struct urb *urb)
582 {
583 int err;
584 unsigned char *data = urb->transfer_buffer;
585 struct keyspan_usa49_portStatusMessage *msg;
586 struct usb_serial *serial;
587 struct usb_serial_port *port;
588 struct keyspan_port_private *p_priv;
589 int old_dcd_state;
590 int status = urb->status;
591
592 serial = urb->context;
593
594 if (status) {
595 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x\n", __func__, status);
596 return;
597 }
598
599 if (urb->actual_length !=
600 sizeof(struct keyspan_usa49_portStatusMessage)) {
601 dev_dbg(&urb->dev->dev, "%s - bad length %d\n", __func__, urb->actual_length);
602 goto exit;
603 }
604
605 /*dev_dbg(&urb->dev->dev, "%s: %11ph", __func__, data);*/
606
607 /* Now do something useful with the data */
608 msg = (struct keyspan_usa49_portStatusMessage *)data;
609
610 /* Check port number from message and retrieve private data */
611 if (msg->portNumber >= serial->num_ports) {
612 dev_dbg(&urb->dev->dev, "%s - Unexpected port number %d\n",
613 __func__, msg->portNumber);
614 goto exit;
615 }
616 port = serial->port[msg->portNumber];
617 p_priv = usb_get_serial_port_data(port);
618
619 /* Update handshaking pin state information */
620 old_dcd_state = p_priv->dcd_state;
621 p_priv->cts_state = ((msg->cts) ? 1 : 0);
622 p_priv->dsr_state = ((msg->dsr) ? 1 : 0);
623 p_priv->dcd_state = ((msg->dcd) ? 1 : 0);
624 p_priv->ri_state = ((msg->ri) ? 1 : 0);
625
626 if (old_dcd_state != p_priv->dcd_state && old_dcd_state)
627 tty_port_tty_hangup(&port->port, true);
628
629 /* Resubmit urb so we continue receiving */
630 err = usb_submit_urb(urb, GFP_ATOMIC);
631 if (err != 0)
632 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
633 exit: ;
634 }
635
636 static void usa49_inack_callback(struct urb *urb)
637 {
638 }
639
640 static void usa49_indat_callback(struct urb *urb)
641 {
642 int i, err;
643 int endpoint;
644 struct usb_serial_port *port;
645 unsigned char *data = urb->transfer_buffer;
646 int status = urb->status;
647
648 endpoint = usb_pipeendpoint(urb->pipe);
649
650 if (status) {
651 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x on endpoint %d.\n",
652 __func__, status, endpoint);
653 return;
654 }
655
656 port = urb->context;
657 if (urb->actual_length) {
658 /* 0x80 bit is error flag */
659 if ((data[0] & 0x80) == 0) {
660 /* no error on any byte */
661 tty_insert_flip_string(&port->port, data + 1,
662 urb->actual_length - 1);
663 } else {
664 /* some bytes had errors, every byte has status */
665 for (i = 0; i + 1 < urb->actual_length; i += 2) {
666 int stat = data[i], flag = 0;
667 if (stat & RXERROR_OVERRUN)
668 flag |= TTY_OVERRUN;
669 if (stat & RXERROR_FRAMING)
670 flag |= TTY_FRAME;
671 if (stat & RXERROR_PARITY)
672 flag |= TTY_PARITY;
673 /* XXX should handle break (0x10) */
674 tty_insert_flip_char(&port->port, data[i+1],
675 flag);
676 }
677 }
678 tty_flip_buffer_push(&port->port);
679 }
680
681 /* Resubmit urb so we continue receiving */
682 err = usb_submit_urb(urb, GFP_ATOMIC);
683 if (err != 0)
684 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
685 }
686
687 static void usa49wg_indat_callback(struct urb *urb)
688 {
689 int i, len, x, err;
690 struct usb_serial *serial;
691 struct usb_serial_port *port;
692 unsigned char *data = urb->transfer_buffer;
693 int status = urb->status;
694
695 serial = urb->context;
696
697 if (status) {
698 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x\n", __func__, status);
699 return;
700 }
701
702 /* inbound data is in the form P#, len, status, data */
703 i = 0;
704 len = 0;
705
706 while (i < urb->actual_length) {
707
708 /* Check port number from message */
709 if (data[i] >= serial->num_ports) {
710 dev_dbg(&urb->dev->dev, "%s - Unexpected port number %d\n",
711 __func__, data[i]);
712 return;
713 }
714 port = serial->port[data[i++]];
715 len = data[i++];
716
717 /* 0x80 bit is error flag */
718 if ((data[i] & 0x80) == 0) {
719 /* no error on any byte */
720 i++;
721 for (x = 1; x < len && i < urb->actual_length; ++x)
722 tty_insert_flip_char(&port->port,
723 data[i++], 0);
724 } else {
725 /*
726 * some bytes had errors, every byte has status
727 */
728 for (x = 0; x + 1 < len &&
729 i + 1 < urb->actual_length; x += 2) {
730 int stat = data[i], flag = 0;
731
732 if (stat & RXERROR_OVERRUN)
733 flag |= TTY_OVERRUN;
734 if (stat & RXERROR_FRAMING)
735 flag |= TTY_FRAME;
736 if (stat & RXERROR_PARITY)
737 flag |= TTY_PARITY;
738 /* XXX should handle break (0x10) */
739 tty_insert_flip_char(&port->port, data[i+1],
740 flag);
741 i += 2;
742 }
743 }
744 tty_flip_buffer_push(&port->port);
745 }
746
747 /* Resubmit urb so we continue receiving */
748 err = usb_submit_urb(urb, GFP_ATOMIC);
749 if (err != 0)
750 dev_dbg(&urb->dev->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
751 }
752
753 /* not used, usa-49 doesn't have per-port control endpoints */
754 static void usa49_outcont_callback(struct urb *urb)
755 {
756 }
757
758 static void usa90_indat_callback(struct urb *urb)
759 {
760 int i, err;
761 int endpoint;
762 struct usb_serial_port *port;
763 struct keyspan_port_private *p_priv;
764 unsigned char *data = urb->transfer_buffer;
765 int status = urb->status;
766
767 endpoint = usb_pipeendpoint(urb->pipe);
768
769 if (status) {
770 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x on endpoint %d.\n",
771 __func__, status, endpoint);
772 return;
773 }
774
775 port = urb->context;
776 p_priv = usb_get_serial_port_data(port);
777
778 if (urb->actual_length) {
779 /* if current mode is DMA, looks like usa28 format
780 otherwise looks like usa26 data format */
781
782 if (p_priv->baud > 57600)
783 tty_insert_flip_string(&port->port, data,
784 urb->actual_length);
785 else {
786 /* 0x80 bit is error flag */
787 if ((data[0] & 0x80) == 0) {
788 /* no errors on individual bytes, only
789 possible overrun err*/
790 if (data[0] & RXERROR_OVERRUN)
791 err = TTY_OVERRUN;
792 else
793 err = 0;
794 for (i = 1; i < urb->actual_length ; ++i)
795 tty_insert_flip_char(&port->port,
796 data[i], err);
797 } else {
798 /* some bytes had errors, every byte has status */
799 dev_dbg(&port->dev, "%s - RX error!!!!\n", __func__);
800 for (i = 0; i + 1 < urb->actual_length; i += 2) {
801 int stat = data[i], flag = 0;
802 if (stat & RXERROR_OVERRUN)
803 flag |= TTY_OVERRUN;
804 if (stat & RXERROR_FRAMING)
805 flag |= TTY_FRAME;
806 if (stat & RXERROR_PARITY)
807 flag |= TTY_PARITY;
808 /* XXX should handle break (0x10) */
809 tty_insert_flip_char(&port->port,
810 data[i+1], flag);
811 }
812 }
813 }
814 tty_flip_buffer_push(&port->port);
815 }
816
817 /* Resubmit urb so we continue receiving */
818 err = usb_submit_urb(urb, GFP_ATOMIC);
819 if (err != 0)
820 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
821 }
822
823
824 static void usa90_instat_callback(struct urb *urb)
825 {
826 unsigned char *data = urb->transfer_buffer;
827 struct keyspan_usa90_portStatusMessage *msg;
828 struct usb_serial *serial;
829 struct usb_serial_port *port;
830 struct keyspan_port_private *p_priv;
831 int old_dcd_state, err;
832 int status = urb->status;
833
834 serial = urb->context;
835
836 if (status) {
837 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x\n", __func__, status);
838 return;
839 }
840 if (urb->actual_length < 14) {
841 dev_dbg(&urb->dev->dev, "%s - %d byte report??\n", __func__, urb->actual_length);
842 goto exit;
843 }
844
845 msg = (struct keyspan_usa90_portStatusMessage *)data;
846
847 /* Now do something useful with the data */
848
849 port = serial->port[0];
850 p_priv = usb_get_serial_port_data(port);
851
852 /* Update handshaking pin state information */
853 old_dcd_state = p_priv->dcd_state;
854 p_priv->cts_state = ((msg->cts) ? 1 : 0);
855 p_priv->dsr_state = ((msg->dsr) ? 1 : 0);
856 p_priv->dcd_state = ((msg->dcd) ? 1 : 0);
857 p_priv->ri_state = ((msg->ri) ? 1 : 0);
858
859 if (old_dcd_state != p_priv->dcd_state && old_dcd_state)
860 tty_port_tty_hangup(&port->port, true);
861
862 /* Resubmit urb so we continue receiving */
863 err = usb_submit_urb(urb, GFP_ATOMIC);
864 if (err != 0)
865 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
866 exit:
867 ;
868 }
869
870 static void usa90_outcont_callback(struct urb *urb)
871 {
872 struct usb_serial_port *port;
873 struct keyspan_port_private *p_priv;
874
875 port = urb->context;
876 p_priv = usb_get_serial_port_data(port);
877
878 if (p_priv->resend_cont) {
879 dev_dbg(&urb->dev->dev, "%s - sending setup\n", __func__);
880 keyspan_usa90_send_setup(port->serial, port,
881 p_priv->resend_cont - 1);
882 }
883 }
884
885 /* Status messages from the 28xg */
886 static void usa67_instat_callback(struct urb *urb)
887 {
888 int err;
889 unsigned char *data = urb->transfer_buffer;
890 struct keyspan_usa67_portStatusMessage *msg;
891 struct usb_serial *serial;
892 struct usb_serial_port *port;
893 struct keyspan_port_private *p_priv;
894 int old_dcd_state;
895 int status = urb->status;
896
897 serial = urb->context;
898
899 if (status) {
900 dev_dbg(&urb->dev->dev, "%s - nonzero status: %x\n", __func__, status);
901 return;
902 }
903
904 if (urb->actual_length !=
905 sizeof(struct keyspan_usa67_portStatusMessage)) {
906 dev_dbg(&urb->dev->dev, "%s - bad length %d\n", __func__, urb->actual_length);
907 return;
908 }
909
910
911 /* Now do something useful with the data */
912 msg = (struct keyspan_usa67_portStatusMessage *)data;
913
914 /* Check port number from message and retrieve private data */
915 if (msg->port >= serial->num_ports) {
916 dev_dbg(&urb->dev->dev, "%s - Unexpected port number %d\n", __func__, msg->port);
917 return;
918 }
919
920 port = serial->port[msg->port];
921 p_priv = usb_get_serial_port_data(port);
922
923 /* Update handshaking pin state information */
924 old_dcd_state = p_priv->dcd_state;
925 p_priv->cts_state = ((msg->hskia_cts) ? 1 : 0);
926 p_priv->dcd_state = ((msg->gpia_dcd) ? 1 : 0);
927
928 if (old_dcd_state != p_priv->dcd_state && old_dcd_state)
929 tty_port_tty_hangup(&port->port, true);
930
931 /* Resubmit urb so we continue receiving */
932 err = usb_submit_urb(urb, GFP_ATOMIC);
933 if (err != 0)
934 dev_dbg(&port->dev, "%s - resubmit read urb failed. (%d)\n", __func__, err);
935 }
936
937 static void usa67_glocont_callback(struct urb *urb)
938 {
939 struct usb_serial *serial;
940 struct usb_serial_port *port;
941 struct keyspan_port_private *p_priv;
942 int i;
943
944 serial = urb->context;
945 for (i = 0; i < serial->num_ports; ++i) {
946 port = serial->port[i];
947 p_priv = usb_get_serial_port_data(port);
948
949 if (p_priv->resend_cont) {
950 dev_dbg(&port->dev, "%s - sending setup\n", __func__);
951 keyspan_usa67_send_setup(serial, port,
952 p_priv->resend_cont - 1);
953 break;
954 }
955 }
956 }
957
958 static int keyspan_write_room(struct tty_struct *tty)
959 {
960 struct usb_serial_port *port = tty->driver_data;
961 struct keyspan_port_private *p_priv;
962 const struct keyspan_device_details *d_details;
963 int flip;
964 int data_len;
965 struct urb *this_urb;
966
967 p_priv = usb_get_serial_port_data(port);
968 d_details = p_priv->device_details;
969
970 /* FIXME: locking */
971 if (d_details->msg_format == msg_usa90)
972 data_len = 64;
973 else
974 data_len = 63;
975
976 flip = p_priv->out_flip;
977
978 /* Check both endpoints to see if any are available. */
979 this_urb = p_priv->out_urbs[flip];
980 if (this_urb != NULL) {
981 if (this_urb->status != -EINPROGRESS)
982 return data_len;
983 flip = (flip + 1) & d_details->outdat_endp_flip;
984 this_urb = p_priv->out_urbs[flip];
985 if (this_urb != NULL) {
986 if (this_urb->status != -EINPROGRESS)
987 return data_len;
988 }
989 }
990 return 0;
991 }
992
993
994 static int keyspan_open(struct tty_struct *tty, struct usb_serial_port *port)
995 {
996 struct keyspan_port_private *p_priv;
997 const struct keyspan_device_details *d_details;
998 int i, err;
999 int baud_rate, device_port;
1000 struct urb *urb;
1001 unsigned int cflag = 0;
1002
1003 p_priv = usb_get_serial_port_data(port);
1004 d_details = p_priv->device_details;
1005
1006 /* Set some sane defaults */
1007 p_priv->rts_state = 1;
1008 p_priv->dtr_state = 1;
1009 p_priv->baud = 9600;
1010
1011 /* force baud and lcr to be set on open */
1012 p_priv->old_baud = 0;
1013 p_priv->old_cflag = 0;
1014
1015 p_priv->out_flip = 0;
1016 p_priv->in_flip = 0;
1017
1018 /* Reset low level data toggle and start reading from endpoints */
1019 for (i = 0; i < 2; i++) {
1020 urb = p_priv->in_urbs[i];
1021 if (urb == NULL)
1022 continue;
1023
1024 /* make sure endpoint data toggle is synchronized
1025 with the device */
1026 usb_clear_halt(urb->dev, urb->pipe);
1027 err = usb_submit_urb(urb, GFP_KERNEL);
1028 if (err != 0)
1029 dev_dbg(&port->dev, "%s - submit urb %d failed (%d)\n", __func__, i, err);
1030 }
1031
1032 /* Reset low level data toggle on out endpoints */
1033 for (i = 0; i < 2; i++) {
1034 urb = p_priv->out_urbs[i];
1035 if (urb == NULL)
1036 continue;
1037 /* usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe),
1038 usb_pipeout(urb->pipe), 0); */
1039 }
1040
1041 /* get the terminal config for the setup message now so we don't
1042 * need to send 2 of them */
1043
1044 device_port = port->port_number;
1045 if (tty) {
1046 cflag = tty->termios.c_cflag;
1047 /* Baud rate calculation takes baud rate as an integer
1048 so other rates can be generated if desired. */
1049 baud_rate = tty_get_baud_rate(tty);
1050 /* If no match or invalid, leave as default */
1051 if (baud_rate >= 0
1052 && d_details->calculate_baud_rate(port, baud_rate, d_details->baudclk,
1053 NULL, NULL, NULL, device_port) == KEYSPAN_BAUD_RATE_OK) {
1054 p_priv->baud = baud_rate;
1055 }
1056 }
1057 /* set CTS/RTS handshake etc. */
1058 p_priv->cflag = cflag;
1059 p_priv->flow_control = (cflag & CRTSCTS) ? flow_cts : flow_none;
1060
1061 keyspan_send_setup(port, 1);
1062 /* mdelay(100); */
1063 /* keyspan_set_termios(port, NULL); */
1064
1065 return 0;
1066 }
1067
1068 static inline void stop_urb(struct urb *urb)
1069 {
1070 if (urb && urb->status == -EINPROGRESS)
1071 usb_kill_urb(urb);
1072 }
1073
1074 static void keyspan_dtr_rts(struct usb_serial_port *port, int on)
1075 {
1076 struct keyspan_port_private *p_priv = usb_get_serial_port_data(port);
1077
1078 p_priv->rts_state = on;
1079 p_priv->dtr_state = on;
1080 keyspan_send_setup(port, 0);
1081 }
1082
1083 static void keyspan_close(struct usb_serial_port *port)
1084 {
1085 int i;
1086 struct keyspan_port_private *p_priv;
1087
1088 p_priv = usb_get_serial_port_data(port);
1089
1090 p_priv->rts_state = 0;
1091 p_priv->dtr_state = 0;
1092
1093 keyspan_send_setup(port, 2);
1094 /* pilot-xfer seems to work best with this delay */
1095 mdelay(100);
1096
1097 p_priv->out_flip = 0;
1098 p_priv->in_flip = 0;
1099
1100 stop_urb(p_priv->inack_urb);
1101 for (i = 0; i < 2; i++) {
1102 stop_urb(p_priv->in_urbs[i]);
1103 stop_urb(p_priv->out_urbs[i]);
1104 }
1105 }
1106
1107 /* download the firmware to a pre-renumeration device */
1108 static int keyspan_fake_startup(struct usb_serial *serial)
1109 {
1110 char *fw_name;
1111
1112 dev_dbg(&serial->dev->dev, "Keyspan startup version %04x product %04x\n",
1113 le16_to_cpu(serial->dev->descriptor.bcdDevice),
1114 le16_to_cpu(serial->dev->descriptor.idProduct));
1115
1116 if ((le16_to_cpu(serial->dev->descriptor.bcdDevice) & 0x8000)
1117 != 0x8000) {
1118 dev_dbg(&serial->dev->dev, "Firmware already loaded. Quitting.\n");
1119 return 1;
1120 }
1121
1122 /* Select firmware image on the basis of idProduct */
1123 switch (le16_to_cpu(serial->dev->descriptor.idProduct)) {
1124 case keyspan_usa28_pre_product_id:
1125 fw_name = "keyspan/usa28.fw";
1126 break;
1127
1128 case keyspan_usa28x_pre_product_id:
1129 fw_name = "keyspan/usa28x.fw";
1130 break;
1131
1132 case keyspan_usa28xa_pre_product_id:
1133 fw_name = "keyspan/usa28xa.fw";
1134 break;
1135
1136 case keyspan_usa28xb_pre_product_id:
1137 fw_name = "keyspan/usa28xb.fw";
1138 break;
1139
1140 case keyspan_usa19_pre_product_id:
1141 fw_name = "keyspan/usa19.fw";
1142 break;
1143
1144 case keyspan_usa19qi_pre_product_id:
1145 fw_name = "keyspan/usa19qi.fw";
1146 break;
1147
1148 case keyspan_mpr_pre_product_id:
1149 fw_name = "keyspan/mpr.fw";
1150 break;
1151
1152 case keyspan_usa19qw_pre_product_id:
1153 fw_name = "keyspan/usa19qw.fw";
1154 break;
1155
1156 case keyspan_usa18x_pre_product_id:
1157 fw_name = "keyspan/usa18x.fw";
1158 break;
1159
1160 case keyspan_usa19w_pre_product_id:
1161 fw_name = "keyspan/usa19w.fw";
1162 break;
1163
1164 case keyspan_usa49w_pre_product_id:
1165 fw_name = "keyspan/usa49w.fw";
1166 break;
1167
1168 case keyspan_usa49wlc_pre_product_id:
1169 fw_name = "keyspan/usa49wlc.fw";
1170 break;
1171
1172 default:
1173 dev_err(&serial->dev->dev, "Unknown product ID (%04x)\n",
1174 le16_to_cpu(serial->dev->descriptor.idProduct));
1175 return 1;
1176 }
1177
1178 dev_dbg(&serial->dev->dev, "Uploading Keyspan %s firmware.\n", fw_name);
1179
1180 if (ezusb_fx1_ihex_firmware_download(serial->dev, fw_name) < 0) {
1181 dev_err(&serial->dev->dev, "failed to load firmware \"%s\"\n",
1182 fw_name);
1183 return -ENOENT;
1184 }
1185
1186 /* after downloading firmware Renumeration will occur in a
1187 moment and the new device will bind to the real driver */
1188
1189 /* we don't want this device to have a driver assigned to it. */
1190 return 1;
1191 }
1192
1193 /* Helper functions used by keyspan_setup_urbs */
1194 static struct usb_endpoint_descriptor const *find_ep(struct usb_serial const *serial,
1195 int endpoint)
1196 {
1197 struct usb_host_interface *iface_desc;
1198 struct usb_endpoint_descriptor *ep;
1199 int i;
1200
1201 iface_desc = serial->interface->cur_altsetting;
1202 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
1203 ep = &iface_desc->endpoint[i].desc;
1204 if (ep->bEndpointAddress == endpoint)
1205 return ep;
1206 }
1207 dev_warn(&serial->interface->dev, "found no endpoint descriptor for "
1208 "endpoint %x\n", endpoint);
1209 return NULL;
1210 }
1211
1212 static struct urb *keyspan_setup_urb(struct usb_serial *serial, int endpoint,
1213 int dir, void *ctx, char *buf, int len,
1214 void (*callback)(struct urb *))
1215 {
1216 struct urb *urb;
1217 struct usb_endpoint_descriptor const *ep_desc;
1218 char const *ep_type_name;
1219
1220 if (endpoint == -1)
1221 return NULL; /* endpoint not needed */
1222
1223 dev_dbg(&serial->interface->dev, "%s - alloc for endpoint %d.\n", __func__, endpoint);
1224 urb = usb_alloc_urb(0, GFP_KERNEL); /* No ISO */
1225 if (urb == NULL) {
1226 dev_dbg(&serial->interface->dev, "%s - alloc for endpoint %d failed.\n", __func__, endpoint);
1227 return NULL;
1228 }
1229
1230 if (endpoint == 0) {
1231 /* control EP filled in when used */
1232 return urb;
1233 }
1234
1235 ep_desc = find_ep(serial, endpoint);
1236 if (!ep_desc) {
1237 /* leak the urb, something's wrong and the callers don't care */
1238 return urb;
1239 }
1240 if (usb_endpoint_xfer_int(ep_desc)) {
1241 ep_type_name = "INT";
1242 usb_fill_int_urb(urb, serial->dev,
1243 usb_sndintpipe(serial->dev, endpoint) | dir,
1244 buf, len, callback, ctx,
1245 ep_desc->bInterval);
1246 } else if (usb_endpoint_xfer_bulk(ep_desc)) {
1247 ep_type_name = "BULK";
1248 usb_fill_bulk_urb(urb, serial->dev,
1249 usb_sndbulkpipe(serial->dev, endpoint) | dir,
1250 buf, len, callback, ctx);
1251 } else {
1252 dev_warn(&serial->interface->dev,
1253 "unsupported endpoint type %x\n",
1254 usb_endpoint_type(ep_desc));
1255 usb_free_urb(urb);
1256 return NULL;
1257 }
1258
1259 dev_dbg(&serial->interface->dev, "%s - using urb %p for %s endpoint %x\n",
1260 __func__, urb, ep_type_name, endpoint);
1261 return urb;
1262 }
1263
1264 static struct callbacks {
1265 void (*instat_callback)(struct urb *);
1266 void (*glocont_callback)(struct urb *);
1267 void (*indat_callback)(struct urb *);
1268 void (*outdat_callback)(struct urb *);
1269 void (*inack_callback)(struct urb *);
1270 void (*outcont_callback)(struct urb *);
1271 } keyspan_callbacks[] = {
1272 {
1273 /* msg_usa26 callbacks */
1274 .instat_callback = usa26_instat_callback,
1275 .glocont_callback = usa26_glocont_callback,
1276 .indat_callback = usa26_indat_callback,
1277 .outdat_callback = usa2x_outdat_callback,
1278 .inack_callback = usa26_inack_callback,
1279 .outcont_callback = usa26_outcont_callback,
1280 }, {
1281 /* msg_usa28 callbacks */
1282 .instat_callback = usa28_instat_callback,
1283 .glocont_callback = usa28_glocont_callback,
1284 .indat_callback = usa28_indat_callback,
1285 .outdat_callback = usa2x_outdat_callback,
1286 .inack_callback = usa28_inack_callback,
1287 .outcont_callback = usa28_outcont_callback,
1288 }, {
1289 /* msg_usa49 callbacks */
1290 .instat_callback = usa49_instat_callback,
1291 .glocont_callback = usa49_glocont_callback,
1292 .indat_callback = usa49_indat_callback,
1293 .outdat_callback = usa2x_outdat_callback,
1294 .inack_callback = usa49_inack_callback,
1295 .outcont_callback = usa49_outcont_callback,
1296 }, {
1297 /* msg_usa90 callbacks */
1298 .instat_callback = usa90_instat_callback,
1299 .glocont_callback = usa28_glocont_callback,
1300 .indat_callback = usa90_indat_callback,
1301 .outdat_callback = usa2x_outdat_callback,
1302 .inack_callback = usa28_inack_callback,
1303 .outcont_callback = usa90_outcont_callback,
1304 }, {
1305 /* msg_usa67 callbacks */
1306 .instat_callback = usa67_instat_callback,
1307 .glocont_callback = usa67_glocont_callback,
1308 .indat_callback = usa26_indat_callback,
1309 .outdat_callback = usa2x_outdat_callback,
1310 .inack_callback = usa26_inack_callback,
1311 .outcont_callback = usa26_outcont_callback,
1312 }
1313 };
1314
1315 /* Generic setup urbs function that uses
1316 data in device_details */
1317 static void keyspan_setup_urbs(struct usb_serial *serial)
1318 {
1319 struct keyspan_serial_private *s_priv;
1320 const struct keyspan_device_details *d_details;
1321 struct callbacks *cback;
1322
1323 s_priv = usb_get_serial_data(serial);
1324 d_details = s_priv->device_details;
1325
1326 /* Setup values for the various callback routines */
1327 cback = &keyspan_callbacks[d_details->msg_format];
1328
1329 /* Allocate and set up urbs for each one that is in use,
1330 starting with instat endpoints */
1331 s_priv->instat_urb = keyspan_setup_urb
1332 (serial, d_details->instat_endpoint, USB_DIR_IN,
1333 serial, s_priv->instat_buf, INSTAT_BUFLEN,
1334 cback->instat_callback);
1335
1336 s_priv->indat_urb = keyspan_setup_urb
1337 (serial, d_details->indat_endpoint, USB_DIR_IN,
1338 serial, s_priv->indat_buf, INDAT49W_BUFLEN,
1339 usa49wg_indat_callback);
1340
1341 s_priv->glocont_urb = keyspan_setup_urb
1342 (serial, d_details->glocont_endpoint, USB_DIR_OUT,
1343 serial, s_priv->glocont_buf, GLOCONT_BUFLEN,
1344 cback->glocont_callback);
1345 }
1346
1347 /* usa19 function doesn't require prescaler */
1348 static int keyspan_usa19_calc_baud(struct usb_serial_port *port,
1349 u32 baud_rate, u32 baudclk, u8 *rate_hi,
1350 u8 *rate_low, u8 *prescaler, int portnum)
1351 {
1352 u32 b16, /* baud rate times 16 (actual rate used internally) */
1353 div, /* divisor */
1354 cnt; /* inverse of divisor (programmed into 8051) */
1355
1356 dev_dbg(&port->dev, "%s - %d.\n", __func__, baud_rate);
1357
1358 /* prevent divide by zero... */
1359 b16 = baud_rate * 16L;
1360 if (b16 == 0)
1361 return KEYSPAN_INVALID_BAUD_RATE;
1362 /* Any "standard" rate over 57k6 is marginal on the USA-19
1363 as we run out of divisor resolution. */
1364 if (baud_rate > 57600)
1365 return KEYSPAN_INVALID_BAUD_RATE;
1366
1367 /* calculate the divisor and the counter (its inverse) */
1368 div = baudclk / b16;
1369 if (div == 0)
1370 return KEYSPAN_INVALID_BAUD_RATE;
1371 else
1372 cnt = 0 - div;
1373
1374 if (div > 0xffff)
1375 return KEYSPAN_INVALID_BAUD_RATE;
1376
1377 /* return the counter values if non-null */
1378 if (rate_low)
1379 *rate_low = (u8) (cnt & 0xff);
1380 if (rate_hi)
1381 *rate_hi = (u8) ((cnt >> 8) & 0xff);
1382 if (rate_low && rate_hi)
1383 dev_dbg(&port->dev, "%s - %d %02x %02x.\n",
1384 __func__, baud_rate, *rate_hi, *rate_low);
1385 return KEYSPAN_BAUD_RATE_OK;
1386 }
1387
1388 /* usa19hs function doesn't require prescaler */
1389 static int keyspan_usa19hs_calc_baud(struct usb_serial_port *port,
1390 u32 baud_rate, u32 baudclk, u8 *rate_hi,
1391 u8 *rate_low, u8 *prescaler, int portnum)
1392 {
1393 u32 b16, /* baud rate times 16 (actual rate used internally) */
1394 div; /* divisor */
1395
1396 dev_dbg(&port->dev, "%s - %d.\n", __func__, baud_rate);
1397
1398 /* prevent divide by zero... */
1399 b16 = baud_rate * 16L;
1400 if (b16 == 0)
1401 return KEYSPAN_INVALID_BAUD_RATE;
1402
1403 /* calculate the divisor */
1404 div = baudclk / b16;
1405 if (div == 0)
1406 return KEYSPAN_INVALID_BAUD_RATE;
1407
1408 if (div > 0xffff)
1409 return KEYSPAN_INVALID_BAUD_RATE;
1410
1411 /* return the counter values if non-null */
1412 if (rate_low)
1413 *rate_low = (u8) (div & 0xff);
1414
1415 if (rate_hi)
1416 *rate_hi = (u8) ((div >> 8) & 0xff);
1417
1418 if (rate_low && rate_hi)
1419 dev_dbg(&port->dev, "%s - %d %02x %02x.\n",
1420 __func__, baud_rate, *rate_hi, *rate_low);
1421
1422 return KEYSPAN_BAUD_RATE_OK;
1423 }
1424
1425 static int keyspan_usa19w_calc_baud(struct usb_serial_port *port,
1426 u32 baud_rate, u32 baudclk, u8 *rate_hi,
1427 u8 *rate_low, u8 *prescaler, int portnum)
1428 {
1429 u32 b16, /* baud rate times 16 (actual rate used internally) */
1430 clk, /* clock with 13/8 prescaler */
1431 div, /* divisor using 13/8 prescaler */
1432 res, /* resulting baud rate using 13/8 prescaler */
1433 diff, /* error using 13/8 prescaler */
1434 smallest_diff;
1435 u8 best_prescaler;
1436 int i;
1437
1438 dev_dbg(&port->dev, "%s - %d.\n", __func__, baud_rate);
1439
1440 /* prevent divide by zero */
1441 b16 = baud_rate * 16L;
1442 if (b16 == 0)
1443 return KEYSPAN_INVALID_BAUD_RATE;
1444
1445 /* Calculate prescaler by trying them all and looking
1446 for best fit */
1447
1448 /* start with largest possible difference */
1449 smallest_diff = 0xffffffff;
1450
1451 /* 0 is an invalid prescaler, used as a flag */
1452 best_prescaler = 0;
1453
1454 for (i = 8; i <= 0xff; ++i) {
1455 clk = (baudclk * 8) / (u32) i;
1456
1457 div = clk / b16;
1458 if (div == 0)
1459 continue;
1460
1461 res = clk / div;
1462 diff = (res > b16) ? (res-b16) : (b16-res);
1463
1464 if (diff < smallest_diff) {
1465 best_prescaler = i;
1466 smallest_diff = diff;
1467 }
1468 }
1469
1470 if (best_prescaler == 0)
1471 return KEYSPAN_INVALID_BAUD_RATE;
1472
1473 clk = (baudclk * 8) / (u32) best_prescaler;
1474 div = clk / b16;
1475
1476 /* return the divisor and prescaler if non-null */
1477 if (rate_low)
1478 *rate_low = (u8) (div & 0xff);
1479 if (rate_hi)
1480 *rate_hi = (u8) ((div >> 8) & 0xff);
1481 if (prescaler) {
1482 *prescaler = best_prescaler;
1483 /* dev_dbg(&port->dev, "%s - %d %d\n", __func__, *prescaler, div); */
1484 }
1485 return KEYSPAN_BAUD_RATE_OK;
1486 }
1487
1488 /* USA-28 supports different maximum baud rates on each port */
1489 static int keyspan_usa28_calc_baud(struct usb_serial_port *port,
1490 u32 baud_rate, u32 baudclk, u8 *rate_hi,
1491 u8 *rate_low, u8 *prescaler, int portnum)
1492 {
1493 u32 b16, /* baud rate times 16 (actual rate used internally) */
1494 div, /* divisor */
1495 cnt; /* inverse of divisor (programmed into 8051) */
1496
1497 dev_dbg(&port->dev, "%s - %d.\n", __func__, baud_rate);
1498
1499 /* prevent divide by zero */
1500 b16 = baud_rate * 16L;
1501 if (b16 == 0)
1502 return KEYSPAN_INVALID_BAUD_RATE;
1503
1504 /* calculate the divisor and the counter (its inverse) */
1505 div = KEYSPAN_USA28_BAUDCLK / b16;
1506 if (div == 0)
1507 return KEYSPAN_INVALID_BAUD_RATE;
1508 else
1509 cnt = 0 - div;
1510
1511 /* check for out of range, based on portnum,
1512 and return result */
1513 if (portnum == 0) {
1514 if (div > 0xffff)
1515 return KEYSPAN_INVALID_BAUD_RATE;
1516 } else {
1517 if (portnum == 1) {
1518 if (div > 0xff)
1519 return KEYSPAN_INVALID_BAUD_RATE;
1520 } else
1521 return KEYSPAN_INVALID_BAUD_RATE;
1522 }
1523
1524 /* return the counter values if not NULL
1525 (port 1 will ignore retHi) */
1526 if (rate_low)
1527 *rate_low = (u8) (cnt & 0xff);
1528 if (rate_hi)
1529 *rate_hi = (u8) ((cnt >> 8) & 0xff);
1530 dev_dbg(&port->dev, "%s - %d OK.\n", __func__, baud_rate);
1531 return KEYSPAN_BAUD_RATE_OK;
1532 }
1533
1534 static int keyspan_usa26_send_setup(struct usb_serial *serial,
1535 struct usb_serial_port *port,
1536 int reset_port)
1537 {
1538 struct keyspan_usa26_portControlMessage msg;
1539 struct keyspan_serial_private *s_priv;
1540 struct keyspan_port_private *p_priv;
1541 const struct keyspan_device_details *d_details;
1542 struct urb *this_urb;
1543 int device_port, err;
1544
1545 dev_dbg(&port->dev, "%s reset=%d\n", __func__, reset_port);
1546
1547 s_priv = usb_get_serial_data(serial);
1548 p_priv = usb_get_serial_port_data(port);
1549 d_details = s_priv->device_details;
1550 device_port = port->port_number;
1551
1552 this_urb = p_priv->outcont_urb;
1553
1554 dev_dbg(&port->dev, "%s - endpoint %d\n", __func__, usb_pipeendpoint(this_urb->pipe));
1555
1556 /* Make sure we have an urb then send the message */
1557 if (this_urb == NULL) {
1558 dev_dbg(&port->dev, "%s - oops no urb.\n", __func__);
1559 return -1;
1560 }
1561
1562 /* Save reset port val for resend.
1563 Don't overwrite resend for open/close condition. */
1564 if ((reset_port + 1) > p_priv->resend_cont)
1565 p_priv->resend_cont = reset_port + 1;
1566 if (this_urb->status == -EINPROGRESS) {
1567 /* dev_dbg(&port->dev, "%s - already writing\n", __func__); */
1568 mdelay(5);
1569 return -1;
1570 }
1571
1572 memset(&msg, 0, sizeof(struct keyspan_usa26_portControlMessage));
1573
1574 /* Only set baud rate if it's changed */
1575 if (p_priv->old_baud != p_priv->baud) {
1576 p_priv->old_baud = p_priv->baud;
1577 msg.setClocking = 0xff;
1578 if (d_details->calculate_baud_rate(port, p_priv->baud, d_details->baudclk,
1579 &msg.baudHi, &msg.baudLo, &msg.prescaler,
1580 device_port) == KEYSPAN_INVALID_BAUD_RATE) {
1581 dev_dbg(&port->dev, "%s - Invalid baud rate %d requested, using 9600.\n",
1582 __func__, p_priv->baud);
1583 msg.baudLo = 0;
1584 msg.baudHi = 125; /* Values for 9600 baud */
1585 msg.prescaler = 10;
1586 }
1587 msg.setPrescaler = 0xff;
1588 }
1589
1590 msg.lcr = (p_priv->cflag & CSTOPB) ? STOPBITS_678_2 : STOPBITS_5678_1;
1591 switch (p_priv->cflag & CSIZE) {
1592 case CS5:
1593 msg.lcr |= USA_DATABITS_5;
1594 break;
1595 case CS6:
1596 msg.lcr |= USA_DATABITS_6;
1597 break;
1598 case CS7:
1599 msg.lcr |= USA_DATABITS_7;
1600 break;
1601 case CS8:
1602 msg.lcr |= USA_DATABITS_8;
1603 break;
1604 }
1605 if (p_priv->cflag & PARENB) {
1606 /* note USA_PARITY_NONE == 0 */
1607 msg.lcr |= (p_priv->cflag & PARODD) ?
1608 USA_PARITY_ODD : USA_PARITY_EVEN;
1609 }
1610 msg.setLcr = 0xff;
1611
1612 msg.ctsFlowControl = (p_priv->flow_control == flow_cts);
1613 msg.xonFlowControl = 0;
1614 msg.setFlowControl = 0xff;
1615 msg.forwardingLength = 16;
1616 msg.xonChar = 17;
1617 msg.xoffChar = 19;
1618
1619 /* Opening port */
1620 if (reset_port == 1) {
1621 msg._txOn = 1;
1622 msg._txOff = 0;
1623 msg.txFlush = 0;
1624 msg.txBreak = 0;
1625 msg.rxOn = 1;
1626 msg.rxOff = 0;
1627 msg.rxFlush = 1;
1628 msg.rxForward = 0;
1629 msg.returnStatus = 0;
1630 msg.resetDataToggle = 0xff;
1631 }
1632
1633 /* Closing port */
1634 else if (reset_port == 2) {
1635 msg._txOn = 0;
1636 msg._txOff = 1;
1637 msg.txFlush = 0;
1638 msg.txBreak = 0;
1639 msg.rxOn = 0;
1640 msg.rxOff = 1;
1641 msg.rxFlush = 1;
1642 msg.rxForward = 0;
1643 msg.returnStatus = 0;
1644 msg.resetDataToggle = 0;
1645 }
1646
1647 /* Sending intermediate configs */
1648 else {
1649 msg._txOn = (!p_priv->break_on);
1650 msg._txOff = 0;
1651 msg.txFlush = 0;
1652 msg.txBreak = (p_priv->break_on);
1653 msg.rxOn = 0;
1654 msg.rxOff = 0;
1655 msg.rxFlush = 0;
1656 msg.rxForward = 0;
1657 msg.returnStatus = 0;
1658 msg.resetDataToggle = 0x0;
1659 }
1660
1661 /* Do handshaking outputs */
1662 msg.setTxTriState_setRts = 0xff;
1663 msg.txTriState_rts = p_priv->rts_state;
1664
1665 msg.setHskoa_setDtr = 0xff;
1666 msg.hskoa_dtr = p_priv->dtr_state;
1667
1668 p_priv->resend_cont = 0;
1669 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg));
1670
1671 /* send the data out the device on control endpoint */
1672 this_urb->transfer_buffer_length = sizeof(msg);
1673
1674 err = usb_submit_urb(this_urb, GFP_ATOMIC);
1675 if (err != 0)
1676 dev_dbg(&port->dev, "%s - usb_submit_urb(setup) failed (%d)\n", __func__, err);
1677 return 0;
1678 }
1679
1680 static int keyspan_usa28_send_setup(struct usb_serial *serial,
1681 struct usb_serial_port *port,
1682 int reset_port)
1683 {
1684 struct keyspan_usa28_portControlMessage msg;
1685 struct keyspan_serial_private *s_priv;
1686 struct keyspan_port_private *p_priv;
1687 const struct keyspan_device_details *d_details;
1688 struct urb *this_urb;
1689 int device_port, err;
1690
1691 s_priv = usb_get_serial_data(serial);
1692 p_priv = usb_get_serial_port_data(port);
1693 d_details = s_priv->device_details;
1694 device_port = port->port_number;
1695
1696 /* only do something if we have a bulk out endpoint */
1697 this_urb = p_priv->outcont_urb;
1698 if (this_urb == NULL) {
1699 dev_dbg(&port->dev, "%s - oops no urb.\n", __func__);
1700 return -1;
1701 }
1702
1703 /* Save reset port val for resend.
1704 Don't overwrite resend for open/close condition. */
1705 if ((reset_port + 1) > p_priv->resend_cont)
1706 p_priv->resend_cont = reset_port + 1;
1707 if (this_urb->status == -EINPROGRESS) {
1708 dev_dbg(&port->dev, "%s already writing\n", __func__);
1709 mdelay(5);
1710 return -1;
1711 }
1712
1713 memset(&msg, 0, sizeof(struct keyspan_usa28_portControlMessage));
1714
1715 msg.setBaudRate = 1;
1716 if (d_details->calculate_baud_rate(port, p_priv->baud, d_details->baudclk,
1717 &msg.baudHi, &msg.baudLo, NULL,
1718 device_port) == KEYSPAN_INVALID_BAUD_RATE) {
1719 dev_dbg(&port->dev, "%s - Invalid baud rate requested %d.\n",
1720 __func__, p_priv->baud);
1721 msg.baudLo = 0xff;
1722 msg.baudHi = 0xb2; /* Values for 9600 baud */
1723 }
1724
1725 /* If parity is enabled, we must calculate it ourselves. */
1726 msg.parity = 0; /* XXX for now */
1727
1728 msg.ctsFlowControl = (p_priv->flow_control == flow_cts);
1729 msg.xonFlowControl = 0;
1730
1731 /* Do handshaking outputs, DTR is inverted relative to RTS */
1732 msg.rts = p_priv->rts_state;
1733 msg.dtr = p_priv->dtr_state;
1734
1735 msg.forwardingLength = 16;
1736 msg.forwardMs = 10;
1737 msg.breakThreshold = 45;
1738 msg.xonChar = 17;
1739 msg.xoffChar = 19;
1740
1741 /*msg.returnStatus = 1;
1742 msg.resetDataToggle = 0xff;*/
1743 /* Opening port */
1744 if (reset_port == 1) {
1745 msg._txOn = 1;
1746 msg._txOff = 0;
1747 msg.txFlush = 0;
1748 msg.txForceXoff = 0;
1749 msg.txBreak = 0;
1750 msg.rxOn = 1;
1751 msg.rxOff = 0;
1752 msg.rxFlush = 1;
1753 msg.rxForward = 0;
1754 msg.returnStatus = 0;
1755 msg.resetDataToggle = 0xff;
1756 }
1757 /* Closing port */
1758 else if (reset_port == 2) {
1759 msg._txOn = 0;
1760 msg._txOff = 1;
1761 msg.txFlush = 0;
1762 msg.txForceXoff = 0;
1763 msg.txBreak = 0;
1764 msg.rxOn = 0;
1765 msg.rxOff = 1;
1766 msg.rxFlush = 1;
1767 msg.rxForward = 0;
1768 msg.returnStatus = 0;
1769 msg.resetDataToggle = 0;
1770 }
1771 /* Sending intermediate configs */
1772 else {
1773 msg._txOn = (!p_priv->break_on);
1774 msg._txOff = 0;
1775 msg.txFlush = 0;
1776 msg.txForceXoff = 0;
1777 msg.txBreak = (p_priv->break_on);
1778 msg.rxOn = 0;
1779 msg.rxOff = 0;
1780 msg.rxFlush = 0;
1781 msg.rxForward = 0;
1782 msg.returnStatus = 0;
1783 msg.resetDataToggle = 0x0;
1784 }
1785
1786 p_priv->resend_cont = 0;
1787 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg));
1788
1789 /* send the data out the device on control endpoint */
1790 this_urb->transfer_buffer_length = sizeof(msg);
1791
1792 err = usb_submit_urb(this_urb, GFP_ATOMIC);
1793 if (err != 0)
1794 dev_dbg(&port->dev, "%s - usb_submit_urb(setup) failed\n", __func__);
1795 #if 0
1796 else {
1797 dev_dbg(&port->dev, "%s - usb_submit_urb(setup) OK %d bytes\n", __func__,
1798 this_urb->transfer_buffer_length);
1799 }
1800 #endif
1801
1802 return 0;
1803 }
1804
1805 static int keyspan_usa49_send_setup(struct usb_serial *serial,
1806 struct usb_serial_port *port,
1807 int reset_port)
1808 {
1809 struct keyspan_usa49_portControlMessage msg;
1810 struct usb_ctrlrequest *dr = NULL;
1811 struct keyspan_serial_private *s_priv;
1812 struct keyspan_port_private *p_priv;
1813 const struct keyspan_device_details *d_details;
1814 struct urb *this_urb;
1815 int err, device_port;
1816
1817 s_priv = usb_get_serial_data(serial);
1818 p_priv = usb_get_serial_port_data(port);
1819 d_details = s_priv->device_details;
1820
1821 this_urb = s_priv->glocont_urb;
1822
1823 /* Work out which port within the device is being setup */
1824 device_port = port->port_number;
1825
1826 /* Make sure we have an urb then send the message */
1827 if (this_urb == NULL) {
1828 dev_dbg(&port->dev, "%s - oops no urb for port.\n", __func__);
1829 return -1;
1830 }
1831
1832 dev_dbg(&port->dev, "%s - endpoint %d (%d)\n",
1833 __func__, usb_pipeendpoint(this_urb->pipe), device_port);
1834
1835 /* Save reset port val for resend.
1836 Don't overwrite resend for open/close condition. */
1837 if ((reset_port + 1) > p_priv->resend_cont)
1838 p_priv->resend_cont = reset_port + 1;
1839
1840 if (this_urb->status == -EINPROGRESS) {
1841 /* dev_dbg(&port->dev, "%s - already writing\n", __func__); */
1842 mdelay(5);
1843 return -1;
1844 }
1845
1846 memset(&msg, 0, sizeof(struct keyspan_usa49_portControlMessage));
1847
1848 msg.portNumber = device_port;
1849
1850 /* Only set baud rate if it's changed */
1851 if (p_priv->old_baud != p_priv->baud) {
1852 p_priv->old_baud = p_priv->baud;
1853 msg.setClocking = 0xff;
1854 if (d_details->calculate_baud_rate(port, p_priv->baud, d_details->baudclk,
1855 &msg.baudHi, &msg.baudLo, &msg.prescaler,
1856 device_port) == KEYSPAN_INVALID_BAUD_RATE) {
1857 dev_dbg(&port->dev, "%s - Invalid baud rate %d requested, using 9600.\n",
1858 __func__, p_priv->baud);
1859 msg.baudLo = 0;
1860 msg.baudHi = 125; /* Values for 9600 baud */
1861 msg.prescaler = 10;
1862 }
1863 /* msg.setPrescaler = 0xff; */
1864 }
1865
1866 msg.lcr = (p_priv->cflag & CSTOPB) ? STOPBITS_678_2 : STOPBITS_5678_1;
1867 switch (p_priv->cflag & CSIZE) {
1868 case CS5:
1869 msg.lcr |= USA_DATABITS_5;
1870 break;
1871 case CS6:
1872 msg.lcr |= USA_DATABITS_6;
1873 break;
1874 case CS7:
1875 msg.lcr |= USA_DATABITS_7;
1876 break;
1877 case CS8:
1878 msg.lcr |= USA_DATABITS_8;
1879 break;
1880 }
1881 if (p_priv->cflag & PARENB) {
1882 /* note USA_PARITY_NONE == 0 */
1883 msg.lcr |= (p_priv->cflag & PARODD) ?
1884 USA_PARITY_ODD : USA_PARITY_EVEN;
1885 }
1886 msg.setLcr = 0xff;
1887
1888 msg.ctsFlowControl = (p_priv->flow_control == flow_cts);
1889 msg.xonFlowControl = 0;
1890 msg.setFlowControl = 0xff;
1891
1892 msg.forwardingLength = 16;
1893 msg.xonChar = 17;
1894 msg.xoffChar = 19;
1895
1896 /* Opening port */
1897 if (reset_port == 1) {
1898 msg._txOn = 1;
1899 msg._txOff = 0;
1900 msg.txFlush = 0;
1901 msg.txBreak = 0;
1902 msg.rxOn = 1;
1903 msg.rxOff = 0;
1904 msg.rxFlush = 1;
1905 msg.rxForward = 0;
1906 msg.returnStatus = 0;
1907 msg.resetDataToggle = 0xff;
1908 msg.enablePort = 1;
1909 msg.disablePort = 0;
1910 }
1911 /* Closing port */
1912 else if (reset_port == 2) {
1913 msg._txOn = 0;
1914 msg._txOff = 1;
1915 msg.txFlush = 0;
1916 msg.txBreak = 0;
1917 msg.rxOn = 0;
1918 msg.rxOff = 1;
1919 msg.rxFlush = 1;
1920 msg.rxForward = 0;
1921 msg.returnStatus = 0;
1922 msg.resetDataToggle = 0;
1923 msg.enablePort = 0;
1924 msg.disablePort = 1;
1925 }
1926 /* Sending intermediate configs */
1927 else {
1928 msg._txOn = (!p_priv->break_on);
1929 msg._txOff = 0;
1930 msg.txFlush = 0;
1931 msg.txBreak = (p_priv->break_on);
1932 msg.rxOn = 0;
1933 msg.rxOff = 0;
1934 msg.rxFlush = 0;
1935 msg.rxForward = 0;
1936 msg.returnStatus = 0;
1937 msg.resetDataToggle = 0x0;
1938 msg.enablePort = 0;
1939 msg.disablePort = 0;
1940 }
1941
1942 /* Do handshaking outputs */
1943 msg.setRts = 0xff;
1944 msg.rts = p_priv->rts_state;
1945
1946 msg.setDtr = 0xff;
1947 msg.dtr = p_priv->dtr_state;
1948
1949 p_priv->resend_cont = 0;
1950
1951 /* if the device is a 49wg, we send control message on usb
1952 control EP 0 */
1953
1954 if (d_details->product_id == keyspan_usa49wg_product_id) {
1955 dr = (void *)(s_priv->ctrl_buf);
1956 dr->bRequestType = USB_TYPE_VENDOR | USB_DIR_OUT;
1957 dr->bRequest = 0xB0; /* 49wg control message */;
1958 dr->wValue = 0;
1959 dr->wIndex = 0;
1960 dr->wLength = cpu_to_le16(sizeof(msg));
1961
1962 memcpy(s_priv->glocont_buf, &msg, sizeof(msg));
1963
1964 usb_fill_control_urb(this_urb, serial->dev,
1965 usb_sndctrlpipe(serial->dev, 0),
1966 (unsigned char *)dr, s_priv->glocont_buf,
1967 sizeof(msg), usa49_glocont_callback, serial);
1968
1969 } else {
1970 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg));
1971
1972 /* send the data out the device on control endpoint */
1973 this_urb->transfer_buffer_length = sizeof(msg);
1974 }
1975 err = usb_submit_urb(this_urb, GFP_ATOMIC);
1976 if (err != 0)
1977 dev_dbg(&port->dev, "%s - usb_submit_urb(setup) failed (%d)\n", __func__, err);
1978 #if 0
1979 else {
1980 dev_dbg(&port->dev, "%s - usb_submit_urb(%d) OK %d bytes (end %d)\n", __func__,
1981 outcont_urb, this_urb->transfer_buffer_length,
1982 usb_pipeendpoint(this_urb->pipe));
1983 }
1984 #endif
1985
1986 return 0;
1987 }
1988
1989 static int keyspan_usa90_send_setup(struct usb_serial *serial,
1990 struct usb_serial_port *port,
1991 int reset_port)
1992 {
1993 struct keyspan_usa90_portControlMessage msg;
1994 struct keyspan_serial_private *s_priv;
1995 struct keyspan_port_private *p_priv;
1996 const struct keyspan_device_details *d_details;
1997 struct urb *this_urb;
1998 int err;
1999 u8 prescaler;
2000
2001 s_priv = usb_get_serial_data(serial);
2002 p_priv = usb_get_serial_port_data(port);
2003 d_details = s_priv->device_details;
2004
2005 /* only do something if we have a bulk out endpoint */
2006 this_urb = p_priv->outcont_urb;
2007 if (this_urb == NULL) {
2008 dev_dbg(&port->dev, "%s - oops no urb.\n", __func__);
2009 return -1;
2010 }
2011
2012 /* Save reset port val for resend.
2013 Don't overwrite resend for open/close condition. */
2014 if ((reset_port + 1) > p_priv->resend_cont)
2015 p_priv->resend_cont = reset_port + 1;
2016 if (this_urb->status == -EINPROGRESS) {
2017 dev_dbg(&port->dev, "%s already writing\n", __func__);
2018 mdelay(5);
2019 return -1;
2020 }
2021
2022 memset(&msg, 0, sizeof(struct keyspan_usa90_portControlMessage));
2023
2024 /* Only set baud rate if it's changed */
2025 if (p_priv->old_baud != p_priv->baud) {
2026 p_priv->old_baud = p_priv->baud;
2027 msg.setClocking = 0x01;
2028 if (d_details->calculate_baud_rate(port, p_priv->baud, d_details->baudclk,
2029 &msg.baudHi, &msg.baudLo, &prescaler, 0) == KEYSPAN_INVALID_BAUD_RATE) {
2030 dev_dbg(&port->dev, "%s - Invalid baud rate %d requested, using 9600.\n",
2031 __func__, p_priv->baud);
2032 p_priv->baud = 9600;
2033 d_details->calculate_baud_rate(port, p_priv->baud, d_details->baudclk,
2034 &msg.baudHi, &msg.baudLo, &prescaler, 0);
2035 }
2036 msg.setRxMode = 1;
2037 msg.setTxMode = 1;
2038 }
2039
2040 /* modes must always be correctly specified */
2041 if (p_priv->baud > 57600) {
2042 msg.rxMode = RXMODE_DMA;
2043 msg.txMode = TXMODE_DMA;
2044 } else {
2045 msg.rxMode = RXMODE_BYHAND;
2046 msg.txMode = TXMODE_BYHAND;
2047 }
2048
2049 msg.lcr = (p_priv->cflag & CSTOPB) ? STOPBITS_678_2 : STOPBITS_5678_1;
2050 switch (p_priv->cflag & CSIZE) {
2051 case CS5:
2052 msg.lcr |= USA_DATABITS_5;
2053 break;
2054 case CS6:
2055 msg.lcr |= USA_DATABITS_6;
2056 break;
2057 case CS7:
2058 msg.lcr |= USA_DATABITS_7;
2059 break;
2060 case CS8:
2061 msg.lcr |= USA_DATABITS_8;
2062 break;
2063 }
2064 if (p_priv->cflag & PARENB) {
2065 /* note USA_PARITY_NONE == 0 */
2066 msg.lcr |= (p_priv->cflag & PARODD) ?
2067 USA_PARITY_ODD : USA_PARITY_EVEN;
2068 }
2069 if (p_priv->old_cflag != p_priv->cflag) {
2070 p_priv->old_cflag = p_priv->cflag;
2071 msg.setLcr = 0x01;
2072 }
2073
2074 if (p_priv->flow_control == flow_cts)
2075 msg.txFlowControl = TXFLOW_CTS;
2076 msg.setTxFlowControl = 0x01;
2077 msg.setRxFlowControl = 0x01;
2078
2079 msg.rxForwardingLength = 16;
2080 msg.rxForwardingTimeout = 16;
2081 msg.txAckSetting = 0;
2082 msg.xonChar = 17;
2083 msg.xoffChar = 19;
2084
2085 /* Opening port */
2086 if (reset_port == 1) {
2087 msg.portEnabled = 1;
2088 msg.rxFlush = 1;
2089 msg.txBreak = (p_priv->break_on);
2090 }
2091 /* Closing port */
2092 else if (reset_port == 2)
2093 msg.portEnabled = 0;
2094 /* Sending intermediate configs */
2095 else {
2096 msg.portEnabled = 1;
2097 msg.txBreak = (p_priv->break_on);
2098 }
2099
2100 /* Do handshaking outputs */
2101 msg.setRts = 0x01;
2102 msg.rts = p_priv->rts_state;
2103
2104 msg.setDtr = 0x01;
2105 msg.dtr = p_priv->dtr_state;
2106
2107 p_priv->resend_cont = 0;
2108 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg));
2109
2110 /* send the data out the device on control endpoint */
2111 this_urb->transfer_buffer_length = sizeof(msg);
2112
2113 err = usb_submit_urb(this_urb, GFP_ATOMIC);
2114 if (err != 0)
2115 dev_dbg(&port->dev, "%s - usb_submit_urb(setup) failed (%d)\n", __func__, err);
2116 return 0;
2117 }
2118
2119 static int keyspan_usa67_send_setup(struct usb_serial *serial,
2120 struct usb_serial_port *port,
2121 int reset_port)
2122 {
2123 struct keyspan_usa67_portControlMessage msg;
2124 struct keyspan_serial_private *s_priv;
2125 struct keyspan_port_private *p_priv;
2126 const struct keyspan_device_details *d_details;
2127 struct urb *this_urb;
2128 int err, device_port;
2129
2130 s_priv = usb_get_serial_data(serial);
2131 p_priv = usb_get_serial_port_data(port);
2132 d_details = s_priv->device_details;
2133
2134 this_urb = s_priv->glocont_urb;
2135
2136 /* Work out which port within the device is being setup */
2137 device_port = port->port_number;
2138
2139 /* Make sure we have an urb then send the message */
2140 if (this_urb == NULL) {
2141 dev_dbg(&port->dev, "%s - oops no urb for port.\n", __func__);
2142 return -1;
2143 }
2144
2145 /* Save reset port val for resend.
2146 Don't overwrite resend for open/close condition. */
2147 if ((reset_port + 1) > p_priv->resend_cont)
2148 p_priv->resend_cont = reset_port + 1;
2149 if (this_urb->status == -EINPROGRESS) {
2150 /* dev_dbg(&port->dev, "%s - already writing\n", __func__); */
2151 mdelay(5);
2152 return -1;
2153 }
2154
2155 memset(&msg, 0, sizeof(struct keyspan_usa67_portControlMessage));
2156
2157 msg.port = device_port;
2158
2159 /* Only set baud rate if it's changed */
2160 if (p_priv->old_baud != p_priv->baud) {
2161 p_priv->old_baud = p_priv->baud;
2162 msg.setClocking = 0xff;
2163 if (d_details->calculate_baud_rate(port, p_priv->baud, d_details->baudclk,
2164 &msg.baudHi, &msg.baudLo, &msg.prescaler,
2165 device_port) == KEYSPAN_INVALID_BAUD_RATE) {
2166 dev_dbg(&port->dev, "%s - Invalid baud rate %d requested, using 9600.\n",
2167 __func__, p_priv->baud);
2168 msg.baudLo = 0;
2169 msg.baudHi = 125; /* Values for 9600 baud */
2170 msg.prescaler = 10;
2171 }
2172 msg.setPrescaler = 0xff;
2173 }
2174
2175 msg.lcr = (p_priv->cflag & CSTOPB) ? STOPBITS_678_2 : STOPBITS_5678_1;
2176 switch (p_priv->cflag & CSIZE) {
2177 case CS5:
2178 msg.lcr |= USA_DATABITS_5;
2179 break;
2180 case CS6:
2181 msg.lcr |= USA_DATABITS_6;
2182 break;
2183 case CS7:
2184 msg.lcr |= USA_DATABITS_7;
2185 break;
2186 case CS8:
2187 msg.lcr |= USA_DATABITS_8;
2188 break;
2189 }
2190 if (p_priv->cflag & PARENB) {
2191 /* note USA_PARITY_NONE == 0 */
2192 msg.lcr |= (p_priv->cflag & PARODD) ?
2193 USA_PARITY_ODD : USA_PARITY_EVEN;
2194 }
2195 msg.setLcr = 0xff;
2196
2197 msg.ctsFlowControl = (p_priv->flow_control == flow_cts);
2198 msg.xonFlowControl = 0;
2199 msg.setFlowControl = 0xff;
2200 msg.forwardingLength = 16;
2201 msg.xonChar = 17;
2202 msg.xoffChar = 19;
2203
2204 if (reset_port == 1) {
2205 /* Opening port */
2206 msg._txOn = 1;
2207 msg._txOff = 0;
2208 msg.txFlush = 0;
2209 msg.txBreak = 0;
2210 msg.rxOn = 1;
2211 msg.rxOff = 0;
2212 msg.rxFlush = 1;
2213 msg.rxForward = 0;
2214 msg.returnStatus = 0;
2215 msg.resetDataToggle = 0xff;
2216 } else if (reset_port == 2) {
2217 /* Closing port */
2218 msg._txOn = 0;
2219 msg._txOff = 1;
2220 msg.txFlush = 0;
2221 msg.txBreak = 0;
2222 msg.rxOn = 0;
2223 msg.rxOff = 1;
2224 msg.rxFlush = 1;
2225 msg.rxForward = 0;
2226 msg.returnStatus = 0;
2227 msg.resetDataToggle = 0;
2228 } else {
2229 /* Sending intermediate configs */
2230 msg._txOn = (!p_priv->break_on);
2231 msg._txOff = 0;
2232 msg.txFlush = 0;
2233 msg.txBreak = (p_priv->break_on);
2234 msg.rxOn = 0;
2235 msg.rxOff = 0;
2236 msg.rxFlush = 0;
2237 msg.rxForward = 0;
2238 msg.returnStatus = 0;
2239 msg.resetDataToggle = 0x0;
2240 }
2241
2242 /* Do handshaking outputs */
2243 msg.setTxTriState_setRts = 0xff;
2244 msg.txTriState_rts = p_priv->rts_state;
2245
2246 msg.setHskoa_setDtr = 0xff;
2247 msg.hskoa_dtr = p_priv->dtr_state;
2248
2249 p_priv->resend_cont = 0;
2250
2251 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg));
2252
2253 /* send the data out the device on control endpoint */
2254 this_urb->transfer_buffer_length = sizeof(msg);
2255
2256 err = usb_submit_urb(this_urb, GFP_ATOMIC);
2257 if (err != 0)
2258 dev_dbg(&port->dev, "%s - usb_submit_urb(setup) failed (%d)\n", __func__, err);
2259 return 0;
2260 }
2261
2262 static void keyspan_send_setup(struct usb_serial_port *port, int reset_port)
2263 {
2264 struct usb_serial *serial = port->serial;
2265 struct keyspan_serial_private *s_priv;
2266 const struct keyspan_device_details *d_details;
2267
2268 s_priv = usb_get_serial_data(serial);
2269 d_details = s_priv->device_details;
2270
2271 switch (d_details->msg_format) {
2272 case msg_usa26:
2273 keyspan_usa26_send_setup(serial, port, reset_port);
2274 break;
2275 case msg_usa28:
2276 keyspan_usa28_send_setup(serial, port, reset_port);
2277 break;
2278 case msg_usa49:
2279 keyspan_usa49_send_setup(serial, port, reset_port);
2280 break;
2281 case msg_usa90:
2282 keyspan_usa90_send_setup(serial, port, reset_port);
2283 break;
2284 case msg_usa67:
2285 keyspan_usa67_send_setup(serial, port, reset_port);
2286 break;
2287 }
2288 }
2289
2290
2291 /* Gets called by the "real" driver (ie once firmware is loaded
2292 and renumeration has taken place. */
2293 static int keyspan_startup(struct usb_serial *serial)
2294 {
2295 int i, err;
2296 struct keyspan_serial_private *s_priv;
2297 const struct keyspan_device_details *d_details;
2298
2299 for (i = 0; (d_details = keyspan_devices[i]) != NULL; ++i)
2300 if (d_details->product_id ==
2301 le16_to_cpu(serial->dev->descriptor.idProduct))
2302 break;
2303 if (d_details == NULL) {
2304 dev_err(&serial->dev->dev, "%s - unknown product id %x\n",
2305 __func__, le16_to_cpu(serial->dev->descriptor.idProduct));
2306 return 1;
2307 }
2308
2309 /* Setup private data for serial driver */
2310 s_priv = kzalloc(sizeof(struct keyspan_serial_private), GFP_KERNEL);
2311 if (!s_priv) {
2312 dev_dbg(&serial->dev->dev, "%s - kmalloc for keyspan_serial_private failed.\n", __func__);
2313 return -ENOMEM;
2314 }
2315
2316 s_priv->device_details = d_details;
2317 usb_set_serial_data(serial, s_priv);
2318
2319 keyspan_setup_urbs(serial);
2320
2321 if (s_priv->instat_urb != NULL) {
2322 err = usb_submit_urb(s_priv->instat_urb, GFP_KERNEL);
2323 if (err != 0)
2324 dev_dbg(&serial->dev->dev, "%s - submit instat urb failed %d\n", __func__, err);
2325 }
2326 if (s_priv->indat_urb != NULL) {
2327 err = usb_submit_urb(s_priv->indat_urb, GFP_KERNEL);
2328 if (err != 0)
2329 dev_dbg(&serial->dev->dev, "%s - submit indat urb failed %d\n", __func__, err);
2330 }
2331
2332 return 0;
2333 }
2334
2335 static void keyspan_disconnect(struct usb_serial *serial)
2336 {
2337 struct keyspan_serial_private *s_priv;
2338
2339 s_priv = usb_get_serial_data(serial);
2340
2341 stop_urb(s_priv->instat_urb);
2342 stop_urb(s_priv->glocont_urb);
2343 stop_urb(s_priv->indat_urb);
2344 }
2345
2346 static void keyspan_release(struct usb_serial *serial)
2347 {
2348 struct keyspan_serial_private *s_priv;
2349
2350 s_priv = usb_get_serial_data(serial);
2351
2352 usb_free_urb(s_priv->instat_urb);
2353 usb_free_urb(s_priv->indat_urb);
2354 usb_free_urb(s_priv->glocont_urb);
2355
2356 kfree(s_priv);
2357 }
2358
2359 static int keyspan_port_probe(struct usb_serial_port *port)
2360 {
2361 struct usb_serial *serial = port->serial;
2362 struct keyspan_serial_private *s_priv;
2363 struct keyspan_port_private *p_priv;
2364 const struct keyspan_device_details *d_details;
2365 struct callbacks *cback;
2366 int endp;
2367 int port_num;
2368 int i;
2369
2370 s_priv = usb_get_serial_data(serial);
2371 d_details = s_priv->device_details;
2372
2373 p_priv = kzalloc(sizeof(*p_priv), GFP_KERNEL);
2374 if (!p_priv)
2375 return -ENOMEM;
2376
2377 p_priv->device_details = d_details;
2378
2379 /* Setup values for the various callback routines */
2380 cback = &keyspan_callbacks[d_details->msg_format];
2381
2382 port_num = port->port_number;
2383
2384 /* Do indat endpoints first, once for each flip */
2385 endp = d_details->indat_endpoints[port_num];
2386 for (i = 0; i <= d_details->indat_endp_flip; ++i, ++endp) {
2387 p_priv->in_urbs[i] = keyspan_setup_urb(serial, endp,
2388 USB_DIR_IN, port,
2389 p_priv->in_buffer[i], 64,
2390 cback->indat_callback);
2391 }
2392 /* outdat endpoints also have flip */
2393 endp = d_details->outdat_endpoints[port_num];
2394 for (i = 0; i <= d_details->outdat_endp_flip; ++i, ++endp) {
2395 p_priv->out_urbs[i] = keyspan_setup_urb(serial, endp,
2396 USB_DIR_OUT, port,
2397 p_priv->out_buffer[i], 64,
2398 cback->outdat_callback);
2399 }
2400 /* inack endpoint */
2401 p_priv->inack_urb = keyspan_setup_urb(serial,
2402 d_details->inack_endpoints[port_num],
2403 USB_DIR_IN, port,
2404 p_priv->inack_buffer, 1,
2405 cback->inack_callback);
2406 /* outcont endpoint */
2407 p_priv->outcont_urb = keyspan_setup_urb(serial,
2408 d_details->outcont_endpoints[port_num],
2409 USB_DIR_OUT, port,
2410 p_priv->outcont_buffer, 64,
2411 cback->outcont_callback);
2412
2413 usb_set_serial_port_data(port, p_priv);
2414
2415 return 0;
2416 }
2417
2418 static int keyspan_port_remove(struct usb_serial_port *port)
2419 {
2420 struct keyspan_port_private *p_priv;
2421 int i;
2422
2423 p_priv = usb_get_serial_port_data(port);
2424
2425 stop_urb(p_priv->inack_urb);
2426 stop_urb(p_priv->outcont_urb);
2427 for (i = 0; i < 2; i++) {
2428 stop_urb(p_priv->in_urbs[i]);
2429 stop_urb(p_priv->out_urbs[i]);
2430 }
2431
2432 usb_free_urb(p_priv->inack_urb);
2433 usb_free_urb(p_priv->outcont_urb);
2434 for (i = 0; i < 2; i++) {
2435 usb_free_urb(p_priv->in_urbs[i]);
2436 usb_free_urb(p_priv->out_urbs[i]);
2437 }
2438
2439 kfree(p_priv);
2440
2441 return 0;
2442 }
2443
2444 MODULE_AUTHOR(DRIVER_AUTHOR);
2445 MODULE_DESCRIPTION(DRIVER_DESC);
2446 MODULE_LICENSE("GPL");
2447
2448 MODULE_FIRMWARE("keyspan/usa28.fw");
2449 MODULE_FIRMWARE("keyspan/usa28x.fw");
2450 MODULE_FIRMWARE("keyspan/usa28xa.fw");
2451 MODULE_FIRMWARE("keyspan/usa28xb.fw");
2452 MODULE_FIRMWARE("keyspan/usa19.fw");
2453 MODULE_FIRMWARE("keyspan/usa19qi.fw");
2454 MODULE_FIRMWARE("keyspan/mpr.fw");
2455 MODULE_FIRMWARE("keyspan/usa19qw.fw");
2456 MODULE_FIRMWARE("keyspan/usa18x.fw");
2457 MODULE_FIRMWARE("keyspan/usa19w.fw");
2458 MODULE_FIRMWARE("keyspan/usa49w.fw");
2459 MODULE_FIRMWARE("keyspan/usa49wlc.fw");
Linus' kernel tree