tty: usb-serial krefs
[deliverable/linux.git] / drivers / usb / serial / ti_usb_3410_5052.c
CommitLineData
1da177e4
LT
1/* vi: ts=8 sw=8
2 *
3 * TI 3410/5052 USB Serial Driver
4 *
5 * Copyright (C) 2004 Texas Instruments
6 *
7 * This driver is based on the Linux io_ti driver, which is
8 * Copyright (C) 2000-2002 Inside Out Networks
9 * Copyright (C) 2001-2002 Greg Kroah-Hartman
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or
14 * (at your option) any later version.
15 *
16 * For questions or problems with this driver, contact Texas Instruments
17 * technical support, or Al Borchers <alborchers@steinerpoint.com>, or
18 * Peter Berger <pberger@brimson.com>.
a30fa793 19 *
1da177e4
LT
20 * This driver needs this hotplug script in /etc/hotplug/usb/ti_usb_3410_5052
21 * or in /etc/hotplug.d/usb/ti_usb_3410_5052.hotplug to set the device
22 * configuration.
23 *
24 * #!/bin/bash
25 *
26 * BOOT_CONFIG=1
27 * ACTIVE_CONFIG=2
28 *
29 * if [[ "$ACTION" != "add" ]]
30 * then
31 * exit
32 * fi
33 *
34 * CONFIG_PATH=/sys${DEVPATH%/?*}/bConfigurationValue
35 *
36 * if [[ 0`cat $CONFIG_PATH` -ne $BOOT_CONFIG ]]
37 * then
38 * exit
39 * fi
40 *
41 * PRODUCT=${PRODUCT%/?*} # delete version
42 * VENDOR_ID=`printf "%d" 0x${PRODUCT%/?*}`
43 * PRODUCT_ID=`printf "%d" 0x${PRODUCT#*?/}`
44 *
45 * PARAM_PATH=/sys/module/ti_usb_3410_5052/parameters
46 *
47 * function scan() {
48 * s=$1
49 * shift
50 * for i
51 * do
52 * if [[ $s -eq $i ]]
53 * then
54 * return 0
55 * fi
56 * done
57 * return 1
58 * }
59 *
60 * IFS=$IFS,
61 *
62 * if (scan $VENDOR_ID 1105 `cat $PARAM_PATH/vendor_3410` &&
63 * scan $PRODUCT_ID 13328 `cat $PARAM_PATH/product_3410`) ||
64 * (scan $VENDOR_ID 1105 `cat $PARAM_PATH/vendor_5052` &&
65 * scan $PRODUCT_ID 20562 20818 20570 20575 `cat $PARAM_PATH/product_5052`)
66 * then
67 * echo $ACTIVE_CONFIG > $CONFIG_PATH
68 * fi
69 */
70
1da177e4
LT
71#include <linux/kernel.h>
72#include <linux/errno.h>
95da310e 73#include <linux/firmware.h>
1da177e4
LT
74#include <linux/init.h>
75#include <linux/slab.h>
76#include <linux/tty.h>
77#include <linux/tty_driver.h>
78#include <linux/tty_flip.h>
79#include <linux/module.h>
80#include <linux/spinlock.h>
81#include <linux/ioctl.h>
82#include <linux/serial.h>
83#include <linux/circ_buf.h>
9da0068a 84#include <linux/mutex.h>
a30fa793 85#include <linux/uaccess.h>
1da177e4 86#include <linux/usb.h>
a969888c 87#include <linux/usb/serial.h>
5f24e2d6 88#include <linux/firmware.h>
1da177e4 89
1da177e4 90#include "ti_usb_3410_5052.h"
1da177e4
LT
91
92/* Defines */
93
94#define TI_DRIVER_VERSION "v0.9"
95#define TI_DRIVER_AUTHOR "Al Borchers <alborchers@steinerpoint.com>"
96#define TI_DRIVER_DESC "TI USB 3410/5052 Serial Driver"
97
98#define TI_FIRMWARE_BUF_SIZE 16284
99
100#define TI_WRITE_BUF_SIZE 1024
101
102#define TI_TRANSFER_TIMEOUT 2
103
104#define TI_DEFAULT_LOW_LATENCY 0
105#define TI_DEFAULT_CLOSING_WAIT 4000 /* in .01 secs */
106
107/* supported setserial flags */
108#define TI_SET_SERIAL_FLAGS (ASYNC_LOW_LATENCY)
109
110/* read urb states */
111#define TI_READ_URB_RUNNING 0
112#define TI_READ_URB_STOPPING 1
113#define TI_READ_URB_STOPPED 2
114
115#define TI_EXTRA_VID_PID_COUNT 5
116
117
118/* Structures */
119
120struct ti_port {
121 int tp_is_open;
122 __u8 tp_msr;
123 __u8 tp_lsr;
124 __u8 tp_shadow_mcr;
125 __u8 tp_uart_mode; /* 232 or 485 modes */
126 unsigned int tp_uart_base_addr;
127 int tp_flags;
128 int tp_closing_wait;/* in .01 secs */
129 struct async_icount tp_icount;
130 wait_queue_head_t tp_msr_wait; /* wait for msr change */
131 wait_queue_head_t tp_write_wait;
132 struct ti_device *tp_tdev;
133 struct usb_serial_port *tp_port;
134 spinlock_t tp_lock;
135 int tp_read_urb_state;
136 int tp_write_urb_in_use;
137 struct circ_buf *tp_write_buf;
138};
139
140struct ti_device {
9da0068a 141 struct mutex td_open_close_lock;
1da177e4
LT
142 int td_open_port_count;
143 struct usb_serial *td_serial;
144 int td_is_3410;
145 int td_urb_error;
146};
147
148
149/* Function Declarations */
150
151static int ti_startup(struct usb_serial *serial);
152static void ti_shutdown(struct usb_serial *serial);
95da310e 153static int ti_open(struct tty_struct *tty, struct usb_serial_port *port,
a30fa793 154 struct file *file);
95da310e 155static void ti_close(struct tty_struct *tty, struct usb_serial_port *port,
a30fa793 156 struct file *file);
95da310e 157static int ti_write(struct tty_struct *tty, struct usb_serial_port *port,
a30fa793 158 const unsigned char *data, int count);
95da310e
AC
159static int ti_write_room(struct tty_struct *tty);
160static int ti_chars_in_buffer(struct tty_struct *tty);
161static void ti_throttle(struct tty_struct *tty);
162static void ti_unthrottle(struct tty_struct *tty);
a30fa793
AC
163static int ti_ioctl(struct tty_struct *tty, struct file *file,
164 unsigned int cmd, unsigned long arg);
165static void ti_set_termios(struct tty_struct *tty,
166 struct usb_serial_port *port, struct ktermios *old_termios);
95da310e
AC
167static int ti_tiocmget(struct tty_struct *tty, struct file *file);
168static int ti_tiocmset(struct tty_struct *tty, struct file *file,
a30fa793 169 unsigned int set, unsigned int clear);
95da310e 170static void ti_break(struct tty_struct *tty, int break_state);
7d12e780
DH
171static void ti_interrupt_callback(struct urb *urb);
172static void ti_bulk_in_callback(struct urb *urb);
173static void ti_bulk_out_callback(struct urb *urb);
1da177e4
LT
174
175static void ti_recv(struct device *dev, struct tty_struct *tty,
176 unsigned char *data, int length);
177static void ti_send(struct ti_port *tport);
178static int ti_set_mcr(struct ti_port *tport, unsigned int mcr);
179static int ti_get_lsr(struct ti_port *tport);
180static int ti_get_serial_info(struct ti_port *tport,
181 struct serial_struct __user *ret_arg);
4a90f09b 182static int ti_set_serial_info(struct tty_struct *tty, struct ti_port *tport,
1da177e4
LT
183 struct serial_struct __user *new_arg);
184static void ti_handle_new_msr(struct ti_port *tport, __u8 msr);
185
186static void ti_drain(struct ti_port *tport, unsigned long timeout, int flush);
187
188static void ti_stop_read(struct ti_port *tport, struct tty_struct *tty);
189static int ti_restart_read(struct ti_port *tport, struct tty_struct *tty);
190
191static int ti_command_out_sync(struct ti_device *tdev, __u8 command,
192 __u16 moduleid, __u16 value, __u8 *data, int size);
193static int ti_command_in_sync(struct ti_device *tdev, __u8 command,
194 __u16 moduleid, __u16 value, __u8 *data, int size);
195
196static int ti_write_byte(struct ti_device *tdev, unsigned long addr,
197 __u8 mask, __u8 byte);
198
95da310e 199static int ti_download_firmware(struct ti_device *tdev, int type);
1da177e4
LT
200
201/* circular buffer */
202static struct circ_buf *ti_buf_alloc(void);
203static void ti_buf_free(struct circ_buf *cb);
204static void ti_buf_clear(struct circ_buf *cb);
205static int ti_buf_data_avail(struct circ_buf *cb);
206static int ti_buf_space_avail(struct circ_buf *cb);
207static int ti_buf_put(struct circ_buf *cb, const char *buf, int count);
208static int ti_buf_get(struct circ_buf *cb, char *buf, int count);
209
210
211/* Data */
212
213/* module parameters */
214static int debug;
215static int low_latency = TI_DEFAULT_LOW_LATENCY;
216static int closing_wait = TI_DEFAULT_CLOSING_WAIT;
217static ushort vendor_3410[TI_EXTRA_VID_PID_COUNT];
64a6f950 218static unsigned int vendor_3410_count;
1da177e4 219static ushort product_3410[TI_EXTRA_VID_PID_COUNT];
64a6f950 220static unsigned int product_3410_count;
1da177e4 221static ushort vendor_5052[TI_EXTRA_VID_PID_COUNT];
64a6f950 222static unsigned int vendor_5052_count;
1da177e4 223static ushort product_5052[TI_EXTRA_VID_PID_COUNT];
64a6f950 224static unsigned int product_5052_count;
1da177e4
LT
225
226/* supported devices */
227/* the array dimension is the number of default entries plus */
228/* TI_EXTRA_VID_PID_COUNT user defined entries plus 1 terminating */
229/* null entry */
230static struct usb_device_id ti_id_table_3410[1+TI_EXTRA_VID_PID_COUNT+1] = {
231 { USB_DEVICE(TI_VENDOR_ID, TI_3410_PRODUCT_ID) },
1f54a6ae 232 { USB_DEVICE(TI_VENDOR_ID, TI_3410_EZ430_ID) },
1da177e4
LT
233};
234
235static struct usb_device_id ti_id_table_5052[4+TI_EXTRA_VID_PID_COUNT+1] = {
236 { USB_DEVICE(TI_VENDOR_ID, TI_5052_BOOT_PRODUCT_ID) },
237 { USB_DEVICE(TI_VENDOR_ID, TI_5152_BOOT_PRODUCT_ID) },
238 { USB_DEVICE(TI_VENDOR_ID, TI_5052_EEPROM_PRODUCT_ID) },
239 { USB_DEVICE(TI_VENDOR_ID, TI_5052_FIRMWARE_PRODUCT_ID) },
240};
241
242static struct usb_device_id ti_id_table_combined[] = {
243 { USB_DEVICE(TI_VENDOR_ID, TI_3410_PRODUCT_ID) },
1f54a6ae 244 { USB_DEVICE(TI_VENDOR_ID, TI_3410_EZ430_ID) },
1da177e4
LT
245 { USB_DEVICE(TI_VENDOR_ID, TI_5052_BOOT_PRODUCT_ID) },
246 { USB_DEVICE(TI_VENDOR_ID, TI_5152_BOOT_PRODUCT_ID) },
247 { USB_DEVICE(TI_VENDOR_ID, TI_5052_EEPROM_PRODUCT_ID) },
248 { USB_DEVICE(TI_VENDOR_ID, TI_5052_FIRMWARE_PRODUCT_ID) },
249 { }
250};
251
252static struct usb_driver ti_usb_driver = {
1da177e4
LT
253 .name = "ti_usb_3410_5052",
254 .probe = usb_serial_probe,
255 .disconnect = usb_serial_disconnect,
256 .id_table = ti_id_table_combined,
ba9dc657 257 .no_dynamic_id = 1,
1da177e4
LT
258};
259
ea65370d 260static struct usb_serial_driver ti_1port_device = {
18fcac35 261 .driver = {
269bda1c
GKH
262 .owner = THIS_MODULE,
263 .name = "ti_usb_3410_5052_1",
18fcac35 264 },
269bda1c 265 .description = "TI USB 3410 1 port adapter",
d9b1b787 266 .usb_driver = &ti_usb_driver,
1da177e4 267 .id_table = ti_id_table_3410,
1da177e4
LT
268 .num_ports = 1,
269 .attach = ti_startup,
270 .shutdown = ti_shutdown,
271 .open = ti_open,
272 .close = ti_close,
273 .write = ti_write,
274 .write_room = ti_write_room,
275 .chars_in_buffer = ti_chars_in_buffer,
276 .throttle = ti_throttle,
277 .unthrottle = ti_unthrottle,
278 .ioctl = ti_ioctl,
279 .set_termios = ti_set_termios,
280 .tiocmget = ti_tiocmget,
281 .tiocmset = ti_tiocmset,
282 .break_ctl = ti_break,
283 .read_int_callback = ti_interrupt_callback,
284 .read_bulk_callback = ti_bulk_in_callback,
285 .write_bulk_callback = ti_bulk_out_callback,
286};
287
ea65370d 288static struct usb_serial_driver ti_2port_device = {
18fcac35 289 .driver = {
269bda1c
GKH
290 .owner = THIS_MODULE,
291 .name = "ti_usb_3410_5052_2",
18fcac35 292 },
269bda1c 293 .description = "TI USB 5052 2 port adapter",
d9b1b787 294 .usb_driver = &ti_usb_driver,
1da177e4 295 .id_table = ti_id_table_5052,
1da177e4
LT
296 .num_ports = 2,
297 .attach = ti_startup,
298 .shutdown = ti_shutdown,
299 .open = ti_open,
300 .close = ti_close,
301 .write = ti_write,
302 .write_room = ti_write_room,
303 .chars_in_buffer = ti_chars_in_buffer,
304 .throttle = ti_throttle,
305 .unthrottle = ti_unthrottle,
306 .ioctl = ti_ioctl,
307 .set_termios = ti_set_termios,
308 .tiocmget = ti_tiocmget,
309 .tiocmset = ti_tiocmset,
310 .break_ctl = ti_break,
311 .read_int_callback = ti_interrupt_callback,
312 .read_bulk_callback = ti_bulk_in_callback,
313 .write_bulk_callback = ti_bulk_out_callback,
314};
315
316
317/* Module */
318
319MODULE_AUTHOR(TI_DRIVER_AUTHOR);
320MODULE_DESCRIPTION(TI_DRIVER_DESC);
321MODULE_VERSION(TI_DRIVER_VERSION);
322MODULE_LICENSE("GPL");
323
5f24e2d6
DW
324MODULE_FIRMWARE("ti_3410.fw");
325MODULE_FIRMWARE("ti_5052.fw");
326
1da177e4
LT
327module_param(debug, bool, S_IRUGO | S_IWUSR);
328MODULE_PARM_DESC(debug, "Enable debugging, 0=no, 1=yes");
329
330module_param(low_latency, bool, S_IRUGO | S_IWUSR);
a30fa793
AC
331MODULE_PARM_DESC(low_latency,
332 "TTY low_latency flag, 0=off, 1=on, default is off");
1da177e4
LT
333
334module_param(closing_wait, int, S_IRUGO | S_IWUSR);
a30fa793
AC
335MODULE_PARM_DESC(closing_wait,
336 "Maximum wait for data to drain in close, in .01 secs, default is 4000");
1da177e4
LT
337
338module_param_array(vendor_3410, ushort, &vendor_3410_count, S_IRUGO);
a30fa793
AC
339MODULE_PARM_DESC(vendor_3410,
340 "Vendor ids for 3410 based devices, 1-5 short integers");
1da177e4 341module_param_array(product_3410, ushort, &product_3410_count, S_IRUGO);
a30fa793
AC
342MODULE_PARM_DESC(product_3410,
343 "Product ids for 3410 based devices, 1-5 short integers");
1da177e4 344module_param_array(vendor_5052, ushort, &vendor_5052_count, S_IRUGO);
a30fa793
AC
345MODULE_PARM_DESC(vendor_5052,
346 "Vendor ids for 5052 based devices, 1-5 short integers");
1da177e4 347module_param_array(product_5052, ushort, &product_5052_count, S_IRUGO);
a30fa793
AC
348MODULE_PARM_DESC(product_5052,
349 "Product ids for 5052 based devices, 1-5 short integers");
1da177e4
LT
350
351MODULE_DEVICE_TABLE(usb, ti_id_table_combined);
352
353
354/* Functions */
355
356static int __init ti_init(void)
357{
a30fa793 358 int i, j;
1da177e4
LT
359 int ret;
360
1da177e4 361 /* insert extra vendor and product ids */
52950ed4 362 j = ARRAY_SIZE(ti_id_table_3410) - TI_EXTRA_VID_PID_COUNT - 1;
a30fa793 363 for (i = 0; i < min(vendor_3410_count, product_3410_count); i++, j++) {
1da177e4
LT
364 ti_id_table_3410[j].idVendor = vendor_3410[i];
365 ti_id_table_3410[j].idProduct = product_3410[i];
366 ti_id_table_3410[j].match_flags = USB_DEVICE_ID_MATCH_DEVICE;
367 }
52950ed4 368 j = ARRAY_SIZE(ti_id_table_5052) - TI_EXTRA_VID_PID_COUNT - 1;
a30fa793 369 for (i = 0; i < min(vendor_5052_count, product_5052_count); i++, j++) {
1da177e4
LT
370 ti_id_table_5052[j].idVendor = vendor_5052[i];
371 ti_id_table_5052[j].idProduct = product_5052[i];
372 ti_id_table_5052[j].match_flags = USB_DEVICE_ID_MATCH_DEVICE;
373 }
374
375 ret = usb_serial_register(&ti_1port_device);
376 if (ret)
377 goto failed_1port;
378 ret = usb_serial_register(&ti_2port_device);
379 if (ret)
380 goto failed_2port;
381
382 ret = usb_register(&ti_usb_driver);
383 if (ret)
384 goto failed_usb;
385
386 info(TI_DRIVER_DESC " " TI_DRIVER_VERSION);
387
388 return 0;
389
390failed_usb:
391 usb_serial_deregister(&ti_2port_device);
392failed_2port:
393 usb_serial_deregister(&ti_1port_device);
394failed_1port:
395 return ret;
396}
397
398
399static void __exit ti_exit(void)
400{
401 usb_serial_deregister(&ti_1port_device);
402 usb_serial_deregister(&ti_2port_device);
403 usb_deregister(&ti_usb_driver);
404}
405
406
407module_init(ti_init);
408module_exit(ti_exit);
409
410
411static int ti_startup(struct usb_serial *serial)
412{
413 struct ti_device *tdev;
414 struct ti_port *tport;
415 struct usb_device *dev = serial->dev;
416 int status;
417 int i;
418
419
420 dbg("%s - product 0x%4X, num configurations %d, configuration value %d",
441b62c1 421 __func__, le16_to_cpu(dev->descriptor.idProduct),
1da177e4
LT
422 dev->descriptor.bNumConfigurations,
423 dev->actconfig->desc.bConfigurationValue);
424
425 /* create device structure */
80b6ca48 426 tdev = kzalloc(sizeof(struct ti_device), GFP_KERNEL);
1da177e4 427 if (tdev == NULL) {
441b62c1 428 dev_err(&dev->dev, "%s - out of memory\n", __func__);
1da177e4
LT
429 return -ENOMEM;
430 }
9da0068a 431 mutex_init(&tdev->td_open_close_lock);
1da177e4
LT
432 tdev->td_serial = serial;
433 usb_set_serial_data(serial, tdev);
434
435 /* determine device type */
436 if (usb_match_id(serial->interface, ti_id_table_3410))
437 tdev->td_is_3410 = 1;
a30fa793
AC
438 dbg("%s - device type is %s", __func__,
439 tdev->td_is_3410 ? "3410" : "5052");
1da177e4
LT
440
441 /* if we have only 1 configuration, download firmware */
442 if (dev->descriptor.bNumConfigurations == 1) {
1da177e4 443 if (tdev->td_is_3410)
95da310e 444 status = ti_download_firmware(tdev, 3410);
1da177e4 445 else
95da310e 446 status = ti_download_firmware(tdev, 5052);
1da177e4
LT
447 if (status)
448 goto free_tdev;
449
450 /* 3410 must be reset, 5052 resets itself */
451 if (tdev->td_is_3410) {
452 msleep_interruptible(100);
453 usb_reset_device(dev);
454 }
455
456 status = -ENODEV;
457 goto free_tdev;
a30fa793 458 }
1da177e4
LT
459
460 /* the second configuration must be set (in sysfs by hotplug script) */
461 if (dev->actconfig->desc.bConfigurationValue == TI_BOOT_CONFIG) {
462 status = -ENODEV;
463 goto free_tdev;
464 }
465
466 /* set up port structures */
467 for (i = 0; i < serial->num_ports; ++i) {
7ac9da10 468 tport = kzalloc(sizeof(struct ti_port), GFP_KERNEL);
1da177e4 469 if (tport == NULL) {
441b62c1 470 dev_err(&dev->dev, "%s - out of memory\n", __func__);
1da177e4
LT
471 status = -ENOMEM;
472 goto free_tports;
473 }
1da177e4 474 spin_lock_init(&tport->tp_lock);
a30fa793
AC
475 tport->tp_uart_base_addr = (i == 0 ?
476 TI_UART1_BASE_ADDR : TI_UART2_BASE_ADDR);
1da177e4
LT
477 tport->tp_flags = low_latency ? ASYNC_LOW_LATENCY : 0;
478 tport->tp_closing_wait = closing_wait;
479 init_waitqueue_head(&tport->tp_msr_wait);
480 init_waitqueue_head(&tport->tp_write_wait);
481 tport->tp_write_buf = ti_buf_alloc();
482 if (tport->tp_write_buf == NULL) {
441b62c1 483 dev_err(&dev->dev, "%s - out of memory\n", __func__);
1da177e4
LT
484 kfree(tport);
485 status = -ENOMEM;
486 goto free_tports;
487 }
488 tport->tp_port = serial->port[i];
489 tport->tp_tdev = tdev;
490 usb_set_serial_port_data(serial->port[i], tport);
491 tport->tp_uart_mode = 0; /* default is RS232 */
492 }
a30fa793 493
1da177e4
LT
494 return 0;
495
496free_tports:
a30fa793 497 for (--i; i >= 0; --i) {
1da177e4
LT
498 tport = usb_get_serial_port_data(serial->port[i]);
499 ti_buf_free(tport->tp_write_buf);
500 kfree(tport);
501 usb_set_serial_port_data(serial->port[i], NULL);
502 }
503free_tdev:
504 kfree(tdev);
505 usb_set_serial_data(serial, NULL);
506 return status;
507}
508
509
510static void ti_shutdown(struct usb_serial *serial)
511{
512 int i;
513 struct ti_device *tdev = usb_get_serial_data(serial);
514 struct ti_port *tport;
515
441b62c1 516 dbg("%s", __func__);
1da177e4 517
a30fa793 518 for (i = 0; i < serial->num_ports; ++i) {
1da177e4
LT
519 tport = usb_get_serial_port_data(serial->port[i]);
520 if (tport) {
521 ti_buf_free(tport->tp_write_buf);
522 kfree(tport);
523 usb_set_serial_port_data(serial->port[i], NULL);
524 }
525 }
526
1bc3c9e1 527 kfree(tdev);
1da177e4
LT
528 usb_set_serial_data(serial, NULL);
529}
530
531
95da310e
AC
532static int ti_open(struct tty_struct *tty,
533 struct usb_serial_port *port, struct file *file)
1da177e4
LT
534{
535 struct ti_port *tport = usb_get_serial_port_data(port);
536 struct ti_device *tdev;
537 struct usb_device *dev;
538 struct urb *urb;
539 int port_number;
540 int status;
a30fa793
AC
541 __u16 open_settings = (__u8)(TI_PIPE_MODE_CONTINOUS |
542 TI_PIPE_TIMEOUT_ENABLE |
1da177e4
LT
543 (TI_TRANSFER_TIMEOUT << 2));
544
441b62c1 545 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
546
547 if (tport == NULL)
548 return -ENODEV;
549
550 dev = port->serial->dev;
551 tdev = tport->tp_tdev;
552
553 /* only one open on any port on a device at a time */
9da0068a 554 if (mutex_lock_interruptible(&tdev->td_open_close_lock))
1da177e4
LT
555 return -ERESTARTSYS;
556
95da310e
AC
557 if (tty)
558 tty->low_latency =
559 (tport->tp_flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1da177e4
LT
560
561 port_number = port->number - port->serial->minor;
562
563 memset(&(tport->tp_icount), 0x00, sizeof(tport->tp_icount));
564
565 tport->tp_msr = 0;
566 tport->tp_shadow_mcr |= (TI_MCR_RTS | TI_MCR_DTR);
567
568 /* start interrupt urb the first time a port is opened on this device */
569 if (tdev->td_open_port_count == 0) {
441b62c1 570 dbg("%s - start interrupt in urb", __func__);
1da177e4
LT
571 urb = tdev->td_serial->port[0]->interrupt_in_urb;
572 if (!urb) {
a30fa793
AC
573 dev_err(&port->dev, "%s - no interrupt urb\n",
574 __func__);
1da177e4 575 status = -EINVAL;
9da0068a 576 goto release_lock;
1da177e4
LT
577 }
578 urb->complete = ti_interrupt_callback;
579 urb->context = tdev;
580 urb->dev = dev;
581 status = usb_submit_urb(urb, GFP_KERNEL);
582 if (status) {
a30fa793
AC
583 dev_err(&port->dev,
584 "%s - submit interrupt urb failed, %d\n",
585 __func__, status);
9da0068a 586 goto release_lock;
1da177e4
LT
587 }
588 }
589
95da310e
AC
590 if (tty)
591 ti_set_termios(tty, port, tty->termios);
1da177e4 592
441b62c1 593 dbg("%s - sending TI_OPEN_PORT", __func__);
1da177e4
LT
594 status = ti_command_out_sync(tdev, TI_OPEN_PORT,
595 (__u8)(TI_UART1_PORT + port_number), open_settings, NULL, 0);
596 if (status) {
a30fa793
AC
597 dev_err(&port->dev, "%s - cannot send open command, %d\n",
598 __func__, status);
1da177e4
LT
599 goto unlink_int_urb;
600 }
601
441b62c1 602 dbg("%s - sending TI_START_PORT", __func__);
1da177e4
LT
603 status = ti_command_out_sync(tdev, TI_START_PORT,
604 (__u8)(TI_UART1_PORT + port_number), 0, NULL, 0);
605 if (status) {
a30fa793
AC
606 dev_err(&port->dev, "%s - cannot send start command, %d\n",
607 __func__, status);
1da177e4
LT
608 goto unlink_int_urb;
609 }
610
441b62c1 611 dbg("%s - sending TI_PURGE_PORT", __func__);
1da177e4
LT
612 status = ti_command_out_sync(tdev, TI_PURGE_PORT,
613 (__u8)(TI_UART1_PORT + port_number), TI_PURGE_INPUT, NULL, 0);
614 if (status) {
a30fa793
AC
615 dev_err(&port->dev, "%s - cannot clear input buffers, %d\n",
616 __func__, status);
1da177e4
LT
617 goto unlink_int_urb;
618 }
619 status = ti_command_out_sync(tdev, TI_PURGE_PORT,
620 (__u8)(TI_UART1_PORT + port_number), TI_PURGE_OUTPUT, NULL, 0);
621 if (status) {
a30fa793
AC
622 dev_err(&port->dev, "%s - cannot clear output buffers, %d\n",
623 __func__, status);
1da177e4
LT
624 goto unlink_int_urb;
625 }
626
627 /* reset the data toggle on the bulk endpoints to work around bug in
628 * host controllers where things get out of sync some times */
629 usb_clear_halt(dev, port->write_urb->pipe);
630 usb_clear_halt(dev, port->read_urb->pipe);
631
95da310e
AC
632 if (tty)
633 ti_set_termios(tty, port, tty->termios);
1da177e4 634
441b62c1 635 dbg("%s - sending TI_OPEN_PORT (2)", __func__);
1da177e4
LT
636 status = ti_command_out_sync(tdev, TI_OPEN_PORT,
637 (__u8)(TI_UART1_PORT + port_number), open_settings, NULL, 0);
638 if (status) {
a30fa793
AC
639 dev_err(&port->dev, "%s - cannot send open command (2), %d\n",
640 __func__, status);
1da177e4
LT
641 goto unlink_int_urb;
642 }
643
441b62c1 644 dbg("%s - sending TI_START_PORT (2)", __func__);
1da177e4
LT
645 status = ti_command_out_sync(tdev, TI_START_PORT,
646 (__u8)(TI_UART1_PORT + port_number), 0, NULL, 0);
647 if (status) {
a30fa793
AC
648 dev_err(&port->dev, "%s - cannot send start command (2), %d\n",
649 __func__, status);
1da177e4
LT
650 goto unlink_int_urb;
651 }
652
653 /* start read urb */
441b62c1 654 dbg("%s - start read urb", __func__);
1da177e4
LT
655 urb = port->read_urb;
656 if (!urb) {
441b62c1 657 dev_err(&port->dev, "%s - no read urb\n", __func__);
1da177e4
LT
658 status = -EINVAL;
659 goto unlink_int_urb;
660 }
661 tport->tp_read_urb_state = TI_READ_URB_RUNNING;
662 urb->complete = ti_bulk_in_callback;
663 urb->context = tport;
664 urb->dev = dev;
665 status = usb_submit_urb(urb, GFP_KERNEL);
666 if (status) {
a30fa793
AC
667 dev_err(&port->dev, "%s - submit read urb failed, %d\n",
668 __func__, status);
1da177e4
LT
669 goto unlink_int_urb;
670 }
671
672 tport->tp_is_open = 1;
673 ++tdev->td_open_port_count;
674
9da0068a 675 goto release_lock;
1da177e4
LT
676
677unlink_int_urb:
678 if (tdev->td_open_port_count == 0)
679 usb_kill_urb(port->serial->port[0]->interrupt_in_urb);
9da0068a
MK
680release_lock:
681 mutex_unlock(&tdev->td_open_close_lock);
441b62c1 682 dbg("%s - exit %d", __func__, status);
1da177e4
LT
683 return status;
684}
685
686
95da310e
AC
687static void ti_close(struct tty_struct *tty, struct usb_serial_port *port,
688 struct file *file)
1da177e4
LT
689{
690 struct ti_device *tdev;
691 struct ti_port *tport;
692 int port_number;
693 int status;
9da0068a 694 int do_unlock;
1da177e4 695
441b62c1 696 dbg("%s - port %d", __func__, port->number);
a30fa793 697
1da177e4
LT
698 tdev = usb_get_serial_data(port->serial);
699 tport = usb_get_serial_port_data(port);
700 if (tdev == NULL || tport == NULL)
701 return;
702
703 tport->tp_is_open = 0;
704
705 ti_drain(tport, (tport->tp_closing_wait*HZ)/100, 1);
706
707 usb_kill_urb(port->read_urb);
708 usb_kill_urb(port->write_urb);
709 tport->tp_write_urb_in_use = 0;
710
711 port_number = port->number - port->serial->minor;
712
441b62c1 713 dbg("%s - sending TI_CLOSE_PORT", __func__);
1da177e4
LT
714 status = ti_command_out_sync(tdev, TI_CLOSE_PORT,
715 (__u8)(TI_UART1_PORT + port_number), 0, NULL, 0);
716 if (status)
a30fa793
AC
717 dev_err(&port->dev,
718 "%s - cannot send close port command, %d\n"
719 , __func__, status);
1da177e4 720
9da0068a
MK
721 /* if mutex_lock is interrupted, continue anyway */
722 do_unlock = !mutex_lock_interruptible(&tdev->td_open_close_lock);
1da177e4
LT
723 --tport->tp_tdev->td_open_port_count;
724 if (tport->tp_tdev->td_open_port_count <= 0) {
725 /* last port is closed, shut down interrupt urb */
726 usb_kill_urb(port->serial->port[0]->interrupt_in_urb);
727 tport->tp_tdev->td_open_port_count = 0;
728 }
9da0068a
MK
729 if (do_unlock)
730 mutex_unlock(&tdev->td_open_close_lock);
1da177e4 731
441b62c1 732 dbg("%s - exit", __func__);
1da177e4
LT
733}
734
735
95da310e
AC
736static int ti_write(struct tty_struct *tty, struct usb_serial_port *port,
737 const unsigned char *data, int count)
1da177e4
LT
738{
739 struct ti_port *tport = usb_get_serial_port_data(port);
740 unsigned long flags;
741
441b62c1 742 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
743
744 if (count == 0) {
441b62c1 745 dbg("%s - write request of 0 bytes", __func__);
1da177e4
LT
746 return 0;
747 }
748
749 if (tport == NULL || !tport->tp_is_open)
750 return -ENODEV;
751
752 spin_lock_irqsave(&tport->tp_lock, flags);
753 count = ti_buf_put(tport->tp_write_buf, data, count);
754 spin_unlock_irqrestore(&tport->tp_lock, flags);
755
756 ti_send(tport);
757
758 return count;
759}
760
761
95da310e 762static int ti_write_room(struct tty_struct *tty)
1da177e4 763{
95da310e 764 struct usb_serial_port *port = tty->driver_data;
1da177e4
LT
765 struct ti_port *tport = usb_get_serial_port_data(port);
766 int room = 0;
767 unsigned long flags;
768
441b62c1 769 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
770
771 if (tport == NULL)
772 return -ENODEV;
a30fa793 773
1da177e4
LT
774 spin_lock_irqsave(&tport->tp_lock, flags);
775 room = ti_buf_space_avail(tport->tp_write_buf);
776 spin_unlock_irqrestore(&tport->tp_lock, flags);
777
441b62c1 778 dbg("%s - returns %d", __func__, room);
1da177e4
LT
779 return room;
780}
781
782
95da310e 783static int ti_chars_in_buffer(struct tty_struct *tty)
1da177e4 784{
95da310e 785 struct usb_serial_port *port = tty->driver_data;
1da177e4
LT
786 struct ti_port *tport = usb_get_serial_port_data(port);
787 int chars = 0;
788 unsigned long flags;
789
441b62c1 790 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
791
792 if (tport == NULL)
793 return -ENODEV;
794
795 spin_lock_irqsave(&tport->tp_lock, flags);
796 chars = ti_buf_data_avail(tport->tp_write_buf);
797 spin_unlock_irqrestore(&tport->tp_lock, flags);
798
441b62c1 799 dbg("%s - returns %d", __func__, chars);
1da177e4
LT
800 return chars;
801}
802
803
95da310e 804static void ti_throttle(struct tty_struct *tty)
1da177e4 805{
95da310e 806 struct usb_serial_port *port = tty->driver_data;
1da177e4 807 struct ti_port *tport = usb_get_serial_port_data(port);
1da177e4 808
441b62c1 809 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
810
811 if (tport == NULL)
812 return;
813
1da177e4
LT
814 if (I_IXOFF(tty) || C_CRTSCTS(tty))
815 ti_stop_read(tport, tty);
816
817}
818
819
95da310e 820static void ti_unthrottle(struct tty_struct *tty)
1da177e4 821{
95da310e 822 struct usb_serial_port *port = tty->driver_data;
1da177e4 823 struct ti_port *tport = usb_get_serial_port_data(port);
1da177e4
LT
824 int status;
825
441b62c1 826 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
827
828 if (tport == NULL)
829 return;
830
1da177e4
LT
831 if (I_IXOFF(tty) || C_CRTSCTS(tty)) {
832 status = ti_restart_read(tport, tty);
833 if (status)
a30fa793
AC
834 dev_err(&port->dev, "%s - cannot restart read, %d\n",
835 __func__, status);
1da177e4
LT
836 }
837}
838
839
95da310e 840static int ti_ioctl(struct tty_struct *tty, struct file *file,
1da177e4
LT
841 unsigned int cmd, unsigned long arg)
842{
95da310e 843 struct usb_serial_port *port = tty->driver_data;
1da177e4
LT
844 struct ti_port *tport = usb_get_serial_port_data(port);
845 struct async_icount cnow;
846 struct async_icount cprev;
847
441b62c1 848 dbg("%s - port %d, cmd = 0x%04X", __func__, port->number, cmd);
1da177e4
LT
849
850 if (tport == NULL)
851 return -ENODEV;
852
853 switch (cmd) {
a30fa793
AC
854 case TIOCGSERIAL:
855 dbg("%s - (%d) TIOCGSERIAL", __func__, port->number);
856 return ti_get_serial_info(tport,
857 (struct serial_struct __user *)arg);
858 case TIOCSSERIAL:
859 dbg("%s - (%d) TIOCSSERIAL", __func__, port->number);
4a90f09b
AC
860 return ti_set_serial_info(tty, tport,
861 (struct serial_struct __user *)arg);
a30fa793
AC
862 case TIOCMIWAIT:
863 dbg("%s - (%d) TIOCMIWAIT", __func__, port->number);
864 cprev = tport->tp_icount;
865 while (1) {
866 interruptible_sleep_on(&tport->tp_msr_wait);
867 if (signal_pending(current))
868 return -ERESTARTSYS;
869 cnow = tport->tp_icount;
870 if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
871 cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
872 return -EIO; /* no change => error */
873 if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
874 ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
875 ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
876 ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)))
877 return 0;
878 cprev = cnow;
879 }
880 break;
881 case TIOCGICOUNT:
882 dbg("%s - (%d) TIOCGICOUNT RX=%d, TX=%d",
883 __func__, port->number,
884 tport->tp_icount.rx, tport->tp_icount.tx);
885 if (copy_to_user((void __user *)arg, &tport->tp_icount,
886 sizeof(tport->tp_icount)))
887 return -EFAULT;
888 return 0;
1da177e4 889 }
1da177e4
LT
890 return -ENOIOCTLCMD;
891}
892
893
95da310e
AC
894static void ti_set_termios(struct tty_struct *tty,
895 struct usb_serial_port *port, struct ktermios *old_termios)
1da177e4
LT
896{
897 struct ti_port *tport = usb_get_serial_port_data(port);
1da177e4 898 struct ti_uart_config *config;
a30fa793 899 tcflag_t cflag, iflag;
1da177e4
LT
900 int baud;
901 int status;
902 int port_number = port->number - port->serial->minor;
903 unsigned int mcr;
904
441b62c1 905 dbg("%s - port %d", __func__, port->number);
1da177e4 906
1da177e4
LT
907 cflag = tty->termios->c_cflag;
908 iflag = tty->termios->c_iflag;
909
441b62c1 910 dbg("%s - cflag %08x, iflag %08x", __func__, cflag, iflag);
a30fa793
AC
911 dbg("%s - old clfag %08x, old iflag %08x", __func__,
912 old_termios->c_cflag, old_termios->c_iflag);
1da177e4
LT
913
914 if (tport == NULL)
915 return;
916
917 config = kmalloc(sizeof(*config), GFP_KERNEL);
918 if (!config) {
441b62c1 919 dev_err(&port->dev, "%s - out of memory\n", __func__);
1da177e4
LT
920 return;
921 }
922
923 config->wFlags = 0;
924
925 /* these flags must be set */
926 config->wFlags |= TI_UART_ENABLE_MS_INTS;
927 config->wFlags |= TI_UART_ENABLE_AUTO_START_DMA;
928 config->bUartMode = (__u8)(tport->tp_uart_mode);
929
930 switch (cflag & CSIZE) {
a30fa793
AC
931 case CS5:
932 config->bDataBits = TI_UART_5_DATA_BITS;
933 break;
934 case CS6:
935 config->bDataBits = TI_UART_6_DATA_BITS;
936 break;
937 case CS7:
938 config->bDataBits = TI_UART_7_DATA_BITS;
939 break;
940 default:
941 case CS8:
942 config->bDataBits = TI_UART_8_DATA_BITS;
943 break;
1da177e4
LT
944 }
945
537699ef
AC
946 /* CMSPAR isn't supported by this driver */
947 tty->termios->c_cflag &= ~CMSPAR;
948
1da177e4
LT
949 if (cflag & PARENB) {
950 if (cflag & PARODD) {
951 config->wFlags |= TI_UART_ENABLE_PARITY_CHECKING;
952 config->bParity = TI_UART_ODD_PARITY;
953 } else {
954 config->wFlags |= TI_UART_ENABLE_PARITY_CHECKING;
955 config->bParity = TI_UART_EVEN_PARITY;
956 }
957 } else {
958 config->wFlags &= ~TI_UART_ENABLE_PARITY_CHECKING;
a30fa793 959 config->bParity = TI_UART_NO_PARITY;
1da177e4
LT
960 }
961
962 if (cflag & CSTOPB)
963 config->bStopBits = TI_UART_2_STOP_BITS;
964 else
965 config->bStopBits = TI_UART_1_STOP_BITS;
966
967 if (cflag & CRTSCTS) {
968 /* RTS flow control must be off to drop RTS for baud rate B0 */
969 if ((cflag & CBAUD) != B0)
970 config->wFlags |= TI_UART_ENABLE_RTS_IN;
971 config->wFlags |= TI_UART_ENABLE_CTS_OUT;
972 } else {
973 tty->hw_stopped = 0;
974 ti_restart_read(tport, tty);
975 }
976
977 if (I_IXOFF(tty) || I_IXON(tty)) {
978 config->cXon = START_CHAR(tty);
979 config->cXoff = STOP_CHAR(tty);
980
981 if (I_IXOFF(tty))
982 config->wFlags |= TI_UART_ENABLE_X_IN;
983 else
984 ti_restart_read(tport, tty);
985
986 if (I_IXON(tty))
987 config->wFlags |= TI_UART_ENABLE_X_OUT;
988 }
989
990 baud = tty_get_baud_rate(tty);
537699ef
AC
991 if (!baud)
992 baud = 9600;
1da177e4
LT
993 if (tport->tp_tdev->td_is_3410)
994 config->wBaudRate = (__u16)((923077 + baud/2) / baud);
995 else
996 config->wBaudRate = (__u16)((461538 + baud/2) / baud);
997
537699ef
AC
998 /* FIXME: Should calculate resulting baud here and report it back */
999 if ((cflag & CBAUD) != B0)
1000 tty_encode_baud_rate(tty, baud, baud);
1001
1da177e4 1002 dbg("%s - BaudRate=%d, wBaudRate=%d, wFlags=0x%04X, bDataBits=%d, bParity=%d, bStopBits=%d, cXon=%d, cXoff=%d, bUartMode=%d",
441b62c1 1003 __func__, baud, config->wBaudRate, config->wFlags, config->bDataBits, config->bParity, config->bStopBits, config->cXon, config->cXoff, config->bUartMode);
1da177e4
LT
1004
1005 cpu_to_be16s(&config->wBaudRate);
1006 cpu_to_be16s(&config->wFlags);
1007
1008 status = ti_command_out_sync(tport->tp_tdev, TI_SET_CONFIG,
1009 (__u8)(TI_UART1_PORT + port_number), 0, (__u8 *)config,
1010 sizeof(*config));
1011 if (status)
a30fa793
AC
1012 dev_err(&port->dev, "%s - cannot set config on port %d, %d\n",
1013 __func__, port_number, status);
1da177e4
LT
1014
1015 /* SET_CONFIG asserts RTS and DTR, reset them correctly */
1016 mcr = tport->tp_shadow_mcr;
1017 /* if baud rate is B0, clear RTS and DTR */
1018 if ((cflag & CBAUD) == B0)
1019 mcr &= ~(TI_MCR_DTR | TI_MCR_RTS);
1020 status = ti_set_mcr(tport, mcr);
1021 if (status)
a30fa793
AC
1022 dev_err(&port->dev,
1023 "%s - cannot set modem control on port %d, %d\n",
1024 __func__, port_number, status);
1da177e4
LT
1025
1026 kfree(config);
1027}
1028
1029
95da310e 1030static int ti_tiocmget(struct tty_struct *tty, struct file *file)
1da177e4 1031{
95da310e 1032 struct usb_serial_port *port = tty->driver_data;
1da177e4
LT
1033 struct ti_port *tport = usb_get_serial_port_data(port);
1034 unsigned int result;
1035 unsigned int msr;
1036 unsigned int mcr;
04ca89d4 1037 unsigned long flags;
1da177e4 1038
441b62c1 1039 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
1040
1041 if (tport == NULL)
1042 return -ENODEV;
1043
04ca89d4 1044 spin_lock_irqsave(&tport->tp_lock, flags);
1da177e4
LT
1045 msr = tport->tp_msr;
1046 mcr = tport->tp_shadow_mcr;
04ca89d4 1047 spin_unlock_irqrestore(&tport->tp_lock, flags);
1da177e4
LT
1048
1049 result = ((mcr & TI_MCR_DTR) ? TIOCM_DTR : 0)
1050 | ((mcr & TI_MCR_RTS) ? TIOCM_RTS : 0)
1051 | ((mcr & TI_MCR_LOOP) ? TIOCM_LOOP : 0)
1052 | ((msr & TI_MSR_CTS) ? TIOCM_CTS : 0)
1053 | ((msr & TI_MSR_CD) ? TIOCM_CAR : 0)
1054 | ((msr & TI_MSR_RI) ? TIOCM_RI : 0)
1055 | ((msr & TI_MSR_DSR) ? TIOCM_DSR : 0);
1056
441b62c1 1057 dbg("%s - 0x%04X", __func__, result);
1da177e4
LT
1058
1059 return result;
1060}
1061
1062
95da310e 1063static int ti_tiocmset(struct tty_struct *tty, struct file *file,
1da177e4
LT
1064 unsigned int set, unsigned int clear)
1065{
95da310e 1066 struct usb_serial_port *port = tty->driver_data;
1da177e4
LT
1067 struct ti_port *tport = usb_get_serial_port_data(port);
1068 unsigned int mcr;
04ca89d4 1069 unsigned long flags;
1da177e4 1070
441b62c1 1071 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
1072
1073 if (tport == NULL)
1074 return -ENODEV;
1075
04ca89d4 1076 spin_lock_irqsave(&tport->tp_lock, flags);
1da177e4
LT
1077 mcr = tport->tp_shadow_mcr;
1078
1079 if (set & TIOCM_RTS)
1080 mcr |= TI_MCR_RTS;
1081 if (set & TIOCM_DTR)
1082 mcr |= TI_MCR_DTR;
1083 if (set & TIOCM_LOOP)
1084 mcr |= TI_MCR_LOOP;
1085
1086 if (clear & TIOCM_RTS)
1087 mcr &= ~TI_MCR_RTS;
1088 if (clear & TIOCM_DTR)
1089 mcr &= ~TI_MCR_DTR;
1090 if (clear & TIOCM_LOOP)
1091 mcr &= ~TI_MCR_LOOP;
04ca89d4 1092 spin_unlock_irqrestore(&tport->tp_lock, flags);
1da177e4
LT
1093
1094 return ti_set_mcr(tport, mcr);
1095}
1096
1097
95da310e 1098static void ti_break(struct tty_struct *tty, int break_state)
1da177e4 1099{
95da310e 1100 struct usb_serial_port *port = tty->driver_data;
1da177e4
LT
1101 struct ti_port *tport = usb_get_serial_port_data(port);
1102 int status;
1103
441b62c1 1104 dbg("%s - state = %d", __func__, break_state);
1da177e4
LT
1105
1106 if (tport == NULL)
1107 return;
1108
1109 ti_drain(tport, (tport->tp_closing_wait*HZ)/100, 0);
1110
1111 status = ti_write_byte(tport->tp_tdev,
1112 tport->tp_uart_base_addr + TI_UART_OFFSET_LCR,
1113 TI_LCR_BREAK, break_state == -1 ? TI_LCR_BREAK : 0);
1114
1115 if (status)
441b62c1 1116 dbg("%s - error setting break, %d", __func__, status);
1da177e4
LT
1117}
1118
1119
7d12e780 1120static void ti_interrupt_callback(struct urb *urb)
1da177e4 1121{
cdc97792 1122 struct ti_device *tdev = urb->context;
1da177e4
LT
1123 struct usb_serial_port *port;
1124 struct usb_serial *serial = tdev->td_serial;
1125 struct ti_port *tport;
1126 struct device *dev = &urb->dev->dev;
1127 unsigned char *data = urb->transfer_buffer;
1128 int length = urb->actual_length;
1129 int port_number;
1130 int function;
52171b48
GKH
1131 int status = urb->status;
1132 int retval;
1da177e4
LT
1133 __u8 msr;
1134
441b62c1 1135 dbg("%s", __func__);
1da177e4 1136
52171b48 1137 switch (status) {
1da177e4
LT
1138 case 0:
1139 break;
1140 case -ECONNRESET:
1141 case -ENOENT:
1142 case -ESHUTDOWN:
441b62c1 1143 dbg("%s - urb shutting down, %d", __func__, status);
1da177e4
LT
1144 tdev->td_urb_error = 1;
1145 return;
1146 default:
52171b48 1147 dev_err(dev, "%s - nonzero urb status, %d\n",
441b62c1 1148 __func__, status);
1da177e4
LT
1149 tdev->td_urb_error = 1;
1150 goto exit;
1151 }
1152
1153 if (length != 2) {
441b62c1 1154 dbg("%s - bad packet size, %d", __func__, length);
1da177e4
LT
1155 goto exit;
1156 }
1157
1158 if (data[0] == TI_CODE_HARDWARE_ERROR) {
441b62c1 1159 dev_err(dev, "%s - hardware error, %d\n", __func__, data[1]);
1da177e4
LT
1160 goto exit;
1161 }
1162
1163 port_number = TI_GET_PORT_FROM_CODE(data[0]);
1164 function = TI_GET_FUNC_FROM_CODE(data[0]);
1165
a30fa793
AC
1166 dbg("%s - port_number %d, function %d, data 0x%02X",
1167 __func__, port_number, function, data[1]);
1da177e4
LT
1168
1169 if (port_number >= serial->num_ports) {
a30fa793
AC
1170 dev_err(dev, "%s - bad port number, %d\n",
1171 __func__, port_number);
1da177e4
LT
1172 goto exit;
1173 }
1174
1175 port = serial->port[port_number];
1176
1177 tport = usb_get_serial_port_data(port);
1178 if (!tport)
1179 goto exit;
1180
1181 switch (function) {
1182 case TI_CODE_DATA_ERROR:
a30fa793
AC
1183 dev_err(dev, "%s - DATA ERROR, port %d, data 0x%02X\n",
1184 __func__, port_number, data[1]);
1da177e4
LT
1185 break;
1186
1187 case TI_CODE_MODEM_STATUS:
1188 msr = data[1];
441b62c1 1189 dbg("%s - port %d, msr 0x%02X", __func__, port_number, msr);
1da177e4
LT
1190 ti_handle_new_msr(tport, msr);
1191 break;
1192
1193 default:
a30fa793
AC
1194 dev_err(dev, "%s - unknown interrupt code, 0x%02X\n",
1195 __func__, data[1]);
1da177e4
LT
1196 break;
1197 }
1198
1199exit:
52171b48
GKH
1200 retval = usb_submit_urb(urb, GFP_ATOMIC);
1201 if (retval)
1202 dev_err(dev, "%s - resubmit interrupt urb failed, %d\n",
441b62c1 1203 __func__, retval);
1da177e4
LT
1204}
1205
1206
7d12e780 1207static void ti_bulk_in_callback(struct urb *urb)
1da177e4 1208{
cdc97792 1209 struct ti_port *tport = urb->context;
1da177e4
LT
1210 struct usb_serial_port *port = tport->tp_port;
1211 struct device *dev = &urb->dev->dev;
52171b48
GKH
1212 int status = urb->status;
1213 int retval = 0;
4a90f09b 1214 struct tty_struct *tty;
1da177e4 1215
441b62c1 1216 dbg("%s", __func__);
1da177e4 1217
52171b48 1218 switch (status) {
1da177e4
LT
1219 case 0:
1220 break;
1221 case -ECONNRESET:
1222 case -ENOENT:
1223 case -ESHUTDOWN:
441b62c1 1224 dbg("%s - urb shutting down, %d", __func__, status);
1da177e4
LT
1225 tport->tp_tdev->td_urb_error = 1;
1226 wake_up_interruptible(&tport->tp_write_wait);
1227 return;
1228 default:
52171b48 1229 dev_err(dev, "%s - nonzero urb status, %d\n",
a30fa793 1230 __func__, status);
1da177e4
LT
1231 tport->tp_tdev->td_urb_error = 1;
1232 wake_up_interruptible(&tport->tp_write_wait);
1233 }
1234
52171b48 1235 if (status == -EPIPE)
1da177e4
LT
1236 goto exit;
1237
52171b48 1238 if (status) {
441b62c1 1239 dev_err(dev, "%s - stopping read!\n", __func__);
1da177e4
LT
1240 return;
1241 }
1242
4a90f09b
AC
1243 tty = tty_port_tty_get(&port->port);
1244 if (tty && urb->actual_length) {
441b62c1 1245 usb_serial_debug_data(debug, dev, __func__,
1da177e4
LT
1246 urb->actual_length, urb->transfer_buffer);
1247
1248 if (!tport->tp_is_open)
441b62c1 1249 dbg("%s - port closed, dropping data", __func__);
1da177e4 1250 else
4a90f09b 1251 ti_recv(&urb->dev->dev, tty,
a30fa793
AC
1252 urb->transfer_buffer,
1253 urb->actual_length);
1da177e4
LT
1254
1255 spin_lock(&tport->tp_lock);
1256 tport->tp_icount.rx += urb->actual_length;
1257 spin_unlock(&tport->tp_lock);
4a90f09b 1258 tty_kref_put(tty);
1da177e4
LT
1259 }
1260
1261exit:
1262 /* continue to read unless stopping */
1263 spin_lock(&tport->tp_lock);
1264 if (tport->tp_read_urb_state == TI_READ_URB_RUNNING) {
1265 urb->dev = port->serial->dev;
52171b48 1266 retval = usb_submit_urb(urb, GFP_ATOMIC);
1da177e4
LT
1267 } else if (tport->tp_read_urb_state == TI_READ_URB_STOPPING) {
1268 tport->tp_read_urb_state = TI_READ_URB_STOPPED;
1269 }
1270 spin_unlock(&tport->tp_lock);
52171b48
GKH
1271 if (retval)
1272 dev_err(dev, "%s - resubmit read urb failed, %d\n",
441b62c1 1273 __func__, retval);
1da177e4
LT
1274}
1275
1276
7d12e780 1277static void ti_bulk_out_callback(struct urb *urb)
1da177e4 1278{
cdc97792 1279 struct ti_port *tport = urb->context;
1da177e4
LT
1280 struct usb_serial_port *port = tport->tp_port;
1281 struct device *dev = &urb->dev->dev;
52171b48 1282 int status = urb->status;
1da177e4 1283
441b62c1 1284 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
1285
1286 tport->tp_write_urb_in_use = 0;
1287
52171b48 1288 switch (status) {
1da177e4
LT
1289 case 0:
1290 break;
1291 case -ECONNRESET:
1292 case -ENOENT:
1293 case -ESHUTDOWN:
441b62c1 1294 dbg("%s - urb shutting down, %d", __func__, status);
1da177e4
LT
1295 tport->tp_tdev->td_urb_error = 1;
1296 wake_up_interruptible(&tport->tp_write_wait);
1297 return;
1298 default:
52171b48 1299 dev_err(dev, "%s - nonzero urb status, %d\n",
441b62c1 1300 __func__, status);
1da177e4
LT
1301 tport->tp_tdev->td_urb_error = 1;
1302 wake_up_interruptible(&tport->tp_write_wait);
1303 }
1304
1305 /* send any buffered data */
1306 ti_send(tport);
1307}
1308
1309
1310static void ti_recv(struct device *dev, struct tty_struct *tty,
1311 unsigned char *data, int length)
1312{
1313 int cnt;
1314
1315 do {
33f0f88f
AC
1316 cnt = tty_buffer_request_room(tty, length);
1317 if (cnt < length) {
a30fa793
AC
1318 dev_err(dev, "%s - dropping data, %d bytes lost\n",
1319 __func__, length - cnt);
1320 if (cnt == 0)
33f0f88f 1321 break;
1da177e4 1322 }
33f0f88f
AC
1323 tty_insert_flip_string(tty, data, cnt);
1324 tty_flip_buffer_push(tty);
1da177e4
LT
1325 data += cnt;
1326 length -= cnt;
1327 } while (length > 0);
1328
1da177e4
LT
1329}
1330
1331
1332static void ti_send(struct ti_port *tport)
1333{
1334 int count, result;
1335 struct usb_serial_port *port = tport->tp_port;
4a90f09b 1336 struct tty_struct *tty = tty_port_tty_get(&port->port); /* FIXME */
1da177e4
LT
1337 unsigned long flags;
1338
1339
441b62c1 1340 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
1341
1342 spin_lock_irqsave(&tport->tp_lock, flags);
1343
4a90f09b
AC
1344 if (tport->tp_write_urb_in_use)
1345 goto unlock;
1da177e4
LT
1346
1347 count = ti_buf_get(tport->tp_write_buf,
1348 port->write_urb->transfer_buffer,
1349 port->bulk_out_size);
1350
4a90f09b
AC
1351 if (count == 0)
1352 goto unlock;
1da177e4
LT
1353
1354 tport->tp_write_urb_in_use = 1;
1355
1356 spin_unlock_irqrestore(&tport->tp_lock, flags);
1357
a30fa793
AC
1358 usb_serial_debug_data(debug, &port->dev, __func__, count,
1359 port->write_urb->transfer_buffer);
1da177e4
LT
1360
1361 usb_fill_bulk_urb(port->write_urb, port->serial->dev,
1362 usb_sndbulkpipe(port->serial->dev,
1363 port->bulk_out_endpointAddress),
1364 port->write_urb->transfer_buffer, count,
1365 ti_bulk_out_callback, tport);
1366
1367 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
1368 if (result) {
a30fa793
AC
1369 dev_err(&port->dev, "%s - submit write urb failed, %d\n",
1370 __func__, result);
1371 tport->tp_write_urb_in_use = 0;
1da177e4
LT
1372 /* TODO: reschedule ti_send */
1373 } else {
1374 spin_lock_irqsave(&tport->tp_lock, flags);
1375 tport->tp_icount.tx += count;
1376 spin_unlock_irqrestore(&tport->tp_lock, flags);
1377 }
1378
1379 /* more room in the buffer for new writes, wakeup */
1380 if (tty)
1381 tty_wakeup(tty);
4a90f09b 1382 tty_kref_put(tty);
1da177e4 1383 wake_up_interruptible(&tport->tp_write_wait);
4a90f09b
AC
1384 return;
1385unlock:
1386 spin_unlock_irqrestore(&tport->tp_lock, flags);
1387 tty_kref_put(tty);
1388 return;
1da177e4
LT
1389}
1390
1391
1392static int ti_set_mcr(struct ti_port *tport, unsigned int mcr)
1393{
04ca89d4 1394 unsigned long flags;
1da177e4
LT
1395 int status;
1396
1397 status = ti_write_byte(tport->tp_tdev,
1398 tport->tp_uart_base_addr + TI_UART_OFFSET_MCR,
1399 TI_MCR_RTS | TI_MCR_DTR | TI_MCR_LOOP, mcr);
1400
04ca89d4 1401 spin_lock_irqsave(&tport->tp_lock, flags);
1da177e4
LT
1402 if (!status)
1403 tport->tp_shadow_mcr = mcr;
04ca89d4 1404 spin_unlock_irqrestore(&tport->tp_lock, flags);
1da177e4
LT
1405
1406 return status;
1407}
1408
1409
1410static int ti_get_lsr(struct ti_port *tport)
1411{
a30fa793 1412 int size, status;
1da177e4
LT
1413 struct ti_device *tdev = tport->tp_tdev;
1414 struct usb_serial_port *port = tport->tp_port;
1415 int port_number = port->number - port->serial->minor;
1416 struct ti_port_status *data;
1417
441b62c1 1418 dbg("%s - port %d", __func__, port->number);
1da177e4
LT
1419
1420 size = sizeof(struct ti_port_status);
1421 data = kmalloc(size, GFP_KERNEL);
1422 if (!data) {
441b62c1 1423 dev_err(&port->dev, "%s - out of memory\n", __func__);
1da177e4
LT
1424 return -ENOMEM;
1425 }
1426
1427 status = ti_command_in_sync(tdev, TI_GET_PORT_STATUS,
1428 (__u8)(TI_UART1_PORT+port_number), 0, (__u8 *)data, size);
1429 if (status) {
a30fa793
AC
1430 dev_err(&port->dev,
1431 "%s - get port status command failed, %d\n",
1432 __func__, status);
1da177e4
LT
1433 goto free_data;
1434 }
1435
441b62c1 1436 dbg("%s - lsr 0x%02X", __func__, data->bLSR);
1da177e4
LT
1437
1438 tport->tp_lsr = data->bLSR;
1439
1440free_data:
1441 kfree(data);
1442 return status;
1443}
1444
1445
1446static int ti_get_serial_info(struct ti_port *tport,
1447 struct serial_struct __user *ret_arg)
1448{
1449 struct usb_serial_port *port = tport->tp_port;
1450 struct serial_struct ret_serial;
1451
1452 if (!ret_arg)
1453 return -EFAULT;
1454
1455 memset(&ret_serial, 0, sizeof(ret_serial));
1456
1457 ret_serial.type = PORT_16550A;
1458 ret_serial.line = port->serial->minor;
1459 ret_serial.port = port->number - port->serial->minor;
1460 ret_serial.flags = tport->tp_flags;
1461 ret_serial.xmit_fifo_size = TI_WRITE_BUF_SIZE;
1462 ret_serial.baud_base = tport->tp_tdev->td_is_3410 ? 921600 : 460800;
1463 ret_serial.closing_wait = tport->tp_closing_wait;
1464
1465 if (copy_to_user(ret_arg, &ret_serial, sizeof(*ret_arg)))
1466 return -EFAULT;
1467
1468 return 0;
1469}
1470
1471
4a90f09b 1472static int ti_set_serial_info(struct tty_struct *tty, struct ti_port *tport,
1da177e4
LT
1473 struct serial_struct __user *new_arg)
1474{
1da177e4
LT
1475 struct serial_struct new_serial;
1476
1477 if (copy_from_user(&new_serial, new_arg, sizeof(new_serial)))
1478 return -EFAULT;
1479
1480 tport->tp_flags = new_serial.flags & TI_SET_SERIAL_FLAGS;
4a90f09b 1481 tty->low_latency = (tport->tp_flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1da177e4
LT
1482 tport->tp_closing_wait = new_serial.closing_wait;
1483
1484 return 0;
1485}
1486
1487
1488static void ti_handle_new_msr(struct ti_port *tport, __u8 msr)
1489{
1490 struct async_icount *icount;
1491 struct tty_struct *tty;
1492 unsigned long flags;
1493
441b62c1 1494 dbg("%s - msr 0x%02X", __func__, msr);
1da177e4
LT
1495
1496 if (msr & TI_MSR_DELTA_MASK) {
1497 spin_lock_irqsave(&tport->tp_lock, flags);
1498 icount = &tport->tp_icount;
1499 if (msr & TI_MSR_DELTA_CTS)
1500 icount->cts++;
1501 if (msr & TI_MSR_DELTA_DSR)
1502 icount->dsr++;
1503 if (msr & TI_MSR_DELTA_CD)
1504 icount->dcd++;
1505 if (msr & TI_MSR_DELTA_RI)
1506 icount->rng++;
1507 wake_up_interruptible(&tport->tp_msr_wait);
1508 spin_unlock_irqrestore(&tport->tp_lock, flags);
1509 }
1510
1511 tport->tp_msr = msr & TI_MSR_MASK;
1512
1513 /* handle CTS flow control */
4a90f09b 1514 tty = tty_port_tty_get(&tport->tp_port->port);
1da177e4
LT
1515 if (tty && C_CRTSCTS(tty)) {
1516 if (msr & TI_MSR_CTS) {
1517 tty->hw_stopped = 0;
1518 tty_wakeup(tty);
1519 } else {
1520 tty->hw_stopped = 1;
1521 }
1522 }
4a90f09b 1523 tty_kref_put(tty);
1da177e4
LT
1524}
1525
1526
1527static void ti_drain(struct ti_port *tport, unsigned long timeout, int flush)
1528{
1529 struct ti_device *tdev = tport->tp_tdev;
1530 struct usb_serial_port *port = tport->tp_port;
1531 wait_queue_t wait;
1da177e4 1532
441b62c1 1533 dbg("%s - port %d", __func__, port->number);
1da177e4 1534
0915f490 1535 spin_lock_irq(&tport->tp_lock);
1da177e4
LT
1536
1537 /* wait for data to drain from the buffer */
1538 tdev->td_urb_error = 0;
1539 init_waitqueue_entry(&wait, current);
1540 add_wait_queue(&tport->tp_write_wait, &wait);
1541 for (;;) {
1542 set_current_state(TASK_INTERRUPTIBLE);
1543 if (ti_buf_data_avail(tport->tp_write_buf) == 0
1544 || timeout == 0 || signal_pending(current)
1545 || tdev->td_urb_error
0915f490 1546 || port->serial->disconnected) /* disconnect */
1da177e4 1547 break;
0915f490 1548 spin_unlock_irq(&tport->tp_lock);
1da177e4 1549 timeout = schedule_timeout(timeout);
0915f490 1550 spin_lock_irq(&tport->tp_lock);
1da177e4
LT
1551 }
1552 set_current_state(TASK_RUNNING);
1553 remove_wait_queue(&tport->tp_write_wait, &wait);
1554
1555 /* flush any remaining data in the buffer */
1556 if (flush)
1557 ti_buf_clear(tport->tp_write_buf);
1558
0915f490 1559 spin_unlock_irq(&tport->tp_lock);
1da177e4 1560
0915f490 1561 mutex_lock(&port->serial->disc_mutex);
1da177e4
LT
1562 /* wait for data to drain from the device */
1563 /* wait for empty tx register, plus 20 ms */
1564 timeout += jiffies;
1565 tport->tp_lsr &= ~TI_LSR_TX_EMPTY;
1566 while ((long)(jiffies - timeout) < 0 && !signal_pending(current)
1567 && !(tport->tp_lsr&TI_LSR_TX_EMPTY) && !tdev->td_urb_error
0915f490 1568 && !port->serial->disconnected) {
1da177e4
LT
1569 if (ti_get_lsr(tport))
1570 break;
0915f490 1571 mutex_unlock(&port->serial->disc_mutex);
1da177e4 1572 msleep_interruptible(20);
0915f490 1573 mutex_lock(&port->serial->disc_mutex);
1da177e4 1574 }
0915f490 1575 mutex_unlock(&port->serial->disc_mutex);
1da177e4
LT
1576}
1577
1578
1579static void ti_stop_read(struct ti_port *tport, struct tty_struct *tty)
1580{
1581 unsigned long flags;
1582
1583 spin_lock_irqsave(&tport->tp_lock, flags);
1584
1585 if (tport->tp_read_urb_state == TI_READ_URB_RUNNING)
1586 tport->tp_read_urb_state = TI_READ_URB_STOPPING;
1587
1588 spin_unlock_irqrestore(&tport->tp_lock, flags);
1589}
1590
1591
1592static int ti_restart_read(struct ti_port *tport, struct tty_struct *tty)
1593{
1594 struct urb *urb;
1595 int status = 0;
1596 unsigned long flags;
1597
1598 spin_lock_irqsave(&tport->tp_lock, flags);
1599
1600 if (tport->tp_read_urb_state == TI_READ_URB_STOPPED) {
944dc184 1601 tport->tp_read_urb_state = TI_READ_URB_RUNNING;
1da177e4 1602 urb = tport->tp_port->read_urb;
944dc184 1603 spin_unlock_irqrestore(&tport->tp_lock, flags);
1da177e4
LT
1604 urb->complete = ti_bulk_in_callback;
1605 urb->context = tport;
1606 urb->dev = tport->tp_port->serial->dev;
1607 status = usb_submit_urb(urb, GFP_KERNEL);
944dc184
ON
1608 } else {
1609 tport->tp_read_urb_state = TI_READ_URB_RUNNING;
1610 spin_unlock_irqrestore(&tport->tp_lock, flags);
1da177e4 1611 }
1da177e4
LT
1612
1613 return status;
1614}
1615
1616
1617static int ti_command_out_sync(struct ti_device *tdev, __u8 command,
1618 __u16 moduleid, __u16 value, __u8 *data, int size)
1619{
1620 int status;
1621
1622 status = usb_control_msg(tdev->td_serial->dev,
1623 usb_sndctrlpipe(tdev->td_serial->dev, 0), command,
1624 (USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT),
1625 value, moduleid, data, size, 1000);
1626
1627 if (status == size)
1628 status = 0;
1629
1630 if (status > 0)
1631 status = -ECOMM;
1632
1633 return status;
1634}
1635
1636
1637static int ti_command_in_sync(struct ti_device *tdev, __u8 command,
1638 __u16 moduleid, __u16 value, __u8 *data, int size)
1639{
1640 int status;
1641
1642 status = usb_control_msg(tdev->td_serial->dev,
1643 usb_rcvctrlpipe(tdev->td_serial->dev, 0), command,
1644 (USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN),
1645 value, moduleid, data, size, 1000);
1646
1647 if (status == size)
1648 status = 0;
1649
1650 if (status > 0)
1651 status = -ECOMM;
1652
1653 return status;
1654}
1655
1656
1657static int ti_write_byte(struct ti_device *tdev, unsigned long addr,
1658 __u8 mask, __u8 byte)
1659{
1660 int status;
1661 unsigned int size;
1662 struct ti_write_data_bytes *data;
1663 struct device *dev = &tdev->td_serial->dev->dev;
1664
a30fa793
AC
1665 dbg("%s - addr 0x%08lX, mask 0x%02X, byte 0x%02X",
1666 __func__, addr, mask, byte);
1da177e4
LT
1667
1668 size = sizeof(struct ti_write_data_bytes) + 2;
1669 data = kmalloc(size, GFP_KERNEL);
1670 if (!data) {
441b62c1 1671 dev_err(dev, "%s - out of memory\n", __func__);
1da177e4
LT
1672 return -ENOMEM;
1673 }
1674
1675 data->bAddrType = TI_RW_DATA_ADDR_XDATA;
1676 data->bDataType = TI_RW_DATA_BYTE;
1677 data->bDataCounter = 1;
1678 data->wBaseAddrHi = cpu_to_be16(addr>>16);
1679 data->wBaseAddrLo = cpu_to_be16(addr);
1680 data->bData[0] = mask;
1681 data->bData[1] = byte;
1682
1683 status = ti_command_out_sync(tdev, TI_WRITE_DATA, TI_RAM_PORT, 0,
1684 (__u8 *)data, size);
1685
1686 if (status < 0)
441b62c1 1687 dev_err(dev, "%s - failed, %d\n", __func__, status);
1da177e4
LT
1688
1689 kfree(data);
1690
1691 return status;
1692}
1693
95da310e
AC
1694static int ti_do_download(struct usb_device *dev, int pipe,
1695 u8 *buffer, int size)
1da177e4 1696{
1da177e4 1697 int pos;
95da310e 1698 u8 cs = 0;
1da177e4 1699 int done;
1da177e4 1700 struct ti_firmware_header *header;
95da310e
AC
1701 int status;
1702 int len;
a30fa793
AC
1703
1704 for (pos = sizeof(struct ti_firmware_header); pos < size; pos++)
1da177e4
LT
1705 cs = (__u8)(cs + buffer[pos]);
1706
1707 header = (struct ti_firmware_header *)buffer;
a30fa793 1708 header->wLength = cpu_to_le16((__u16)(size
95da310e 1709 - sizeof(struct ti_firmware_header)));
1da177e4
LT
1710 header->bCheckSum = cs;
1711
441b62c1 1712 dbg("%s - downloading firmware", __func__);
95da310e
AC
1713 for (pos = 0; pos < size; pos += done) {
1714 len = min(size - pos, TI_DOWNLOAD_MAX_PACKET_SIZE);
1715 status = usb_bulk_msg(dev, pipe, buffer + pos, len,
1716 &done, 1000);
1da177e4
LT
1717 if (status)
1718 break;
1719 }
95da310e
AC
1720 return status;
1721}
1da177e4 1722
95da310e
AC
1723static int ti_download_firmware(struct ti_device *tdev, int type)
1724{
1725 int status = -ENOMEM;
1726 int buffer_size;
1727 __u8 *buffer;
1728 struct usb_device *dev = tdev->td_serial->dev;
1729 unsigned int pipe = usb_sndbulkpipe(dev,
1730 tdev->td_serial->port[0]->bulk_out_endpointAddress);
1731 const struct firmware *fw_p;
1732 char buf[32];
1733 sprintf(buf, "ti_usb-%d.bin", type);
1da177e4 1734
95da310e
AC
1735 if (request_firmware(&fw_p, buf, &dev->dev)) {
1736 dev_err(&dev->dev, "%s - firmware not found\n", __func__);
1737 return -ENOENT;
1738 }
1739 if (fw_p->size > TI_FIRMWARE_BUF_SIZE) {
1740 dev_err(&dev->dev, "%s - firmware too large\n", __func__);
1741 return -ENOENT;
1742 }
1743
1744 buffer_size = TI_FIRMWARE_BUF_SIZE + sizeof(struct ti_firmware_header);
1745 buffer = kmalloc(buffer_size, GFP_KERNEL);
1746 if (buffer) {
1747 memcpy(buffer, fw_p->data, fw_p->size);
1748 memset(buffer + fw_p->size, 0xff, buffer_size - fw_p->size);
2bcbe4c1 1749 status = ti_do_download(dev, pipe, buffer, fw_p->size);
95da310e
AC
1750 kfree(buffer);
1751 }
1752 release_firmware(fw_p);
1da177e4 1753 if (status) {
a30fa793
AC
1754 dev_err(&dev->dev, "%s - error downloading firmware, %d\n",
1755 __func__, status);
1da177e4
LT
1756 return status;
1757 }
1758
441b62c1 1759 dbg("%s - download successful", __func__);
1da177e4
LT
1760
1761 return 0;
1762}
1763
1764
1765/* Circular Buffer Functions */
1766
1767/*
1768 * ti_buf_alloc
1769 *
1770 * Allocate a circular buffer and all associated memory.
1771 */
1772
1773static struct circ_buf *ti_buf_alloc(void)
1774{
1775 struct circ_buf *cb;
1776
5cbded58 1777 cb = kmalloc(sizeof(struct circ_buf), GFP_KERNEL);
1da177e4
LT
1778 if (cb == NULL)
1779 return NULL;
1780
1781 cb->buf = kmalloc(TI_WRITE_BUF_SIZE, GFP_KERNEL);
1782 if (cb->buf == NULL) {
1783 kfree(cb);
1784 return NULL;
1785 }
1786
1787 ti_buf_clear(cb);
1788
1789 return cb;
1790}
1791
1792
1793/*
1794 * ti_buf_free
1795 *
1796 * Free the buffer and all associated memory.
1797 */
1798
1799static void ti_buf_free(struct circ_buf *cb)
1800{
1801 kfree(cb->buf);
1802 kfree(cb);
1803}
1804
1805
1806/*
1807 * ti_buf_clear
1808 *
1809 * Clear out all data in the circular buffer.
1810 */
1811
1812static void ti_buf_clear(struct circ_buf *cb)
1813{
1814 cb->head = cb->tail = 0;
1815}
1816
1817
1818/*
1819 * ti_buf_data_avail
1820 *
1821 * Return the number of bytes of data available in the circular
1822 * buffer.
1823 */
1824
1825static int ti_buf_data_avail(struct circ_buf *cb)
1826{
a30fa793 1827 return CIRC_CNT(cb->head, cb->tail, TI_WRITE_BUF_SIZE);
1da177e4
LT
1828}
1829
1830
1831/*
1832 * ti_buf_space_avail
1833 *
1834 * Return the number of bytes of space available in the circular
1835 * buffer.
1836 */
1837
1838static int ti_buf_space_avail(struct circ_buf *cb)
1839{
a30fa793 1840 return CIRC_SPACE(cb->head, cb->tail, TI_WRITE_BUF_SIZE);
1da177e4
LT
1841}
1842
1843
1844/*
1845 * ti_buf_put
1846 *
1847 * Copy data data from a user buffer and put it into the circular buffer.
1848 * Restrict to the amount of space available.
1849 *
1850 * Return the number of bytes copied.
1851 */
1852
1853static int ti_buf_put(struct circ_buf *cb, const char *buf, int count)
1854{
1855 int c, ret = 0;
1856
1857 while (1) {
1858 c = CIRC_SPACE_TO_END(cb->head, cb->tail, TI_WRITE_BUF_SIZE);
1859 if (count < c)
1860 c = count;
1861 if (c <= 0)
1862 break;
1863 memcpy(cb->buf + cb->head, buf, c);
1864 cb->head = (cb->head + c) & (TI_WRITE_BUF_SIZE-1);
1865 buf += c;
1866 count -= c;
1867 ret += c;
1868 }
1869
1870 return ret;
1871}
1872
1873
1874/*
1875 * ti_buf_get
1876 *
1877 * Get data from the circular buffer and copy to the given buffer.
1878 * Restrict to the amount of data available.
1879 *
1880 * Return the number of bytes copied.
1881 */
1882
1883static int ti_buf_get(struct circ_buf *cb, char *buf, int count)
1884{
1885 int c, ret = 0;
1886
1887 while (1) {
1888 c = CIRC_CNT_TO_END(cb->head, cb->tail, TI_WRITE_BUF_SIZE);
1889 if (count < c)
1890 c = count;
1891 if (c <= 0)
1892 break;
1893 memcpy(buf, cb->buf + cb->tail, c);
1894 cb->tail = (cb->tail + c) & (TI_WRITE_BUF_SIZE-1);
1895 buf += c;
1896 count -= c;
1897 ret += c;
1898 }
1899
1900 return ret;
1901}
This page took 0.566485 seconds and 5 git commands to generate.