projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
USB: remove unnecessary type casting of urb->context
[linux-2.6-block.git] / drivers / usb / serial / oti6858.c
CommitLineData
49cdee0e
KL		 1/*
2 * Ours Technology Inc. OTi-6858 USB to serial adapter driver.
3 *
4 * Copyleft (C) 2007 Kees Lemmens (adapted for kernel 2.6.20)
5 * Copyright (C) 2006 Tomasz Michal Lukaszewski (FIXME: add e-mail)
6 * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
7 * Copyright (C) 2003 IBM Corp.
8 *
9 * Many thanks to the authors of pl2303 driver: all functions in this file
10 * are heavily based on pl2303 code, buffering code is a 1-to-1 copy.
11 *
12 * Warning! You use this driver on your own risk! The only official
13 * description of this device I have is datasheet from manufacturer,
14 * and it doesn't contain almost any information needed to write a driver.
15 * Almost all knowlegde used while writing this driver was gathered by:
16 * - analyzing traffic between device and the M$ Windows 2000 driver,
17 * - trying different bit combinations and checking pin states
18 * with a voltmeter,
19 * - receiving malformed frames and producing buffer overflows
20 * to learn how errors are reported,
21 * So, THIS CODE CAN DESTROY OTi-6858 AND ANY OTHER DEVICES, THAT ARE
22 * CONNECTED TO IT!
23 *
24 * This program is free software; you can redistribute it and/or modify
25 * it under the terms of the GNU General Public License as published by
26 * the Free Software Foundation; either version 2 of the License.
27 *
28 * See Documentation/usb/usb-serial.txt for more information on using this driver
29 *
30 * TODO:
31 * - implement correct flushing for ioctls and oti6858_close()
32 * - check how errors (rx overflow, parity error, framing error) are reported
33 * - implement oti6858_break_ctl()
34 * - implement more ioctls
35 * - test/implement flow control
36 * - allow setting custom baud rates
37 */
38
39#include <linux/kernel.h>
40#include <linux/errno.h>
41#include <linux/init.h>
42#include <linux/slab.h>
43#include <linux/tty.h>
44#include <linux/tty_driver.h>
45#include <linux/tty_flip.h>
46#include <linux/serial.h>
47#include <linux/module.h>
48#include <linux/moduleparam.h>
49#include <linux/spinlock.h>
50#include <linux/usb.h>
51#include <linux/usb/serial.h>
52#include <asm/uaccess.h>
53#include "oti6858.h"
54
55#define OTI6858_DESCRIPTION \
56 "Ours Technology Inc. OTi-6858 USB to serial adapter driver"
57#define OTI6858_AUTHOR "Tomasz Michal Lukaszewski <FIXME@FIXME>"
58#define OTI6858_VERSION "0.1"
59
60static struct usb_device_id id_table [] = {
61 { USB_DEVICE(OTI6858_VENDOR_ID, OTI6858_PRODUCT_ID) },
62 { }
63};
64
65MODULE_DEVICE_TABLE(usb, id_table);
66
67static struct usb_driver oti6858_driver = {
68 .name = "oti6858",
69 .probe = usb_serial_probe,
70 .disconnect = usb_serial_disconnect,
71 .id_table = id_table,
72 .no_dynamic_id = 1,
73};
74
75static int debug;
76
77
78/* buffering code, copied from pl2303 driver */
79#define PL2303_BUF_SIZE 1024
80#define PL2303_TMP_BUF_SIZE 1024
81
b0a239da 82struct oti6858_buf {
49cdee0e
KL		 83 unsigned int buf_size;
84 char *buf_buf;
85 char *buf_get;
86 char *buf_put;
87};
88
89/* requests */
90#define OTI6858_REQ_GET_STATUS (USB_DIR_IN | USB_TYPE_VENDOR | 0x00)
91#define OTI6858_REQ_T_GET_STATUS 0x01
92
93#define OTI6858_REQ_SET_LINE (USB_DIR_OUT | USB_TYPE_VENDOR | 0x00)
94#define OTI6858_REQ_T_SET_LINE 0x00
95
96#define OTI6858_REQ_CHECK_TXBUFF (USB_DIR_IN | USB_TYPE_VENDOR | 0x01)
97#define OTI6858_REQ_T_CHECK_TXBUFF 0x00
98
99/* format of the control packet */
100struct oti6858_control_pkt {
101 u16 divisor; /* baud rate = 96000000 / (16 * divisor), LE */
102#define OTI6858_MAX_BAUD_RATE 3000000
103 u8 frame_fmt;
104#define FMT_STOP_BITS_MASK 0xc0
105#define FMT_STOP_BITS_1 0x00
106#define FMT_STOP_BITS_2 0x40 /* 1.5 stop bits if FMT_DATA_BITS_5 */
107#define FMT_PARITY_MASK 0x38
108#define FMT_PARITY_NONE 0x00
109#define FMT_PARITY_ODD 0x08
110#define FMT_PARITY_EVEN 0x18
111#define FMT_PARITY_MARK 0x28
112#define FMT_PARITY_SPACE 0x38
113#define FMT_DATA_BITS_MASK 0x03
114#define FMT_DATA_BITS_5 0x00
115#define FMT_DATA_BITS_6 0x01
116#define FMT_DATA_BITS_7 0x02
117#define FMT_DATA_BITS_8 0x03
118 u8 something; /* always equals 0x43 */
119 u8 control; /* settings of flow control lines */
120#define CONTROL_MASK 0x0c
121#define CONTROL_DTR_HIGH 0x08
122#define CONTROL_RTS_HIGH 0x04
123 u8 tx_status;
124#define TX_BUFFER_EMPTIED 0x09
125 u8 pin_state;
126#define PIN_MASK 0x3f
127#define PIN_RTS 0x20 /* output pin */
128#define PIN_CTS 0x10 /* input pin, active low */
129#define PIN_DSR 0x08 /* input pin, active low */
130#define PIN_DTR 0x04 /* output pin */
131#define PIN_RI 0x02 /* input pin, active low */
132#define PIN_DCD 0x01 /* input pin, active low */
133 u8 rx_bytes_avail; /* number of bytes in rx buffer */;
134};
135
136#define OTI6858_CTRL_PKT_SIZE sizeof(struct oti6858_control_pkt)
137#define OTI6858_CTRL_EQUALS_PENDING(a, priv) \
138 ( ((a)->divisor == (priv)->pending_setup.divisor) \
139 && ((a)->control == (priv)->pending_setup.control) \
140 && ((a)->frame_fmt == (priv)->pending_setup.frame_fmt) )
141
142/* function prototypes */
143static int oti6858_open(struct usb_serial_port *port, struct file *filp);
144static void oti6858_close(struct usb_serial_port *port, struct file *filp);
145static void oti6858_set_termios(struct usb_serial_port *port,
146 struct ktermios *old);
147static int oti6858_ioctl(struct usb_serial_port *port, struct file *file,
148 unsigned int cmd, unsigned long arg);
149static void oti6858_read_int_callback(struct urb *urb);
150static void oti6858_read_bulk_callback(struct urb *urb);
151static void oti6858_write_bulk_callback(struct urb *urb);
152static int oti6858_write(struct usb_serial_port *port,
153 const unsigned char *buf, int count);
154static int oti6858_write_room(struct usb_serial_port *port);
155static void oti6858_break_ctl(struct usb_serial_port *port, int break_state);
156static int oti6858_chars_in_buffer(struct usb_serial_port *port);
157static int oti6858_tiocmget(struct usb_serial_port *port, struct file *file);
158static int oti6858_tiocmset(struct usb_serial_port *port, struct file *file,
159 unsigned int set, unsigned int clear);
160static int oti6858_startup(struct usb_serial *serial);
161static void oti6858_shutdown(struct usb_serial *serial);
162
163/* functions operating on buffers */
b0a239da
AC		 164static struct oti6858_buf *oti6858_buf_alloc(unsigned int size);
165static void oti6858_buf_free(struct oti6858_buf *pb);
166static void oti6858_buf_clear(struct oti6858_buf *pb);
167static unsigned int oti6858_buf_data_avail(struct oti6858_buf *pb);
168static unsigned int oti6858_buf_space_avail(struct oti6858_buf *pb);
169static unsigned int oti6858_buf_put(struct oti6858_buf *pb, const char *buf,
49cdee0e 170 unsigned int count);
b0a239da 171static unsigned int oti6858_buf_get(struct oti6858_buf *pb, char *buf,
49cdee0e
KL		 172 unsigned int count);
173
174
175/* device info */
176static struct usb_serial_driver oti6858_device = {
177 .driver = {
178 .owner = THIS_MODULE,
179 .name = "oti6858",
180 },
181 .id_table = id_table,
49cdee0e
KL		 182 .num_ports = 1,
183 .open = oti6858_open,
184 .close = oti6858_close,
185 .write = oti6858_write,
186 .ioctl = oti6858_ioctl,
187 .break_ctl = oti6858_break_ctl,
188 .set_termios = oti6858_set_termios,
189 .tiocmget = oti6858_tiocmget,
190 .tiocmset = oti6858_tiocmset,
191 .read_bulk_callback = oti6858_read_bulk_callback,
192 .read_int_callback = oti6858_read_int_callback,
193 .write_bulk_callback = oti6858_write_bulk_callback,
194 .write_room = oti6858_write_room,
195 .chars_in_buffer = oti6858_chars_in_buffer,
196 .attach = oti6858_startup,
197 .shutdown = oti6858_shutdown,
198};
199
200struct oti6858_private {
201 spinlock_t lock;
202
b0a239da 203 struct oti6858_buf *buf;
49cdee0e
KL		 204 struct oti6858_control_pkt status;
205
206 struct {
207 u8 read_urb_in_use;
208 u8 write_urb_in_use;
209 u8 termios_initialized;
210 } flags;
211 struct delayed_work delayed_write_work;
212
213 struct {
214 u16 divisor;
215 u8 frame_fmt;
216 u8 control;
217 } pending_setup;
218 u8 transient;
219 u8 setup_done;
220 struct delayed_work delayed_setup_work;
221
222 wait_queue_head_t intr_wait;
223 struct usb_serial_port *port; /* USB port with which associated */
224};
225
226#undef dbg
227/* #define dbg(format, arg...) printk(KERN_INFO "%s: " format "\n", __FILE__, ## arg) */
228#define dbg(format, arg...) printk(KERN_INFO "" format "\n", ## arg)
229
230static void setup_line(struct work_struct *work)
231{
232 struct oti6858_private *priv = container_of(work, struct oti6858_private, delayed_setup_work.work);
233 struct usb_serial_port *port = priv->port;
234 struct oti6858_control_pkt *new_setup;
235 unsigned long flags;
236 int result;
237
441b62c1 238 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 239
240 if ((new_setup = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL)) == NULL) {
441b62c1 241 dev_err(&port->dev, "%s(): out of memory!\n", __func__);
49cdee0e
KL		 242 /* we will try again */
243 schedule_delayed_work(&priv->delayed_setup_work, msecs_to_jiffies(2));
244 return;
245 }
246
247 result = usb_control_msg(port->serial->dev,
248 usb_rcvctrlpipe(port->serial->dev, 0),
249 OTI6858_REQ_T_GET_STATUS,
250 OTI6858_REQ_GET_STATUS,
251 0, 0,
252 new_setup, OTI6858_CTRL_PKT_SIZE,
253 100);
254
255 if (result != OTI6858_CTRL_PKT_SIZE) {
441b62c1 256 dev_err(&port->dev, "%s(): error reading status\n", __func__);
49cdee0e
KL		 257 kfree(new_setup);
258 /* we will try again */
259 schedule_delayed_work(&priv->delayed_setup_work, msecs_to_jiffies(2));
260 return;
261 }
262
263 spin_lock_irqsave(&priv->lock, flags);
264 if (!OTI6858_CTRL_EQUALS_PENDING(new_setup, priv)) {
265 new_setup->divisor = priv->pending_setup.divisor;
266 new_setup->control = priv->pending_setup.control;
267 new_setup->frame_fmt = priv->pending_setup.frame_fmt;
268
269 spin_unlock_irqrestore(&priv->lock, flags);
270 result = usb_control_msg(port->serial->dev,
271 usb_sndctrlpipe(port->serial->dev, 0),
272 OTI6858_REQ_T_SET_LINE,
273 OTI6858_REQ_SET_LINE,
274 0, 0,
275 new_setup, OTI6858_CTRL_PKT_SIZE,
276 100);
277 } else {
278 spin_unlock_irqrestore(&priv->lock, flags);
279 result = 0;
280 }
281 kfree(new_setup);
282
283 spin_lock_irqsave(&priv->lock, flags);
284 if (result != OTI6858_CTRL_PKT_SIZE)
285 priv->transient = 0;
286 priv->setup_done = 1;
287 spin_unlock_irqrestore(&priv->lock, flags);
288
441b62c1 289 dbg("%s(): submitting interrupt urb", __func__);
49cdee0e
KL		 290 port->interrupt_in_urb->dev = port->serial->dev;
291 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
292 if (result != 0) {
293 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
441b62c1 294 " with error %d\n", __func__, result);
49cdee0e
KL		 295 }
296}
297
298void send_data(struct work_struct *work)
299{
300 struct oti6858_private *priv = container_of(work, struct oti6858_private, delayed_write_work.work);
301 struct usb_serial_port *port = priv->port;
302 int count = 0, result;
303 unsigned long flags;
304 unsigned char allow;
305
441b62c1 306 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 307
308 spin_lock_irqsave(&priv->lock, flags);
309 if (priv->flags.write_urb_in_use) {
310 spin_unlock_irqrestore(&priv->lock, flags);
311 schedule_delayed_work(&priv->delayed_write_work, msecs_to_jiffies(2));
312 return;
313 }
314 priv->flags.write_urb_in_use = 1;
315
b0a239da 316 count = oti6858_buf_data_avail(priv->buf);
49cdee0e
KL		 317 spin_unlock_irqrestore(&priv->lock, flags);
318 if (count > port->bulk_out_size)
319 count = port->bulk_out_size;
320
321 if (count != 0) {
322 result = usb_control_msg(port->serial->dev,
323 usb_rcvctrlpipe(port->serial->dev, 0),
324 OTI6858_REQ_T_CHECK_TXBUFF,
325 OTI6858_REQ_CHECK_TXBUFF,
326 count, 0, &allow, 1, 100);
327 if (result != 1 || allow != 0)
328 count = 0;
329 }
330
331 if (count == 0) {
332 priv->flags.write_urb_in_use = 0;
333
441b62c1 334 dbg("%s(): submitting interrupt urb", __func__);
49cdee0e
KL		 335 port->interrupt_in_urb->dev = port->serial->dev;
336 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
337 if (result != 0) {
338 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
441b62c1 339 " with error %d\n", __func__, result);
49cdee0e
KL		 340 }
341 return;
342 }
343
344 spin_lock_irqsave(&priv->lock, flags);
b0a239da 345 oti6858_buf_get(priv->buf, port->write_urb->transfer_buffer, count);
49cdee0e
KL		 346 spin_unlock_irqrestore(&priv->lock, flags);
347
348 port->write_urb->transfer_buffer_length = count;
349 port->write_urb->dev = port->serial->dev;
350 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
351 if (result != 0) {
352 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
441b62c1 353 " with error %d\n", __func__, result);
49cdee0e
KL		 354 priv->flags.write_urb_in_use = 0;
355 }
356
357 usb_serial_port_softint(port);
358}
359
360static int oti6858_startup(struct usb_serial *serial)
361{
362 struct usb_serial_port *port = serial->port[0];
363 struct oti6858_private *priv;
364 int i;
365
366 for (i = 0; i < serial->num_ports; ++i) {
367 priv = kzalloc(sizeof(struct oti6858_private), GFP_KERNEL);
368 if (!priv)
369 break;
b0a239da 370 priv->buf = oti6858_buf_alloc(PL2303_BUF_SIZE);
49cdee0e
KL		 371 if (priv->buf == NULL) {
372 kfree(priv);
373 break;
374 }
375
376 spin_lock_init(&priv->lock);
377 init_waitqueue_head(&priv->intr_wait);
378// INIT_WORK(&priv->setup_work, setup_line, serial->port[i]);
379// INIT_WORK(&priv->write_work, send_data, serial->port[i]);
380 priv->port = port;
381 INIT_DELAYED_WORK(&priv->delayed_setup_work, setup_line);
382 INIT_DELAYED_WORK(&priv->delayed_write_work, send_data);
383
384 usb_set_serial_port_data(serial->port[i], priv);
385 }
386 if (i == serial->num_ports)
387 return 0;
388
389 for (--i; i >= 0; --i) {
390 priv = usb_get_serial_port_data(serial->port[i]);
b0a239da 391 oti6858_buf_free(priv->buf);
49cdee0e
KL		 392 kfree(priv);
393 usb_set_serial_port_data(serial->port[i], NULL);
394 }
395 return -ENOMEM;
396}
397
398static int oti6858_write(struct usb_serial_port *port,
399 const unsigned char *buf, int count)
400{
401 struct oti6858_private *priv = usb_get_serial_port_data(port);
402 unsigned long flags;
403
441b62c1 404 dbg("%s(port = %d, count = %d)", __func__, port->number, count);
49cdee0e
KL		 405
406 if (!count)
407 return count;
408
409 spin_lock_irqsave(&priv->lock, flags);
b0a239da 410 count = oti6858_buf_put(priv->buf, buf, count);
49cdee0e
KL		 411 spin_unlock_irqrestore(&priv->lock, flags);
412
413 return count;
414}
415
416static int oti6858_write_room(struct usb_serial_port *port)
417{
418 struct oti6858_private *priv = usb_get_serial_port_data(port);
419 int room = 0;
420 unsigned long flags;
421
441b62c1 422 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 423
424 spin_lock_irqsave(&priv->lock, flags);
b0a239da 425 room = oti6858_buf_space_avail(priv->buf);
49cdee0e
KL		 426 spin_unlock_irqrestore(&priv->lock, flags);
427
428 return room;
429}
430
431static int oti6858_chars_in_buffer(struct usb_serial_port *port)
432{
433 struct oti6858_private *priv = usb_get_serial_port_data(port);
434 int chars = 0;
435 unsigned long flags;
436
441b62c1 437 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 438
439 spin_lock_irqsave(&priv->lock, flags);
b0a239da 440 chars = oti6858_buf_data_avail(priv->buf);
49cdee0e
KL		 441 spin_unlock_irqrestore(&priv->lock, flags);
442
443 return chars;
444}
445
446static void oti6858_set_termios(struct usb_serial_port *port,
447 struct ktermios *old_termios)
448{
449 struct oti6858_private *priv = usb_get_serial_port_data(port);
450 unsigned long flags;
451 unsigned int cflag;
452 u8 frame_fmt, control;
453 u16 divisor;
454 int br;
455
441b62c1 456 dbg("%s(port = %d)", __func__, port->number);
49cdee0e 457
b0a239da 458 if (!port->tty || !port->tty->termios) {
441b62c1 459 dbg("%s(): no tty structures", __func__);
49cdee0e
KL		 460 return;
461 }
462
463 spin_lock_irqsave(&priv->lock, flags);
464 if (!priv->flags.termios_initialized) {
465 *(port->tty->termios) = tty_std_termios;
466 port->tty->termios->c_cflag = B38400 | CS8 | CREAD | HUPCL | CLOCAL;
467 priv->flags.termios_initialized = 1;
b0a239da
AC		 468 port->tty->termios->c_ispeed = 38400;
469 port->tty->termios->c_ospeed = 38400;
49cdee0e
KL		 470 }
471 spin_unlock_irqrestore(&priv->lock, flags);
472
473 cflag = port->tty->termios->c_cflag;
474
475 spin_lock_irqsave(&priv->lock, flags);
476 divisor = priv->pending_setup.divisor;
477 frame_fmt = priv->pending_setup.frame_fmt;
478 control = priv->pending_setup.control;
479 spin_unlock_irqrestore(&priv->lock, flags);
480
481 frame_fmt &= ~FMT_DATA_BITS_MASK;
482 switch (cflag & CSIZE) {
483 case CS5:
484 frame_fmt |= FMT_DATA_BITS_5;
485 break;
486 case CS6:
487 frame_fmt |= FMT_DATA_BITS_6;
488 break;
489 case CS7:
490 frame_fmt |= FMT_DATA_BITS_7;
491 break;
492 default:
493 case CS8:
494 frame_fmt |= FMT_DATA_BITS_8;
495 break;
496 }
497
498 /* manufacturer claims that this device can work with baud rates
499 * up to 3 Mbps; I've tested it only on 115200 bps, so I can't
500 * guarantee that any other baud rate will work (especially
501 * the higher ones)
502 */
503 br = tty_get_baud_rate(port->tty);
504 if (br == 0) {
505 divisor = 0;
b0a239da 506 } else {
49cdee0e 507 int real_br;
b0a239da 508 br = min(br, OTI6858_MAX_BAUD_RATE);
49cdee0e
KL		 509
510 divisor = (96000000 + 8 * br) / (16 * br);
511 real_br = 96000000 / (16 * divisor);
49cdee0e 512 divisor = cpu_to_le16(divisor);
b0a239da 513 tty_encode_baud_rate(port->tty, real_br, real_br);
49cdee0e
KL		 514 }
515
516 frame_fmt &= ~FMT_STOP_BITS_MASK;
517 if ((cflag & CSTOPB) != 0) {
518 frame_fmt |= FMT_STOP_BITS_2;
519 } else {
520 frame_fmt |= FMT_STOP_BITS_1;
521 }
522
523 frame_fmt &= ~FMT_PARITY_MASK;
524 if ((cflag & PARENB) != 0) {
525 if ((cflag & PARODD) != 0) {
526 frame_fmt |= FMT_PARITY_ODD;
527 } else {
528 frame_fmt |= FMT_PARITY_EVEN;
529 }
530 } else {
531 frame_fmt |= FMT_PARITY_NONE;
532 }
533
534 control &= ~CONTROL_MASK;
535 if ((cflag & CRTSCTS) != 0)
536 control |= (CONTROL_DTR_HIGH | CONTROL_RTS_HIGH);
537
538 /* change control lines if we are switching to or from B0 */
539 /* FIXME:
540 spin_lock_irqsave(&priv->lock, flags);
541 control = priv->line_control;
542 if ((cflag & CBAUD) == B0)
543 priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
544 else
545 priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
546 if (control != priv->line_control) {
547 control = priv->line_control;
548 spin_unlock_irqrestore(&priv->lock, flags);
549 set_control_lines(serial->dev, control);
550 } else {
551 spin_unlock_irqrestore(&priv->lock, flags);
552 }
553 */
554
555 spin_lock_irqsave(&priv->lock, flags);
556 if (divisor != priv->pending_setup.divisor
557 || control != priv->pending_setup.control
558 || frame_fmt != priv->pending_setup.frame_fmt) {
559 priv->pending_setup.divisor = divisor;
560 priv->pending_setup.control = control;
561 priv->pending_setup.frame_fmt = frame_fmt;
562 }
563 spin_unlock_irqrestore(&priv->lock, flags);
564}
565
566static int oti6858_open(struct usb_serial_port *port, struct file *filp)
567{
568 struct oti6858_private *priv = usb_get_serial_port_data(port);
569 struct ktermios tmp_termios;
570 struct usb_serial *serial = port->serial;
571 struct oti6858_control_pkt *buf;
572 unsigned long flags;
573 int result;
574
441b62c1 575 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 576
577 usb_clear_halt(serial->dev, port->write_urb->pipe);
578 usb_clear_halt(serial->dev, port->read_urb->pipe);
579
580 if (port->open_count != 1)
581 return 0;
582
583 if ((buf = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL)) == NULL) {
441b62c1 584 dev_err(&port->dev, "%s(): out of memory!\n", __func__);
49cdee0e
KL		 585 return -ENOMEM;
586 }
587
588 result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
589 OTI6858_REQ_T_GET_STATUS,
590 OTI6858_REQ_GET_STATUS,
591 0, 0,
592 buf, OTI6858_CTRL_PKT_SIZE,
593 100);
594 if (result != OTI6858_CTRL_PKT_SIZE) {
595 /* assume default (after power-on reset) values */
596 buf->divisor = cpu_to_le16(0x009c); /* 38400 bps */
597 buf->frame_fmt = 0x03; /* 8N1 */
598 buf->something = 0x43;
599 buf->control = 0x4c; /* DTR, RTS */
600 buf->tx_status = 0x00;
601 buf->pin_state = 0x5b; /* RTS, CTS, DSR, DTR, RI, DCD */
602 buf->rx_bytes_avail = 0x00;
603 }
604
605 spin_lock_irqsave(&priv->lock, flags);
606 memcpy(&priv->status, buf, OTI6858_CTRL_PKT_SIZE);
607 priv->pending_setup.divisor = buf->divisor;
608 priv->pending_setup.frame_fmt = buf->frame_fmt;
609 priv->pending_setup.control = buf->control;
610 spin_unlock_irqrestore(&priv->lock, flags);
611 kfree(buf);
612
441b62c1 613 dbg("%s(): submitting interrupt urb", __func__);
49cdee0e
KL		 614 port->interrupt_in_urb->dev = serial->dev;
615 result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
616 if (result != 0) {
617 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
441b62c1 618 " with error %d\n", __func__, result);
49cdee0e
KL		 619 oti6858_close(port, NULL);
620 return -EPROTO;
621 }
622
623 /* setup termios */
624 if (port->tty)
625 oti6858_set_termios(port, &tmp_termios);
626
627 return 0;
628}
629
630static void oti6858_close(struct usb_serial_port *port, struct file *filp)
631{
632 struct oti6858_private *priv = usb_get_serial_port_data(port);
633 unsigned long flags;
634 long timeout;
635 wait_queue_t wait;
636
441b62c1 637 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 638
639 /* wait for data to drain from the buffer */
640 spin_lock_irqsave(&priv->lock, flags);
641 timeout = 30 * HZ; /* PL2303_CLOSING_WAIT */
642 init_waitqueue_entry(&wait, current);
643 add_wait_queue(&port->tty->write_wait, &wait);
441b62c1 644 dbg("%s(): entering wait loop", __func__);
49cdee0e
KL		 645 for (;;) {
646 set_current_state(TASK_INTERRUPTIBLE);
b0a239da 647 if (oti6858_buf_data_avail(priv->buf) == 0
49cdee0e 648 || timeout == 0 || signal_pending(current)
0915f490 649 || port->serial->disconnected)
49cdee0e
KL		 650 break;
651 spin_unlock_irqrestore(&priv->lock, flags);
652 timeout = schedule_timeout(timeout);
653 spin_lock_irqsave(&priv->lock, flags);
654 }
655 set_current_state(TASK_RUNNING);
656 remove_wait_queue(&port->tty->write_wait, &wait);
441b62c1 657 dbg("%s(): after wait loop", __func__);
49cdee0e
KL		 658
659 /* clear out any remaining data in the buffer */
b0a239da 660 oti6858_buf_clear(priv->buf);
49cdee0e
KL		 661 spin_unlock_irqrestore(&priv->lock, flags);
662
663 /* wait for characters to drain from the device */
664 /* (this is long enough for the entire 256 byte */
665 /* pl2303 hardware buffer to drain with no flow */
666 /* control for data rates of 1200 bps or more, */
667 /* for lower rates we should really know how much */
668 /* data is in the buffer to compute a delay */
669 /* that is not unnecessarily long) */
670 /* FIXME
671 bps = tty_get_baud_rate(port->tty);
672 if (bps > 1200)
673 timeout = max((HZ*2560)/bps,HZ/10);
674 else
675 */
676 timeout = 2*HZ;
677 schedule_timeout_interruptible(timeout);
441b62c1 678 dbg("%s(): after schedule_timeout_interruptible()", __func__);
49cdee0e
KL		 679
680 /* cancel scheduled setup */
681 cancel_delayed_work(&priv->delayed_setup_work);
682 cancel_delayed_work(&priv->delayed_write_work);
683 flush_scheduled_work();
684
685 /* shutdown our urbs */
441b62c1 686 dbg("%s(): shutting down urbs", __func__);
49cdee0e
KL		 687 usb_kill_urb(port->write_urb);
688 usb_kill_urb(port->read_urb);
689 usb_kill_urb(port->interrupt_in_urb);
690
691 /*
692 if (port->tty && (port->tty->termios->c_cflag) & HUPCL) {
693 // drop DTR and RTS
694 spin_lock_irqsave(&priv->lock, flags);
695 priv->pending_setup.control &= ~CONTROL_MASK;
696 spin_unlock_irqrestore(&priv->lock, flags);
697 }
698 */
699}
700
701static int oti6858_tiocmset(struct usb_serial_port *port, struct file *file,
702 unsigned int set, unsigned int clear)
703{
704 struct oti6858_private *priv = usb_get_serial_port_data(port);
705 unsigned long flags;
706 u8 control;
707
708 dbg("%s(port = %d, set = 0x%08x, clear = 0x%08x)",
441b62c1 709 __func__, port->number, set, clear);
49cdee0e
KL		 710
711 if (!usb_get_intfdata(port->serial->interface))
712 return -ENODEV;
713
714 /* FIXME: check if this is correct (active high/low) */
715 spin_lock_irqsave(&priv->lock, flags);
716 control = priv->pending_setup.control;
717 if ((set & TIOCM_RTS) != 0)
718 control |= CONTROL_RTS_HIGH;
719 if ((set & TIOCM_DTR) != 0)
720 control |= CONTROL_DTR_HIGH;
721 if ((clear & TIOCM_RTS) != 0)
722 control &= ~CONTROL_RTS_HIGH;
723 if ((clear & TIOCM_DTR) != 0)
724 control &= ~CONTROL_DTR_HIGH;
725
726 if (control != priv->pending_setup.control) {
727 priv->pending_setup.control = control;
728 }
729 spin_unlock_irqrestore(&priv->lock, flags);
730
731 return 0;
732}
733
734static int oti6858_tiocmget(struct usb_serial_port *port, struct file *file)
735{
736 struct oti6858_private *priv = usb_get_serial_port_data(port);
737 unsigned long flags;
738 unsigned pin_state;
739 unsigned result = 0;
740
441b62c1 741 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 742
743 if (!usb_get_intfdata(port->serial->interface))
744 return -ENODEV;
745
746 spin_lock_irqsave(&priv->lock, flags);
747 pin_state = priv->status.pin_state & PIN_MASK;
748 spin_unlock_irqrestore(&priv->lock, flags);
749
750 /* FIXME: check if this is correct (active high/low) */
751 if ((pin_state & PIN_RTS) != 0)
752 result |= TIOCM_RTS;
753 if ((pin_state & PIN_CTS) != 0)
754 result |= TIOCM_CTS;
755 if ((pin_state & PIN_DSR) != 0)
756 result |= TIOCM_DSR;
757 if ((pin_state & PIN_DTR) != 0)
758 result |= TIOCM_DTR;
759 if ((pin_state & PIN_RI) != 0)
760 result |= TIOCM_RI;
761 if ((pin_state & PIN_DCD) != 0)
762 result |= TIOCM_CD;
763
441b62c1 764 dbg("%s() = 0x%08x", __func__, result);
49cdee0e
KL		 765
766 return result;
767}
768
769static int wait_modem_info(struct usb_serial_port *port, unsigned int arg)
770{
771 struct oti6858_private *priv = usb_get_serial_port_data(port);
772 unsigned long flags;
773 unsigned int prev, status;
774 unsigned int changed;
775
776 spin_lock_irqsave(&priv->lock, flags);
777 prev = priv->status.pin_state;
778 spin_unlock_irqrestore(&priv->lock, flags);
779
780 while (1) {
781 wait_event_interruptible(priv->intr_wait, priv->status.pin_state != prev);
782 if (signal_pending(current))
783 return -ERESTARTSYS;
784
785 spin_lock_irqsave(&priv->lock, flags);
786 status = priv->status.pin_state & PIN_MASK;
787 spin_unlock_irqrestore(&priv->lock, flags);
788
789 changed = prev ^ status;
790 /* FIXME: check if this is correct (active high/low) */
791 if ( ((arg & TIOCM_RNG) && (changed & PIN_RI)) ||
792 ((arg & TIOCM_DSR) && (changed & PIN_DSR)) ||
793 ((arg & TIOCM_CD) && (changed & PIN_DCD)) ||
794 ((arg & TIOCM_CTS) && (changed & PIN_CTS))) {
795 return 0;
796 }
797 prev = status;
798 }
799
800 /* NOTREACHED */
801 return 0;
802}
803
804static int oti6858_ioctl(struct usb_serial_port *port, struct file *file,
805 unsigned int cmd, unsigned long arg)
806{
807 void __user *user_arg = (void __user *) arg;
808 unsigned int x;
809
810 dbg("%s(port = %d, cmd = 0x%04x, arg = 0x%08lx)",
441b62c1 811 __func__, port->number, cmd, arg);
49cdee0e
KL		 812
813 switch (cmd) {
49cdee0e
KL		 814 case TIOCMBIS:
815 if (copy_from_user(&x, user_arg, sizeof(x)))
816 return -EFAULT;
817 return oti6858_tiocmset(port, NULL, x, 0);
818
819 case TIOCMBIC:
820 if (copy_from_user(&x, user_arg, sizeof(x)))
821 return -EFAULT;
822 return oti6858_tiocmset(port, NULL, 0, x);
823
49cdee0e 824 case TIOCMIWAIT:
441b62c1 825 dbg("%s(): TIOCMIWAIT", __func__);
49cdee0e
KL		 826 return wait_modem_info(port, arg);
827
828 default:
441b62c1 829 dbg("%s(): 0x%04x not supported", __func__, cmd);
49cdee0e
KL		 830 break;
831 }
832
833 return -ENOIOCTLCMD;
834}
835
836static void oti6858_break_ctl(struct usb_serial_port *port, int break_state)
837{
838 int state;
839
441b62c1 840 dbg("%s(port = %d)", __func__, port->number);
49cdee0e
KL		 841
842 state = (break_state == 0) ? 0 : 1;
441b62c1 843 dbg("%s(): turning break %s", __func__, state ? "on" : "off");
49cdee0e
KL		 844
845 /* FIXME */
846/*
847 result = usb_control_msg (serial->dev, usb_sndctrlpipe (serial->dev, 0),
848 BREAK_REQUEST, BREAK_REQUEST_TYPE, state,
849 0, NULL, 0, 100);
850 if (result != 0)
441b62c1 851 dbg("%s(): error sending break", __func__);
49cdee0e
KL		 852 */
853}
854
855static void oti6858_shutdown(struct usb_serial *serial)
856{
857 struct oti6858_private *priv;
858 int i;
859
441b62c1 860 dbg("%s()", __func__);
49cdee0e
KL		 861
862 for (i = 0; i < serial->num_ports; ++i) {
863 priv = usb_get_serial_port_data(serial->port[i]);
864 if (priv) {
b0a239da 865 oti6858_buf_free(priv->buf);
49cdee0e
KL		 866 kfree(priv);
867 usb_set_serial_port_data(serial->port[i], NULL);
868 }
869 }
870}
871
872static void oti6858_read_int_callback(struct urb *urb)
873{
cdc97792 874 struct usb_serial_port *port = urb->context;
49cdee0e
KL		 875 struct oti6858_private *priv = usb_get_serial_port_data(port);
876 int transient = 0, can_recv = 0, resubmit = 1;
78c26aeb 877 int status = urb->status;
49cdee0e 878
78c26aeb 879 dbg("%s(port = %d, status = %d)",
441b62c1 880 __func__, port->number, status);
49cdee0e 881
78c26aeb 882 switch (status) {
49cdee0e
KL		 883 case 0:
884 /* success */
885 break;
886 case -ECONNRESET:
887 case -ENOENT:
888 case -ESHUTDOWN:
889 /* this urb is terminated, clean up */
890 dbg("%s(): urb shutting down with status: %d",
441b62c1 891 __func__, status);
49cdee0e
KL		 892 return;
893 default:
894 dbg("%s(): nonzero urb status received: %d",
441b62c1 895 __func__, status);
49cdee0e
KL		 896 break;
897 }
898
78c26aeb 899 if (status == 0 && urb->actual_length == OTI6858_CTRL_PKT_SIZE) {
49cdee0e
KL		 900 struct oti6858_control_pkt *xs = urb->transfer_buffer;
901 unsigned long flags;
902
903 spin_lock_irqsave(&priv->lock, flags);
904
905 if (!priv->transient) {
906 if (!OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
907 if (xs->rx_bytes_avail == 0) {
908 priv->transient = 4;
909 priv->setup_done = 0;
910 resubmit = 0;
911 dbg("%s(): scheduling setup_line()",
441b62c1 912 __func__);
49cdee0e
KL		 913 schedule_delayed_work(&priv->delayed_setup_work, 0);
914 }
915 }
916 } else {
917 if (OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
918 priv->transient = 0;
919 } else if (!priv->setup_done) {
920 resubmit = 0;
921 } else if (--priv->transient == 0) {
922 if (xs->rx_bytes_avail == 0) {
923 priv->transient = 4;
924 priv->setup_done = 0;
925 resubmit = 0;
926 dbg("%s(): scheduling setup_line()",
441b62c1 927 __func__);
49cdee0e
KL		 928 schedule_delayed_work(&priv->delayed_setup_work, 0);
929 }
930 }
931 }
932
933 if (!priv->transient) {
934 if (xs->pin_state != priv->status.pin_state)
935 wake_up_interruptible(&priv->intr_wait);
936 memcpy(&priv->status, xs, OTI6858_CTRL_PKT_SIZE);
937 }
938
939 if (!priv->transient && xs->rx_bytes_avail != 0) {
940 can_recv = xs->rx_bytes_avail;
941 priv->flags.read_urb_in_use = 1;
942 }
943
944 transient = priv->transient;
945 spin_unlock_irqrestore(&priv->lock, flags);
946 }
947
948 if (can_recv) {
949 int result;
950
951 port->read_urb->dev = port->serial->dev;
952 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
953 if (result != 0) {
954 priv->flags.read_urb_in_use = 0;
955 dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
441b62c1 956 " error %d\n", __func__, result);
49cdee0e
KL		 957 } else {
958 resubmit = 0;
959 }
960 } else if (!transient) {
961 unsigned long flags;
962
963 spin_lock_irqsave(&priv->lock, flags);
964 if (priv->flags.write_urb_in_use == 0
b0a239da 965 && oti6858_buf_data_avail(priv->buf) != 0) {
49cdee0e
KL		 966 schedule_delayed_work(&priv->delayed_write_work,0);
967 resubmit = 0;
968 }
969 spin_unlock_irqrestore(&priv->lock, flags);
970 }
971
972 if (resubmit) {
973 int result;
974
441b62c1 975// dbg("%s(): submitting interrupt urb", __func__);
49cdee0e
KL		 976 urb->dev = port->serial->dev;
977 result = usb_submit_urb(urb, GFP_ATOMIC);
978 if (result != 0) {
979 dev_err(&urb->dev->dev,
980 "%s(): usb_submit_urb() failed with"
441b62c1 981 " error %d\n", __func__, result);
49cdee0e
KL		 982 }
983 }
984}
985
986static void oti6858_read_bulk_callback(struct urb *urb)
987{
cdc97792 988 struct usb_serial_port *port = urb->context;
49cdee0e
KL		 989 struct oti6858_private *priv = usb_get_serial_port_data(port);
990 struct tty_struct *tty;
991 unsigned char *data = urb->transfer_buffer;
992 unsigned long flags;
78c26aeb 993 int status = urb->status;
b0a239da 994 int result;
49cdee0e 995
78c26aeb 996 dbg("%s(port = %d, status = %d)",
441b62c1 997 __func__, port->number, status);
49cdee0e
KL		 998
999 spin_lock_irqsave(&priv->lock, flags);
1000 priv->flags.read_urb_in_use = 0;
1001 spin_unlock_irqrestore(&priv->lock, flags);
1002
78c26aeb 1003 if (status != 0) {
49cdee0e 1004 if (!port->open_count) {
441b62c1 1005 dbg("%s(): port is closed, exiting", __func__);
49cdee0e
KL		 1006 return;
1007 }
1008 /*
78c26aeb 1009 if (status == -EPROTO) {
49cdee0e 1010 // PL2303 mysteriously fails with -EPROTO reschedule the read
441b62c1 1011 dbg("%s - caught -EPROTO, resubmitting the urb", __func__);
49cdee0e
KL		 1012 result = usb_submit_urb(urb, GFP_ATOMIC);
1013 if (result)
441b62c1 1014 dev_err(&urb->dev->dev, "%s - failed resubmitting read urb, error %d\n", __func__, result);
49cdee0e
KL		 1015 return;
1016 }
1017 */
441b62c1 1018 dbg("%s(): unable to handle the error, exiting", __func__);
49cdee0e
KL		 1019 return;
1020 }
1021
49cdee0e
KL		 1022 tty = port->tty;
1023 if (tty != NULL && urb->actual_length > 0) {
b0a239da 1024 tty_insert_flip_string(tty, data, urb->actual_length);
49cdee0e
KL		 1025 tty_flip_buffer_push(tty);
1026 }
1027
1028 // schedule the interrupt urb if we are still open */
1029 if (port->open_count != 0) {
1030 port->interrupt_in_urb->dev = port->serial->dev;
1031 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
1032 if (result != 0) {
1033 dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
441b62c1 1034 " error %d\n", __func__, result);
49cdee0e
KL		 1035 }
1036 }
1037}
1038
1039static void oti6858_write_bulk_callback(struct urb *urb)
1040{
cdc97792 1041 struct usb_serial_port *port = urb->context;
49cdee0e 1042 struct oti6858_private *priv = usb_get_serial_port_data(port);
78c26aeb 1043 int status = urb->status;
49cdee0e
KL		 1044 int result;
1045
78c26aeb 1046 dbg("%s(port = %d, status = %d)",
441b62c1 1047 __func__, port->number, status);
49cdee0e 1048
78c26aeb 1049 switch (status) {
49cdee0e
KL		 1050 case 0:
1051 /* success */
1052 break;
1053 case -ECONNRESET:
1054 case -ENOENT:
1055 case -ESHUTDOWN:
1056 /* this urb is terminated, clean up */
1057 dbg("%s(): urb shutting down with status: %d",
441b62c1 1058 __func__, status);
49cdee0e
KL		 1059 priv->flags.write_urb_in_use = 0;
1060 return;
1061 default:
1062 /* error in the urb, so we have to resubmit it */
1063 dbg("%s(): nonzero write bulk status received: %d",
441b62c1
HH		 1064 __func__, status);
1065 dbg("%s(): overflow in write", __func__);
49cdee0e
KL		 1066
1067 port->write_urb->transfer_buffer_length = 1;
1068 port->write_urb->dev = port->serial->dev;
1069 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
1070 if (result) {
1071 dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
441b62c1 1072 " error %d\n", __func__, result);
49cdee0e
KL		 1073 } else {
1074 return;
1075 }
1076 }
1077
1078 priv->flags.write_urb_in_use = 0;
1079
1080 // schedule the interrupt urb if we are still open */
1081 port->interrupt_in_urb->dev = port->serial->dev;
441b62c1 1082 dbg("%s(): submitting interrupt urb", __func__);
49cdee0e
KL		 1083 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
1084 if (result != 0) {
1085 dev_err(&port->dev, "%s(): failed submitting int urb,"
441b62c1 1086 " error %d\n", __func__, result);
49cdee0e
KL		 1087 }
1088}
1089
1090
1091/*
b0a239da 1092 * oti6858_buf_alloc
49cdee0e
KL		 1093 *
1094 * Allocate a circular buffer and all associated memory.
1095 */
b0a239da 1096static struct oti6858_buf *oti6858_buf_alloc(unsigned int size)
49cdee0e 1097{
b0a239da 1098 struct oti6858_buf *pb;
49cdee0e
KL		 1099
1100 if (size == 0)
1101 return NULL;
1102
b0a239da 1103 pb = kmalloc(sizeof(struct oti6858_buf), GFP_KERNEL);
49cdee0e
KL		 1104 if (pb == NULL)
1105 return NULL;
1106
1107 pb->buf_buf = kmalloc(size, GFP_KERNEL);
1108 if (pb->buf_buf == NULL) {
1109 kfree(pb);
1110 return NULL;
1111 }
1112
1113 pb->buf_size = size;
1114 pb->buf_get = pb->buf_put = pb->buf_buf;
1115
1116 return pb;
1117}
1118
1119/*
b0a239da 1120 * oti6858_buf_free
49cdee0e
KL		 1121 *
1122 * Free the buffer and all associated memory.
1123 */
b0a239da 1124static void oti6858_buf_free(struct oti6858_buf *pb)
49cdee0e
KL		 1125{
1126 if (pb) {
1127 kfree(pb->buf_buf);
1128 kfree(pb);
1129 }
1130}
1131
1132/*
b0a239da 1133 * oti6858_buf_clear
49cdee0e
KL		 1134 *
1135 * Clear out all data in the circular buffer.
1136 */
b0a239da 1137static void oti6858_buf_clear(struct oti6858_buf *pb)
49cdee0e
KL		 1138{
1139 if (pb != NULL) {
1140 /* equivalent to a get of all data available */
1141 pb->buf_get = pb->buf_put;
1142 }
1143}
1144
1145/*
b0a239da 1146 * oti6858_buf_data_avail
49cdee0e
KL		 1147 *
1148 * Return the number of bytes of data available in the circular
1149 * buffer.
1150 */
b0a239da 1151static unsigned int oti6858_buf_data_avail(struct oti6858_buf *pb)
49cdee0e
KL		 1152{
1153 if (pb == NULL)
1154 return 0;
1155 return ((pb->buf_size + pb->buf_put - pb->buf_get) % pb->buf_size);
1156}
1157
1158/*
b0a239da 1159 * oti6858_buf_space_avail
49cdee0e
KL		 1160 *
1161 * Return the number of bytes of space available in the circular
1162 * buffer.
1163 */
b0a239da 1164static unsigned int oti6858_buf_space_avail(struct oti6858_buf *pb)
49cdee0e
KL		 1165{
1166 if (pb == NULL)
1167 return 0;
1168 return ((pb->buf_size + pb->buf_get - pb->buf_put - 1) % pb->buf_size);
1169}
1170
1171/*
b0a239da 1172 * oti6858_buf_put
49cdee0e
KL		 1173 *
1174 * Copy data data from a user buffer and put it into the circular buffer.
1175 * Restrict to the amount of space available.
1176 *
1177 * Return the number of bytes copied.
1178 */
b0a239da 1179static unsigned int oti6858_buf_put(struct oti6858_buf *pb, const char *buf,
49cdee0e
KL		 1180 unsigned int count)
1181{
1182 unsigned int len;
1183
1184 if (pb == NULL)
1185 return 0;
1186
b0a239da 1187 len = oti6858_buf_space_avail(pb);
49cdee0e
KL		 1188 if (count > len)
1189 count = len;
1190
1191 if (count == 0)
1192 return 0;
1193
1194 len = pb->buf_buf + pb->buf_size - pb->buf_put;
1195 if (count > len) {
1196 memcpy(pb->buf_put, buf, len);
1197 memcpy(pb->buf_buf, buf+len, count - len);
1198 pb->buf_put = pb->buf_buf + count - len;
1199 } else {
1200 memcpy(pb->buf_put, buf, count);
1201 if (count < len)
1202 pb->buf_put += count;
1203 else /* count == len */
1204 pb->buf_put = pb->buf_buf;
1205 }
1206
1207 return count;
1208}
1209
1210/*
b0a239da 1211 * oti6858_buf_get
49cdee0e
KL		 1212 *
1213 * Get data from the circular buffer and copy to the given buffer.
1214 * Restrict to the amount of data available.
1215 *
1216 * Return the number of bytes copied.
1217 */
b0a239da 1218static unsigned int oti6858_buf_get(struct oti6858_buf *pb, char *buf,
49cdee0e
KL		 1219 unsigned int count)
1220{
1221 unsigned int len;
1222
1223 if (pb == NULL)
1224 return 0;
1225
b0a239da 1226 len = oti6858_buf_data_avail(pb);
49cdee0e
KL		 1227 if (count > len)
1228 count = len;
1229
1230 if (count == 0)
1231 return 0;
1232
1233 len = pb->buf_buf + pb->buf_size - pb->buf_get;
1234 if (count > len) {
1235 memcpy(buf, pb->buf_get, len);
1236 memcpy(buf+len, pb->buf_buf, count - len);
1237 pb->buf_get = pb->buf_buf + count - len;
1238 } else {
1239 memcpy(buf, pb->buf_get, count);
1240 if (count < len)
1241 pb->buf_get += count;
1242 else /* count == len */
1243 pb->buf_get = pb->buf_buf;
1244 }
1245
1246 return count;
1247}
1248
1249/* module description and (de)initialization */
1250
1251static int __init oti6858_init(void)
1252{
1253 int retval;
1254
1255 if ((retval = usb_serial_register(&oti6858_device)) == 0) {
1256 if ((retval = usb_register(&oti6858_driver)) != 0)
1257 usb_serial_deregister(&oti6858_device);
1258 else
1259 return 0;
1260 }
1261
1262 return retval;
1263}
1264
1265static void __exit oti6858_exit(void)
1266{
1267 usb_deregister(&oti6858_driver);
1268 usb_serial_deregister(&oti6858_device);
1269}
1270
1271module_init(oti6858_init);
1272module_exit(oti6858_exit);
1273
1274MODULE_DESCRIPTION(OTI6858_DESCRIPTION);
1275MODULE_AUTHOR(OTI6858_AUTHOR);
1276MODULE_VERSION(OTI6858_VERSION);
1277MODULE_LICENSE("GPL");
1278
1279module_param(debug, bool, S_IRUGO | S_IWUSR);
1280MODULE_PARM_DESC(debug, "enable debug output");
1281
Linux 6.x block layer and io_uring tree(s)