Linux Audio

Check our new training course

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