xref: /openbmc/linux/drivers/usb/serial/whiteheat.c (revision 28dce2c4)
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * USB ConnectTech WhiteHEAT driver
4  *
5  *	Copyright (C) 2002
6  *	    Connect Tech Inc.
7  *
8  *	Copyright (C) 1999 - 2001
9  *	    Greg Kroah-Hartman (greg@kroah.com)
10  *
11  * See Documentation/usb/usb-serial.rst for more information on using this
12  * driver
13  */
14 
15 #include <linux/kernel.h>
16 #include <linux/errno.h>
17 #include <linux/slab.h>
18 #include <linux/tty.h>
19 #include <linux/tty_driver.h>
20 #include <linux/tty_flip.h>
21 #include <linux/module.h>
22 #include <linux/spinlock.h>
23 #include <linux/mutex.h>
24 #include <linux/uaccess.h>
25 #include <asm/termbits.h>
26 #include <linux/usb.h>
27 #include <linux/serial_reg.h>
28 #include <linux/serial.h>
29 #include <linux/usb/serial.h>
30 #include <linux/usb/ezusb.h>
31 #include "whiteheat.h"			/* WhiteHEAT specific commands */
32 
33 #ifndef CMSPAR
34 #define CMSPAR 0
35 #endif
36 
37 /*
38  * Version Information
39  */
40 #define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Stuart MacDonald <stuartm@connecttech.com>"
41 #define DRIVER_DESC "USB ConnectTech WhiteHEAT driver"
42 
43 #define CONNECT_TECH_VENDOR_ID		0x0710
44 #define CONNECT_TECH_FAKE_WHITE_HEAT_ID	0x0001
45 #define CONNECT_TECH_WHITE_HEAT_ID	0x8001
46 
47 /*
48    ID tables for whiteheat are unusual, because we want to different
49    things for different versions of the device.  Eventually, this
50    will be doable from a single table.  But, for now, we define two
51    separate ID tables, and then a third table that combines them
52    just for the purpose of exporting the autoloading information.
53 */
54 static const struct usb_device_id id_table_std[] = {
55 	{ USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_WHITE_HEAT_ID) },
56 	{ }						/* Terminating entry */
57 };
58 
59 static const struct usb_device_id id_table_prerenumeration[] = {
60 	{ USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_FAKE_WHITE_HEAT_ID) },
61 	{ }						/* Terminating entry */
62 };
63 
64 static const struct usb_device_id id_table_combined[] = {
65 	{ USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_WHITE_HEAT_ID) },
66 	{ USB_DEVICE(CONNECT_TECH_VENDOR_ID, CONNECT_TECH_FAKE_WHITE_HEAT_ID) },
67 	{ }						/* Terminating entry */
68 };
69 
70 MODULE_DEVICE_TABLE(usb, id_table_combined);
71 
72 
73 /* function prototypes for the Connect Tech WhiteHEAT prerenumeration device */
74 static int  whiteheat_firmware_download(struct usb_serial *serial,
75 					const struct usb_device_id *id);
76 static int  whiteheat_firmware_attach(struct usb_serial *serial);
77 
78 /* function prototypes for the Connect Tech WhiteHEAT serial converter */
79 static int  whiteheat_attach(struct usb_serial *serial);
80 static void whiteheat_release(struct usb_serial *serial);
81 static int  whiteheat_port_probe(struct usb_serial_port *port);
82 static void whiteheat_port_remove(struct usb_serial_port *port);
83 static int  whiteheat_open(struct tty_struct *tty,
84 			struct usb_serial_port *port);
85 static void whiteheat_close(struct usb_serial_port *port);
86 static void whiteheat_get_serial(struct tty_struct *tty,
87 			struct serial_struct *ss);
88 static void whiteheat_set_termios(struct tty_struct *tty,
89 			struct usb_serial_port *port, struct ktermios *old);
90 static int  whiteheat_tiocmget(struct tty_struct *tty);
91 static int  whiteheat_tiocmset(struct tty_struct *tty,
92 			unsigned int set, unsigned int clear);
93 static void whiteheat_break_ctl(struct tty_struct *tty, int break_state);
94 
95 static struct usb_serial_driver whiteheat_fake_device = {
96 	.driver = {
97 		.owner =	THIS_MODULE,
98 		.name =		"whiteheatnofirm",
99 	},
100 	.description =		"Connect Tech - WhiteHEAT - (prerenumeration)",
101 	.id_table =		id_table_prerenumeration,
102 	.num_ports =		1,
103 	.probe =		whiteheat_firmware_download,
104 	.attach =		whiteheat_firmware_attach,
105 };
106 
107 static struct usb_serial_driver whiteheat_device = {
108 	.driver = {
109 		.owner =	THIS_MODULE,
110 		.name =		"whiteheat",
111 	},
112 	.description =		"Connect Tech - WhiteHEAT",
113 	.id_table =		id_table_std,
114 	.num_ports =		4,
115 	.num_bulk_in =		5,
116 	.num_bulk_out =		5,
117 	.attach =		whiteheat_attach,
118 	.release =		whiteheat_release,
119 	.port_probe =		whiteheat_port_probe,
120 	.port_remove =		whiteheat_port_remove,
121 	.open =			whiteheat_open,
122 	.close =		whiteheat_close,
123 	.get_serial =		whiteheat_get_serial,
124 	.set_termios =		whiteheat_set_termios,
125 	.break_ctl =		whiteheat_break_ctl,
126 	.tiocmget =		whiteheat_tiocmget,
127 	.tiocmset =		whiteheat_tiocmset,
128 	.throttle =		usb_serial_generic_throttle,
129 	.unthrottle =		usb_serial_generic_unthrottle,
130 };
131 
132 static struct usb_serial_driver * const serial_drivers[] = {
133 	&whiteheat_fake_device, &whiteheat_device, NULL
134 };
135 
136 struct whiteheat_command_private {
137 	struct mutex		mutex;
138 	__u8			port_running;
139 	__u8			command_finished;
140 	wait_queue_head_t	wait_command; /* for handling sleeping whilst
141 						 waiting for a command to
142 						 finish */
143 	__u8			result_buffer[64];
144 };
145 
146 struct whiteheat_private {
147 	__u8			mcr;		/* FIXME: no locking on mcr */
148 };
149 
150 
151 /* local function prototypes */
152 static int start_command_port(struct usb_serial *serial);
153 static void stop_command_port(struct usb_serial *serial);
154 static void command_port_write_callback(struct urb *urb);
155 static void command_port_read_callback(struct urb *urb);
156 
157 static int firm_send_command(struct usb_serial_port *port, __u8 command,
158 						__u8 *data, __u8 datasize);
159 static int firm_open(struct usb_serial_port *port);
160 static int firm_close(struct usb_serial_port *port);
161 static void firm_setup_port(struct tty_struct *tty);
162 static int firm_set_rts(struct usb_serial_port *port, __u8 onoff);
163 static int firm_set_dtr(struct usb_serial_port *port, __u8 onoff);
164 static int firm_set_break(struct usb_serial_port *port, __u8 onoff);
165 static int firm_purge(struct usb_serial_port *port, __u8 rxtx);
166 static int firm_get_dtr_rts(struct usb_serial_port *port);
167 static int firm_report_tx_done(struct usb_serial_port *port);
168 
169 
170 #define COMMAND_PORT		4
171 #define COMMAND_TIMEOUT		(2*HZ)	/* 2 second timeout for a command */
172 #define	COMMAND_TIMEOUT_MS	2000
173 
174 
175 /*****************************************************************************
176  * Connect Tech's White Heat prerenumeration driver functions
177  *****************************************************************************/
178 
179 /* steps to download the firmware to the WhiteHEAT device:
180  - hold the reset (by writing to the reset bit of the CPUCS register)
181  - download the VEND_AX.HEX file to the chip using VENDOR_REQUEST-ANCHOR_LOAD
182  - release the reset (by writing to the CPUCS register)
183  - download the WH.HEX file for all addresses greater than 0x1b3f using
184    VENDOR_REQUEST-ANCHOR_EXTERNAL_RAM_LOAD
185  - hold the reset
186  - download the WH.HEX file for all addresses less than 0x1b40 using
187    VENDOR_REQUEST_ANCHOR_LOAD
188  - release the reset
189  - device renumerated itself and comes up as new device id with all
190    firmware download completed.
191 */
192 static int whiteheat_firmware_download(struct usb_serial *serial,
193 					const struct usb_device_id *id)
194 {
195 	int response;
196 
197 	response = ezusb_fx1_ihex_firmware_download(serial->dev, "whiteheat_loader.fw");
198 	if (response >= 0) {
199 		response = ezusb_fx1_ihex_firmware_download(serial->dev, "whiteheat.fw");
200 		if (response >= 0)
201 			return 0;
202 	}
203 	return -ENOENT;
204 }
205 
206 
207 static int whiteheat_firmware_attach(struct usb_serial *serial)
208 {
209 	/* We want this device to fail to have a driver assigned to it */
210 	return 1;
211 }
212 
213 
214 /*****************************************************************************
215  * Connect Tech's White Heat serial driver functions
216  *****************************************************************************/
217 
218 static int whiteheat_attach(struct usb_serial *serial)
219 {
220 	struct usb_serial_port *command_port;
221 	struct whiteheat_command_private *command_info;
222 	struct whiteheat_hw_info *hw_info;
223 	int pipe;
224 	int ret;
225 	int alen;
226 	__u8 *command;
227 	__u8 *result;
228 
229 	command_port = serial->port[COMMAND_PORT];
230 
231 	pipe = usb_sndbulkpipe(serial->dev,
232 			command_port->bulk_out_endpointAddress);
233 	command = kmalloc(2, GFP_KERNEL);
234 	if (!command)
235 		goto no_command_buffer;
236 	command[0] = WHITEHEAT_GET_HW_INFO;
237 	command[1] = 0;
238 
239 	result = kmalloc(sizeof(*hw_info) + 1, GFP_KERNEL);
240 	if (!result)
241 		goto no_result_buffer;
242 	/*
243 	 * When the module is reloaded the firmware is still there and
244 	 * the endpoints are still in the usb core unchanged. This is the
245 	 * unlinking bug in disguise. Same for the call below.
246 	 */
247 	usb_clear_halt(serial->dev, pipe);
248 	ret = usb_bulk_msg(serial->dev, pipe, command, 2,
249 						&alen, COMMAND_TIMEOUT_MS);
250 	if (ret) {
251 		dev_err(&serial->dev->dev, "%s: Couldn't send command [%d]\n",
252 			serial->type->description, ret);
253 		goto no_firmware;
254 	} else if (alen != 2) {
255 		dev_err(&serial->dev->dev, "%s: Send command incomplete [%d]\n",
256 			serial->type->description, alen);
257 		goto no_firmware;
258 	}
259 
260 	pipe = usb_rcvbulkpipe(serial->dev,
261 				command_port->bulk_in_endpointAddress);
262 	/* See the comment on the usb_clear_halt() above */
263 	usb_clear_halt(serial->dev, pipe);
264 	ret = usb_bulk_msg(serial->dev, pipe, result,
265 			sizeof(*hw_info) + 1, &alen, COMMAND_TIMEOUT_MS);
266 	if (ret) {
267 		dev_err(&serial->dev->dev, "%s: Couldn't get results [%d]\n",
268 			serial->type->description, ret);
269 		goto no_firmware;
270 	} else if (alen != sizeof(*hw_info) + 1) {
271 		dev_err(&serial->dev->dev, "%s: Get results incomplete [%d]\n",
272 			serial->type->description, alen);
273 		goto no_firmware;
274 	} else if (result[0] != command[0]) {
275 		dev_err(&serial->dev->dev, "%s: Command failed [%d]\n",
276 			serial->type->description, result[0]);
277 		goto no_firmware;
278 	}
279 
280 	hw_info = (struct whiteheat_hw_info *)&result[1];
281 
282 	dev_info(&serial->dev->dev, "%s: Firmware v%d.%02d\n",
283 		 serial->type->description,
284 		 hw_info->sw_major_rev, hw_info->sw_minor_rev);
285 
286 	command_info = kmalloc(sizeof(struct whiteheat_command_private),
287 								GFP_KERNEL);
288 	if (!command_info)
289 		goto no_command_private;
290 
291 	mutex_init(&command_info->mutex);
292 	command_info->port_running = 0;
293 	init_waitqueue_head(&command_info->wait_command);
294 	usb_set_serial_port_data(command_port, command_info);
295 	command_port->write_urb->complete = command_port_write_callback;
296 	command_port->read_urb->complete = command_port_read_callback;
297 	kfree(result);
298 	kfree(command);
299 
300 	return 0;
301 
302 no_firmware:
303 	/* Firmware likely not running */
304 	dev_err(&serial->dev->dev,
305 		"%s: Unable to retrieve firmware version, try replugging\n",
306 		serial->type->description);
307 	dev_err(&serial->dev->dev,
308 		"%s: If the firmware is not running (status led not blinking)\n",
309 		serial->type->description);
310 	dev_err(&serial->dev->dev,
311 		"%s: please contact support@connecttech.com\n",
312 		serial->type->description);
313 	kfree(result);
314 	kfree(command);
315 	return -ENODEV;
316 
317 no_command_private:
318 	kfree(result);
319 no_result_buffer:
320 	kfree(command);
321 no_command_buffer:
322 	return -ENOMEM;
323 }
324 
325 static void whiteheat_release(struct usb_serial *serial)
326 {
327 	struct usb_serial_port *command_port;
328 
329 	/* free up our private data for our command port */
330 	command_port = serial->port[COMMAND_PORT];
331 	kfree(usb_get_serial_port_data(command_port));
332 }
333 
334 static int whiteheat_port_probe(struct usb_serial_port *port)
335 {
336 	struct whiteheat_private *info;
337 
338 	info = kzalloc(sizeof(*info), GFP_KERNEL);
339 	if (!info)
340 		return -ENOMEM;
341 
342 	usb_set_serial_port_data(port, info);
343 
344 	return 0;
345 }
346 
347 static void whiteheat_port_remove(struct usb_serial_port *port)
348 {
349 	struct whiteheat_private *info;
350 
351 	info = usb_get_serial_port_data(port);
352 	kfree(info);
353 }
354 
355 static int whiteheat_open(struct tty_struct *tty, struct usb_serial_port *port)
356 {
357 	int retval;
358 
359 	retval = start_command_port(port->serial);
360 	if (retval)
361 		goto exit;
362 
363 	/* send an open port command */
364 	retval = firm_open(port);
365 	if (retval) {
366 		stop_command_port(port->serial);
367 		goto exit;
368 	}
369 
370 	retval = firm_purge(port, WHITEHEAT_PURGE_RX | WHITEHEAT_PURGE_TX);
371 	if (retval) {
372 		firm_close(port);
373 		stop_command_port(port->serial);
374 		goto exit;
375 	}
376 
377 	if (tty)
378 		firm_setup_port(tty);
379 
380 	/* Work around HCD bugs */
381 	usb_clear_halt(port->serial->dev, port->read_urb->pipe);
382 	usb_clear_halt(port->serial->dev, port->write_urb->pipe);
383 
384 	retval = usb_serial_generic_open(tty, port);
385 	if (retval) {
386 		firm_close(port);
387 		stop_command_port(port->serial);
388 		goto exit;
389 	}
390 exit:
391 	return retval;
392 }
393 
394 
395 static void whiteheat_close(struct usb_serial_port *port)
396 {
397 	firm_report_tx_done(port);
398 	firm_close(port);
399 
400 	usb_serial_generic_close(port);
401 
402 	stop_command_port(port->serial);
403 }
404 
405 static int whiteheat_tiocmget(struct tty_struct *tty)
406 {
407 	struct usb_serial_port *port = tty->driver_data;
408 	struct whiteheat_private *info = usb_get_serial_port_data(port);
409 	unsigned int modem_signals = 0;
410 
411 	firm_get_dtr_rts(port);
412 	if (info->mcr & UART_MCR_DTR)
413 		modem_signals |= TIOCM_DTR;
414 	if (info->mcr & UART_MCR_RTS)
415 		modem_signals |= TIOCM_RTS;
416 
417 	return modem_signals;
418 }
419 
420 static int whiteheat_tiocmset(struct tty_struct *tty,
421 			       unsigned int set, unsigned int clear)
422 {
423 	struct usb_serial_port *port = tty->driver_data;
424 	struct whiteheat_private *info = usb_get_serial_port_data(port);
425 
426 	if (set & TIOCM_RTS)
427 		info->mcr |= UART_MCR_RTS;
428 	if (set & TIOCM_DTR)
429 		info->mcr |= UART_MCR_DTR;
430 
431 	if (clear & TIOCM_RTS)
432 		info->mcr &= ~UART_MCR_RTS;
433 	if (clear & TIOCM_DTR)
434 		info->mcr &= ~UART_MCR_DTR;
435 
436 	firm_set_dtr(port, info->mcr & UART_MCR_DTR);
437 	firm_set_rts(port, info->mcr & UART_MCR_RTS);
438 	return 0;
439 }
440 
441 
442 static void whiteheat_get_serial(struct tty_struct *tty, struct serial_struct *ss)
443 {
444 	ss->baud_base = 460800;
445 }
446 
447 
448 static void whiteheat_set_termios(struct tty_struct *tty,
449 	struct usb_serial_port *port, struct ktermios *old_termios)
450 {
451 	firm_setup_port(tty);
452 }
453 
454 static void whiteheat_break_ctl(struct tty_struct *tty, int break_state)
455 {
456 	struct usb_serial_port *port = tty->driver_data;
457 	firm_set_break(port, break_state);
458 }
459 
460 
461 /*****************************************************************************
462  * Connect Tech's White Heat callback routines
463  *****************************************************************************/
464 static void command_port_write_callback(struct urb *urb)
465 {
466 	int status = urb->status;
467 
468 	if (status) {
469 		dev_dbg(&urb->dev->dev, "nonzero urb status: %d\n", status);
470 		return;
471 	}
472 }
473 
474 
475 static void command_port_read_callback(struct urb *urb)
476 {
477 	struct usb_serial_port *command_port = urb->context;
478 	struct whiteheat_command_private *command_info;
479 	int status = urb->status;
480 	unsigned char *data = urb->transfer_buffer;
481 	int result;
482 
483 	command_info = usb_get_serial_port_data(command_port);
484 	if (!command_info) {
485 		dev_dbg(&urb->dev->dev, "%s - command_info is NULL, exiting.\n", __func__);
486 		return;
487 	}
488 	if (!urb->actual_length) {
489 		dev_dbg(&urb->dev->dev, "%s - empty response, exiting.\n", __func__);
490 		return;
491 	}
492 	if (status) {
493 		dev_dbg(&urb->dev->dev, "%s - nonzero urb status: %d\n", __func__, status);
494 		if (status != -ENOENT)
495 			command_info->command_finished = WHITEHEAT_CMD_FAILURE;
496 		wake_up(&command_info->wait_command);
497 		return;
498 	}
499 
500 	usb_serial_debug_data(&command_port->dev, __func__, urb->actual_length, data);
501 
502 	if (data[0] == WHITEHEAT_CMD_COMPLETE) {
503 		command_info->command_finished = WHITEHEAT_CMD_COMPLETE;
504 		wake_up(&command_info->wait_command);
505 	} else if (data[0] == WHITEHEAT_CMD_FAILURE) {
506 		command_info->command_finished = WHITEHEAT_CMD_FAILURE;
507 		wake_up(&command_info->wait_command);
508 	} else if (data[0] == WHITEHEAT_EVENT) {
509 		/* These are unsolicited reports from the firmware, hence no
510 		   waiting command to wakeup */
511 		dev_dbg(&urb->dev->dev, "%s - event received\n", __func__);
512 	} else if ((data[0] == WHITEHEAT_GET_DTR_RTS) &&
513 		(urb->actual_length - 1 <= sizeof(command_info->result_buffer))) {
514 		memcpy(command_info->result_buffer, &data[1],
515 						urb->actual_length - 1);
516 		command_info->command_finished = WHITEHEAT_CMD_COMPLETE;
517 		wake_up(&command_info->wait_command);
518 	} else
519 		dev_dbg(&urb->dev->dev, "%s - bad reply from firmware\n", __func__);
520 
521 	/* Continue trying to always read */
522 	result = usb_submit_urb(command_port->read_urb, GFP_ATOMIC);
523 	if (result)
524 		dev_dbg(&urb->dev->dev, "%s - failed resubmitting read urb, error %d\n",
525 			__func__, result);
526 }
527 
528 
529 /*****************************************************************************
530  * Connect Tech's White Heat firmware interface
531  *****************************************************************************/
532 static int firm_send_command(struct usb_serial_port *port, __u8 command,
533 						__u8 *data, __u8 datasize)
534 {
535 	struct usb_serial_port *command_port;
536 	struct whiteheat_command_private *command_info;
537 	struct whiteheat_private *info;
538 	struct device *dev = &port->dev;
539 	__u8 *transfer_buffer;
540 	int retval = 0;
541 	int t;
542 
543 	dev_dbg(dev, "%s - command %d\n", __func__, command);
544 
545 	command_port = port->serial->port[COMMAND_PORT];
546 	command_info = usb_get_serial_port_data(command_port);
547 
548 	if (command_port->bulk_out_size < datasize + 1)
549 		return -EIO;
550 
551 	mutex_lock(&command_info->mutex);
552 	command_info->command_finished = false;
553 
554 	transfer_buffer = (__u8 *)command_port->write_urb->transfer_buffer;
555 	transfer_buffer[0] = command;
556 	memcpy(&transfer_buffer[1], data, datasize);
557 	command_port->write_urb->transfer_buffer_length = datasize + 1;
558 	retval = usb_submit_urb(command_port->write_urb, GFP_NOIO);
559 	if (retval) {
560 		dev_dbg(dev, "%s - submit urb failed\n", __func__);
561 		goto exit;
562 	}
563 
564 	/* wait for the command to complete */
565 	t = wait_event_timeout(command_info->wait_command,
566 		(bool)command_info->command_finished, COMMAND_TIMEOUT);
567 	if (!t)
568 		usb_kill_urb(command_port->write_urb);
569 
570 	if (command_info->command_finished == false) {
571 		dev_dbg(dev, "%s - command timed out.\n", __func__);
572 		retval = -ETIMEDOUT;
573 		goto exit;
574 	}
575 
576 	if (command_info->command_finished == WHITEHEAT_CMD_FAILURE) {
577 		dev_dbg(dev, "%s - command failed.\n", __func__);
578 		retval = -EIO;
579 		goto exit;
580 	}
581 
582 	if (command_info->command_finished == WHITEHEAT_CMD_COMPLETE) {
583 		dev_dbg(dev, "%s - command completed.\n", __func__);
584 		switch (command) {
585 		case WHITEHEAT_GET_DTR_RTS:
586 			info = usb_get_serial_port_data(port);
587 			memcpy(&info->mcr, command_info->result_buffer,
588 					sizeof(struct whiteheat_dr_info));
589 				break;
590 		}
591 	}
592 exit:
593 	mutex_unlock(&command_info->mutex);
594 	return retval;
595 }
596 
597 
598 static int firm_open(struct usb_serial_port *port)
599 {
600 	struct whiteheat_simple open_command;
601 
602 	open_command.port = port->port_number + 1;
603 	return firm_send_command(port, WHITEHEAT_OPEN,
604 		(__u8 *)&open_command, sizeof(open_command));
605 }
606 
607 
608 static int firm_close(struct usb_serial_port *port)
609 {
610 	struct whiteheat_simple close_command;
611 
612 	close_command.port = port->port_number + 1;
613 	return firm_send_command(port, WHITEHEAT_CLOSE,
614 			(__u8 *)&close_command, sizeof(close_command));
615 }
616 
617 
618 static void firm_setup_port(struct tty_struct *tty)
619 {
620 	struct usb_serial_port *port = tty->driver_data;
621 	struct device *dev = &port->dev;
622 	struct whiteheat_port_settings port_settings;
623 	unsigned int cflag = tty->termios.c_cflag;
624 	speed_t baud;
625 
626 	port_settings.port = port->port_number + 1;
627 
628 	/* get the byte size */
629 	switch (cflag & CSIZE) {
630 	case CS5:	port_settings.bits = 5;   break;
631 	case CS6:	port_settings.bits = 6;   break;
632 	case CS7:	port_settings.bits = 7;   break;
633 	default:
634 	case CS8:	port_settings.bits = 8;   break;
635 	}
636 	dev_dbg(dev, "%s - data bits = %d\n", __func__, port_settings.bits);
637 
638 	/* determine the parity */
639 	if (cflag & PARENB)
640 		if (cflag & CMSPAR)
641 			if (cflag & PARODD)
642 				port_settings.parity = WHITEHEAT_PAR_MARK;
643 			else
644 				port_settings.parity = WHITEHEAT_PAR_SPACE;
645 		else
646 			if (cflag & PARODD)
647 				port_settings.parity = WHITEHEAT_PAR_ODD;
648 			else
649 				port_settings.parity = WHITEHEAT_PAR_EVEN;
650 	else
651 		port_settings.parity = WHITEHEAT_PAR_NONE;
652 	dev_dbg(dev, "%s - parity = %c\n", __func__, port_settings.parity);
653 
654 	/* figure out the stop bits requested */
655 	if (cflag & CSTOPB)
656 		port_settings.stop = 2;
657 	else
658 		port_settings.stop = 1;
659 	dev_dbg(dev, "%s - stop bits = %d\n", __func__, port_settings.stop);
660 
661 	/* figure out the flow control settings */
662 	if (cflag & CRTSCTS)
663 		port_settings.hflow = (WHITEHEAT_HFLOW_CTS |
664 						WHITEHEAT_HFLOW_RTS);
665 	else
666 		port_settings.hflow = WHITEHEAT_HFLOW_NONE;
667 	dev_dbg(dev, "%s - hardware flow control = %s %s %s %s\n", __func__,
668 	    (port_settings.hflow & WHITEHEAT_HFLOW_CTS) ? "CTS" : "",
669 	    (port_settings.hflow & WHITEHEAT_HFLOW_RTS) ? "RTS" : "",
670 	    (port_settings.hflow & WHITEHEAT_HFLOW_DSR) ? "DSR" : "",
671 	    (port_settings.hflow & WHITEHEAT_HFLOW_DTR) ? "DTR" : "");
672 
673 	/* determine software flow control */
674 	if (I_IXOFF(tty))
675 		port_settings.sflow = WHITEHEAT_SFLOW_RXTX;
676 	else
677 		port_settings.sflow = WHITEHEAT_SFLOW_NONE;
678 	dev_dbg(dev, "%s - software flow control = %c\n", __func__, port_settings.sflow);
679 
680 	port_settings.xon = START_CHAR(tty);
681 	port_settings.xoff = STOP_CHAR(tty);
682 	dev_dbg(dev, "%s - XON = %2x, XOFF = %2x\n", __func__, port_settings.xon, port_settings.xoff);
683 
684 	/* get the baud rate wanted */
685 	baud = tty_get_baud_rate(tty);
686 	port_settings.baud = cpu_to_le32(baud);
687 	dev_dbg(dev, "%s - baud rate = %u\n", __func__, baud);
688 
689 	/* fixme: should set validated settings */
690 	tty_encode_baud_rate(tty, baud, baud);
691 
692 	/* handle any settings that aren't specified in the tty structure */
693 	port_settings.lloop = 0;
694 
695 	/* now send the message to the device */
696 	firm_send_command(port, WHITEHEAT_SETUP_PORT,
697 			(__u8 *)&port_settings, sizeof(port_settings));
698 }
699 
700 
701 static int firm_set_rts(struct usb_serial_port *port, __u8 onoff)
702 {
703 	struct whiteheat_set_rdb rts_command;
704 
705 	rts_command.port = port->port_number + 1;
706 	rts_command.state = onoff;
707 	return firm_send_command(port, WHITEHEAT_SET_RTS,
708 			(__u8 *)&rts_command, sizeof(rts_command));
709 }
710 
711 
712 static int firm_set_dtr(struct usb_serial_port *port, __u8 onoff)
713 {
714 	struct whiteheat_set_rdb dtr_command;
715 
716 	dtr_command.port = port->port_number + 1;
717 	dtr_command.state = onoff;
718 	return firm_send_command(port, WHITEHEAT_SET_DTR,
719 			(__u8 *)&dtr_command, sizeof(dtr_command));
720 }
721 
722 
723 static int firm_set_break(struct usb_serial_port *port, __u8 onoff)
724 {
725 	struct whiteheat_set_rdb break_command;
726 
727 	break_command.port = port->port_number + 1;
728 	break_command.state = onoff;
729 	return firm_send_command(port, WHITEHEAT_SET_BREAK,
730 			(__u8 *)&break_command, sizeof(break_command));
731 }
732 
733 
734 static int firm_purge(struct usb_serial_port *port, __u8 rxtx)
735 {
736 	struct whiteheat_purge purge_command;
737 
738 	purge_command.port = port->port_number + 1;
739 	purge_command.what = rxtx;
740 	return firm_send_command(port, WHITEHEAT_PURGE,
741 			(__u8 *)&purge_command, sizeof(purge_command));
742 }
743 
744 
745 static int firm_get_dtr_rts(struct usb_serial_port *port)
746 {
747 	struct whiteheat_simple get_dr_command;
748 
749 	get_dr_command.port = port->port_number + 1;
750 	return firm_send_command(port, WHITEHEAT_GET_DTR_RTS,
751 			(__u8 *)&get_dr_command, sizeof(get_dr_command));
752 }
753 
754 
755 static int firm_report_tx_done(struct usb_serial_port *port)
756 {
757 	struct whiteheat_simple close_command;
758 
759 	close_command.port = port->port_number + 1;
760 	return firm_send_command(port, WHITEHEAT_REPORT_TX_DONE,
761 			(__u8 *)&close_command, sizeof(close_command));
762 }
763 
764 
765 /*****************************************************************************
766  * Connect Tech's White Heat utility functions
767  *****************************************************************************/
768 static int start_command_port(struct usb_serial *serial)
769 {
770 	struct usb_serial_port *command_port;
771 	struct whiteheat_command_private *command_info;
772 	int retval = 0;
773 
774 	command_port = serial->port[COMMAND_PORT];
775 	command_info = usb_get_serial_port_data(command_port);
776 	mutex_lock(&command_info->mutex);
777 	if (!command_info->port_running) {
778 		/* Work around HCD bugs */
779 		usb_clear_halt(serial->dev, command_port->read_urb->pipe);
780 
781 		retval = usb_submit_urb(command_port->read_urb, GFP_KERNEL);
782 		if (retval) {
783 			dev_err(&serial->dev->dev,
784 				"%s - failed submitting read urb, error %d\n",
785 				__func__, retval);
786 			goto exit;
787 		}
788 	}
789 	command_info->port_running++;
790 
791 exit:
792 	mutex_unlock(&command_info->mutex);
793 	return retval;
794 }
795 
796 
797 static void stop_command_port(struct usb_serial *serial)
798 {
799 	struct usb_serial_port *command_port;
800 	struct whiteheat_command_private *command_info;
801 
802 	command_port = serial->port[COMMAND_PORT];
803 	command_info = usb_get_serial_port_data(command_port);
804 	mutex_lock(&command_info->mutex);
805 	command_info->port_running--;
806 	if (!command_info->port_running)
807 		usb_kill_urb(command_port->read_urb);
808 	mutex_unlock(&command_info->mutex);
809 }
810 
811 module_usb_serial_driver(serial_drivers, id_table_combined);
812 
813 MODULE_AUTHOR(DRIVER_AUTHOR);
814 MODULE_DESCRIPTION(DRIVER_DESC);
815 MODULE_LICENSE("GPL");
816 
817 MODULE_FIRMWARE("whiteheat.fw");
818 MODULE_FIRMWARE("whiteheat_loader.fw");
819