blob: 40cfbe1d351764dcdab80a680fad1fdf42fd0b76 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * USB Cypress M8 driver
3 *
4 * Copyright (C) 2004
5 * Lonnie Mendez (dignome@gmail.com)
6 * Copyright (C) 2003,2004
7 * Neil Whelchel (koyama@firstlight.net)
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
13 *
14 * See Documentation/usb/usb-serial.txt for more information on using this driver
15 *
16 * See http://geocities.com/i0xox0i for information on this driver and the
17 * earthmate usb device.
18 *
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -050019 * Lonnie Mendez <dignome@gmail.com>
20 * 4-29-2005
21 * Fixed problem where setting or retreiving the serial config would fail with
22 * EPIPE. Removed CRTS toggling so the driver behaves more like other usbserial
23 * adapters. Issued new interval of 1ms instead of the default 10ms. As a
24 * result, transfer speed has been substantially increased. From avg. 850bps to
25 * avg. 3300bps. initial termios has also been modified. Cleaned up code and
26 * formatting issues so it is more readable. Replaced the C++ style comments.
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 *
28 * Lonnie Mendez <dignome@gmail.com>
29 * 12-15-2004
30 * Incorporated write buffering from pl2303 driver. Fixed bug with line
31 * handling so both lines are raised in cypress_open. (was dropping rts)
32 * Various code cleanups made as well along with other misc bug fixes.
33 *
34 * Lonnie Mendez <dignome@gmail.com>
35 * 04-10-2004
36 * Driver modified to support dynamic line settings. Various improvments
37 * and features.
38 *
39 * Neil Whelchel
40 * 10-2003
41 * Driver first released.
42 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070043 */
44
45/* Thanks to Neil Whelchel for writing the first cypress m8 implementation for linux. */
46/* Thanks to cypress for providing references for the hid reports. */
47/* Thanks to Jiang Zhang for providing links and for general help. */
48/* Code originates and was built up from ftdi_sio, belkin, pl2303 and others. */
49
50
Linus Torvalds1da177e2005-04-16 15:20:36 -070051#include <linux/kernel.h>
52#include <linux/errno.h>
53#include <linux/init.h>
54#include <linux/slab.h>
55#include <linux/tty.h>
56#include <linux/tty_driver.h>
57#include <linux/tty_flip.h>
58#include <linux/module.h>
59#include <linux/moduleparam.h>
60#include <linux/spinlock.h>
61#include <linux/usb.h>
Greg Kroah-Hartmana9698882006-07-11 21:22:58 -070062#include <linux/usb/serial.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070063#include <linux/serial.h>
64#include <linux/delay.h>
65#include <asm/uaccess.h>
66
Linus Torvalds1da177e2005-04-16 15:20:36 -070067#include "cypress_m8.h"
68
69
70#ifdef CONFIG_USB_SERIAL_DEBUG
71 static int debug = 1;
72#else
73 static int debug;
74#endif
75static int stats;
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -050076static int interval;
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
78/*
79 * Version Information
80 */
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -050081#define DRIVER_VERSION "v1.09"
Linus Torvalds1da177e2005-04-16 15:20:36 -070082#define DRIVER_AUTHOR "Lonnie Mendez <dignome@gmail.com>, Neil Whelchel <koyama@firstlight.net>"
83#define DRIVER_DESC "Cypress USB to Serial Driver"
84
85/* write buffer size defines */
86#define CYPRESS_BUF_SIZE 1024
87#define CYPRESS_CLOSING_WAIT (30*HZ)
88
89static struct usb_device_id id_table_earthmate [] = {
90 { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) },
Lonnie Mendez25b6f082005-05-10 17:09:52 -050091 { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB_LT20) },
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 { } /* Terminating entry */
93};
94
95static struct usb_device_id id_table_cyphidcomrs232 [] = {
96 { USB_DEVICE(VENDOR_ID_CYPRESS, PRODUCT_ID_CYPHIDCOM) },
97 { } /* Terminating entry */
98};
99
Lonnie Mendeza5c44e22006-03-01 10:45:24 -0600100static struct usb_device_id id_table_nokiaca42v2 [] = {
101 { USB_DEVICE(VENDOR_ID_DAZZLE, PRODUCT_ID_CA42) },
102 { } /* Terminating entry */
103};
104
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105static struct usb_device_id id_table_combined [] = {
106 { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB) },
Lonnie Mendez25b6f082005-05-10 17:09:52 -0500107 { USB_DEVICE(VENDOR_ID_DELORME, PRODUCT_ID_EARTHMATEUSB_LT20) },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108 { USB_DEVICE(VENDOR_ID_CYPRESS, PRODUCT_ID_CYPHIDCOM) },
Lonnie Mendeza5c44e22006-03-01 10:45:24 -0600109 { USB_DEVICE(VENDOR_ID_DAZZLE, PRODUCT_ID_CA42) },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 { } /* Terminating entry */
111};
112
113MODULE_DEVICE_TABLE (usb, id_table_combined);
114
115static struct usb_driver cypress_driver = {
116 .name = "cypress",
117 .probe = usb_serial_probe,
118 .disconnect = usb_serial_disconnect,
119 .id_table = id_table_combined,
Greg Kroah-Hartmanba9dc652005-11-16 13:41:28 -0800120 .no_dynamic_id = 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121};
122
123struct cypress_private {
124 spinlock_t lock; /* private lock */
125 int chiptype; /* identifier of device, for quirks/etc */
126 int bytes_in; /* used for statistics */
127 int bytes_out; /* used for statistics */
128 int cmd_count; /* used for statistics */
129 int cmd_ctrl; /* always set this to 1 before issuing a command */
130 struct cypress_buf *buf; /* write buffer */
131 int write_urb_in_use; /* write urb in use indicator */
Mike Isely0257fa92006-08-29 22:06:59 -0500132 int write_urb_interval; /* interval to use for write urb */
133 int read_urb_interval; /* interval to use for read urb */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134 int termios_initialized;
135 __u8 line_control; /* holds dtr / rts value */
136 __u8 current_status; /* received from last read - info on dsr,cts,cd,ri,etc */
137 __u8 current_config; /* stores the current configuration byte */
138 __u8 rx_flags; /* throttling - used from whiteheat/ftdi_sio */
139 int baud_rate; /* stores current baud rate in integer form */
140 int cbr_mask; /* stores current baud rate in masked form */
141 int isthrottled; /* if throttled, discard reads */
142 wait_queue_head_t delta_msr_wait; /* used for TIOCMIWAIT */
143 char prev_status, diff_status; /* used for TIOCMIWAIT */
144 /* we pass a pointer to this as the arguement sent to cypress_set_termios old_termios */
145 struct termios tmp_termios; /* stores the old termios settings */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146};
147
148/* write buffer structure */
149struct cypress_buf {
150 unsigned int buf_size;
151 char *buf_buf;
152 char *buf_get;
153 char *buf_put;
154};
155
156/* function prototypes for the Cypress USB to serial device */
157static int cypress_earthmate_startup (struct usb_serial *serial);
158static int cypress_hidcom_startup (struct usb_serial *serial);
Lonnie Mendeza5c44e22006-03-01 10:45:24 -0600159static int cypress_ca42v2_startup (struct usb_serial *serial);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160static void cypress_shutdown (struct usb_serial *serial);
161static int cypress_open (struct usb_serial_port *port, struct file *filp);
162static void cypress_close (struct usb_serial_port *port, struct file *filp);
163static int cypress_write (struct usb_serial_port *port, const unsigned char *buf, int count);
164static void cypress_send (struct usb_serial_port *port);
165static int cypress_write_room (struct usb_serial_port *port);
166static int cypress_ioctl (struct usb_serial_port *port, struct file * file, unsigned int cmd, unsigned long arg);
167static void cypress_set_termios (struct usb_serial_port *port, struct termios * old);
168static int cypress_tiocmget (struct usb_serial_port *port, struct file *file);
169static int cypress_tiocmset (struct usb_serial_port *port, struct file *file, unsigned int set, unsigned int clear);
170static int cypress_chars_in_buffer (struct usb_serial_port *port);
171static void cypress_throttle (struct usb_serial_port *port);
172static void cypress_unthrottle (struct usb_serial_port *port);
173static void cypress_read_int_callback (struct urb *urb, struct pt_regs *regs);
174static void cypress_write_int_callback (struct urb *urb, struct pt_regs *regs);
175/* baud helper functions */
176static int mask_to_rate (unsigned mask);
177static unsigned rate_to_mask (int rate);
178/* write buffer functions */
179static struct cypress_buf *cypress_buf_alloc(unsigned int size);
180static void cypress_buf_free(struct cypress_buf *cb);
181static void cypress_buf_clear(struct cypress_buf *cb);
182static unsigned int cypress_buf_data_avail(struct cypress_buf *cb);
183static unsigned int cypress_buf_space_avail(struct cypress_buf *cb);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500184static unsigned int cypress_buf_put(struct cypress_buf *cb, const char *buf, unsigned int count);
185static unsigned int cypress_buf_get(struct cypress_buf *cb, char *buf, unsigned int count);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
187
Greg Kroah-Hartmanea653702005-06-20 21:15:16 -0700188static struct usb_serial_driver cypress_earthmate_device = {
Greg Kroah-Hartman18fcac32005-06-20 21:15:16 -0700189 .driver = {
190 .owner = THIS_MODULE,
Greg Kroah-Hartman269bda12005-06-20 21:15:16 -0700191 .name = "earthmate",
Greg Kroah-Hartman18fcac32005-06-20 21:15:16 -0700192 },
Greg Kroah-Hartman269bda12005-06-20 21:15:16 -0700193 .description = "DeLorme Earthmate USB",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 .id_table = id_table_earthmate,
195 .num_interrupt_in = 1,
196 .num_interrupt_out = 1,
197 .num_bulk_in = NUM_DONT_CARE,
198 .num_bulk_out = NUM_DONT_CARE,
199 .num_ports = 1,
200 .attach = cypress_earthmate_startup,
201 .shutdown = cypress_shutdown,
202 .open = cypress_open,
203 .close = cypress_close,
204 .write = cypress_write,
205 .write_room = cypress_write_room,
206 .ioctl = cypress_ioctl,
207 .set_termios = cypress_set_termios,
208 .tiocmget = cypress_tiocmget,
209 .tiocmset = cypress_tiocmset,
210 .chars_in_buffer = cypress_chars_in_buffer,
211 .throttle = cypress_throttle,
212 .unthrottle = cypress_unthrottle,
213 .read_int_callback = cypress_read_int_callback,
214 .write_int_callback = cypress_write_int_callback,
215};
216
Greg Kroah-Hartmanea653702005-06-20 21:15:16 -0700217static struct usb_serial_driver cypress_hidcom_device = {
Greg Kroah-Hartman18fcac32005-06-20 21:15:16 -0700218 .driver = {
219 .owner = THIS_MODULE,
Greg Kroah-Hartman269bda12005-06-20 21:15:16 -0700220 .name = "cyphidcom",
Greg Kroah-Hartman18fcac32005-06-20 21:15:16 -0700221 },
Greg Kroah-Hartman269bda12005-06-20 21:15:16 -0700222 .description = "HID->COM RS232 Adapter",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 .id_table = id_table_cyphidcomrs232,
224 .num_interrupt_in = 1,
225 .num_interrupt_out = 1,
226 .num_bulk_in = NUM_DONT_CARE,
227 .num_bulk_out = NUM_DONT_CARE,
228 .num_ports = 1,
229 .attach = cypress_hidcom_startup,
230 .shutdown = cypress_shutdown,
231 .open = cypress_open,
232 .close = cypress_close,
233 .write = cypress_write,
234 .write_room = cypress_write_room,
235 .ioctl = cypress_ioctl,
236 .set_termios = cypress_set_termios,
237 .tiocmget = cypress_tiocmget,
238 .tiocmset = cypress_tiocmset,
239 .chars_in_buffer = cypress_chars_in_buffer,
240 .throttle = cypress_throttle,
241 .unthrottle = cypress_unthrottle,
242 .read_int_callback = cypress_read_int_callback,
243 .write_int_callback = cypress_write_int_callback,
244};
245
Lonnie Mendeza5c44e22006-03-01 10:45:24 -0600246static struct usb_serial_driver cypress_ca42v2_device = {
247 .driver = {
248 .owner = THIS_MODULE,
249 .name = "nokiaca42v2",
250 },
251 .description = "Nokia CA-42 V2 Adapter",
252 .id_table = id_table_nokiaca42v2,
253 .num_interrupt_in = 1,
254 .num_interrupt_out = 1,
255 .num_bulk_in = NUM_DONT_CARE,
256 .num_bulk_out = NUM_DONT_CARE,
257 .num_ports = 1,
258 .attach = cypress_ca42v2_startup,
259 .shutdown = cypress_shutdown,
260 .open = cypress_open,
261 .close = cypress_close,
262 .write = cypress_write,
263 .write_room = cypress_write_room,
264 .ioctl = cypress_ioctl,
265 .set_termios = cypress_set_termios,
266 .tiocmget = cypress_tiocmget,
267 .tiocmset = cypress_tiocmset,
268 .chars_in_buffer = cypress_chars_in_buffer,
269 .throttle = cypress_throttle,
270 .unthrottle = cypress_unthrottle,
271 .read_int_callback = cypress_read_int_callback,
272 .write_int_callback = cypress_write_int_callback,
273};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274
275/*****************************************************************************
276 * Cypress serial helper functions
277 *****************************************************************************/
278
279
Steven Cole093cf722005-05-03 19:07:24 -0600280/* This function can either set or retrieve the current serial line settings */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281static int cypress_serial_control (struct usb_serial_port *port, unsigned baud_mask, int data_bits, int stop_bits,
282 int parity_enable, int parity_type, int reset, int cypress_request_type)
283{
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500284 int new_baudrate = 0, retval = 0, tries = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 struct cypress_private *priv;
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500286 __u8 feature_buffer[8];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 unsigned long flags;
288
289 dbg("%s", __FUNCTION__);
290
291 priv = usb_get_serial_port_data(port);
292
293 switch(cypress_request_type) {
294 case CYPRESS_SET_CONFIG:
295
296 /*
297 * The general purpose firmware for the Cypress M8 allows for a maximum speed
298 * of 57600bps (I have no idea whether DeLorme chose to use the general purpose
299 * firmware or not), if you need to modify this speed setting for your own
300 * project please add your own chiptype and modify the code likewise. The
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500301 * Cypress HID->COM device will work successfully up to 115200bps (but the
302 * actual throughput is around 3kBps).
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 */
304 if (baud_mask != priv->cbr_mask) {
305 dbg("%s - baud rate is changing", __FUNCTION__);
306 if ( priv->chiptype == CT_EARTHMATE ) {
307 /* 300 and 600 baud rates are supported under the generic firmware,
308 * but are not used with NMEA and SiRF protocols */
309
310 if ( (baud_mask == B300) || (baud_mask == B600) ) {
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500311 err("%s - failed setting baud rate, unsupported speed",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312 __FUNCTION__);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500313 new_baudrate = priv->baud_rate;
314 } else if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
315 err("%s - failed setting baud rate, unsupported speed",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 __FUNCTION__);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500317 new_baudrate = priv->baud_rate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 }
319 } else if (priv->chiptype == CT_CYPHIDCOM) {
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500320 if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
321 err("%s - failed setting baud rate, unsupported speed",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 __FUNCTION__);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500323 new_baudrate = priv->baud_rate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 }
Lonnie Mendeza5c44e22006-03-01 10:45:24 -0600325 } else if (priv->chiptype == CT_CA42V2) {
326 if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
327 err("%s - failed setting baud rate, unsupported speed",
328 __FUNCTION__);
329 new_baudrate = priv->baud_rate;
330 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 } else if (priv->chiptype == CT_GENERIC) {
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500332 if ( (new_baudrate = mask_to_rate(baud_mask)) == -1) {
333 err("%s - failed setting baud rate, unsupported speed",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700334 __FUNCTION__);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500335 new_baudrate = priv->baud_rate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336 }
337 } else {
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500338 info("%s - please define your chiptype", __FUNCTION__);
339 new_baudrate = priv->baud_rate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340 }
341 } else { /* baud rate not changing, keep the old */
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500342 new_baudrate = priv->baud_rate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 }
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500344 dbg("%s - baud rate is being sent as %d", __FUNCTION__, new_baudrate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500346 memset(feature_buffer, 0, 8);
347 /* fill the feature_buffer with new configuration */
348 *((u_int32_t *)feature_buffer) = new_baudrate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500350 feature_buffer[4] |= data_bits; /* assign data bits in 2 bit space ( max 3 ) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 /* 1 bit gap */
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500352 feature_buffer[4] |= (stop_bits << 3); /* assign stop bits in 1 bit space */
353 feature_buffer[4] |= (parity_enable << 4); /* assign parity flag in 1 bit space */
354 feature_buffer[4] |= (parity_type << 5); /* assign parity type in 1 bit space */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355 /* 1 bit gap */
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500356 feature_buffer[4] |= (reset << 7); /* assign reset at end of byte, 1 bit space */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357
358 dbg("%s - device is being sent this feature report:", __FUNCTION__);
359 dbg("%s - %02X - %02X - %02X - %02X - %02X", __FUNCTION__, feature_buffer[0], feature_buffer[1],
360 feature_buffer[2], feature_buffer[3], feature_buffer[4]);
361
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500362 do {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 retval = usb_control_msg (port->serial->dev, usb_sndctrlpipe(port->serial->dev, 0),
364 HID_REQ_SET_REPORT, USB_DIR_OUT | USB_RECIP_INTERFACE | USB_TYPE_CLASS,
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500365 0x0300, 0, feature_buffer, 8, 500);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500367 if (tries++ >= 3)
368 break;
369
370 if (retval == EPIPE)
371 usb_clear_halt(port->serial->dev, 0x00);
372 } while (retval != 8 && retval != ENODEV);
373
374 if (retval != 8)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375 err("%s - failed sending serial line settings - %d", __FUNCTION__, retval);
376 else {
377 spin_lock_irqsave(&priv->lock, flags);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500378 priv->baud_rate = new_baudrate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 priv->cbr_mask = baud_mask;
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500380 priv->current_config = feature_buffer[4];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381 spin_unlock_irqrestore(&priv->lock, flags);
382 }
383 break;
384 case CYPRESS_GET_CONFIG:
385 dbg("%s - retreiving serial line settings", __FUNCTION__);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500386 /* set initial values in feature buffer */
387 memset(feature_buffer, 0, 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500389 do {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 retval = usb_control_msg (port->serial->dev, usb_rcvctrlpipe(port->serial->dev, 0),
391 HID_REQ_GET_REPORT, USB_DIR_IN | USB_RECIP_INTERFACE | USB_TYPE_CLASS,
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500392 0x0300, 0, feature_buffer, 8, 500);
393
394 if (tries++ >= 3)
395 break;
396
397 if (retval == EPIPE)
398 usb_clear_halt(port->serial->dev, 0x00);
399 } while (retval != 5 && retval != ENODEV);
400
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 if (retval != 5) {
Adrian Bunk943ffb52006-01-10 00:10:13 +0100402 err("%s - failed to retrieve serial line settings - %d", __FUNCTION__, retval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 return retval;
404 } else {
405 spin_lock_irqsave(&priv->lock, flags);
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500406
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 /* store the config in one byte, and later use bit masks to check values */
408 priv->current_config = feature_buffer[4];
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500409 priv->baud_rate = *((u_int32_t *)feature_buffer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500411 if ( (priv->cbr_mask = rate_to_mask(priv->baud_rate)) == 0x40)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 dbg("%s - failed setting the baud mask (not defined)", __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 spin_unlock_irqrestore(&priv->lock, flags);
414 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 }
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500416 spin_lock_irqsave(&priv->lock, flags);
417 ++priv->cmd_count;
418 spin_unlock_irqrestore(&priv->lock, flags);
419
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420 return retval;
421} /* cypress_serial_control */
422
423
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500424/* given a baud mask, it will return integer baud on success */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425static int mask_to_rate (unsigned mask)
426{
427 int rate;
428
429 switch (mask) {
430 case B0: rate = 0; break;
431 case B300: rate = 300; break;
432 case B600: rate = 600; break;
433 case B1200: rate = 1200; break;
434 case B2400: rate = 2400; break;
435 case B4800: rate = 4800; break;
436 case B9600: rate = 9600; break;
437 case B19200: rate = 19200; break;
438 case B38400: rate = 38400; break;
439 case B57600: rate = 57600; break;
440 case B115200: rate = 115200; break;
441 default: rate = -1;
442 }
443
444 return rate;
445}
446
447
448static unsigned rate_to_mask (int rate)
449{
450 unsigned mask;
451
452 switch (rate) {
453 case 0: mask = B0; break;
454 case 300: mask = B300; break;
455 case 600: mask = B600; break;
456 case 1200: mask = B1200; break;
457 case 2400: mask = B2400; break;
458 case 4800: mask = B4800; break;
459 case 9600: mask = B9600; break;
460 case 19200: mask = B19200; break;
461 case 38400: mask = B38400; break;
462 case 57600: mask = B57600; break;
463 case 115200: mask = B115200; break;
464 default: mask = 0x40;
465 }
466
467 return mask;
468}
469/*****************************************************************************
470 * Cypress serial driver functions
471 *****************************************************************************/
472
473
474static int generic_startup (struct usb_serial *serial)
475{
476 struct cypress_private *priv;
Mike Isely0257fa92006-08-29 22:06:59 -0500477 struct usb_serial_port *port = serial->port[0];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478
Mike Isely0257fa92006-08-29 22:06:59 -0500479 dbg("%s - port %d", __FUNCTION__, port->number);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480
Eric Sesterhenn80b6ca42006-02-27 21:29:43 +0100481 priv = kzalloc(sizeof (struct cypress_private), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 if (!priv)
483 return -ENOMEM;
484
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 spin_lock_init(&priv->lock);
486 priv->buf = cypress_buf_alloc(CYPRESS_BUF_SIZE);
487 if (priv->buf == NULL) {
488 kfree(priv);
489 return -ENOMEM;
490 }
491 init_waitqueue_head(&priv->delta_msr_wait);
492
493 usb_reset_configuration (serial->dev);
494
495 priv->cmd_ctrl = 0;
496 priv->line_control = 0;
497 priv->termios_initialized = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498 priv->rx_flags = 0;
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500499 priv->cbr_mask = B300;
Mike Isely0257fa92006-08-29 22:06:59 -0500500 if (interval > 0) {
501 priv->write_urb_interval = interval;
502 priv->read_urb_interval = interval;
503 dbg("%s - port %d read & write intervals forced to %d",
504 __FUNCTION__,port->number,interval);
505 } else {
506 priv->write_urb_interval = port->interrupt_out_urb->interval;
507 priv->read_urb_interval = port->interrupt_in_urb->interval;
508 dbg("%s - port %d intervals: read=%d write=%d",
509 __FUNCTION__,port->number,
510 priv->read_urb_interval,priv->write_urb_interval);
511 }
512 usb_set_serial_port_data(port, priv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700513
Lonnie Mendezb9db07f2005-07-12 17:21:31 -0500514 return 0;
515}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516
517
518static int cypress_earthmate_startup (struct usb_serial *serial)
519{
520 struct cypress_private *priv;
521
522 dbg("%s", __FUNCTION__);
523
524 if (generic_startup(serial)) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -0500525 dbg("%s - Failed setting up port %d", __FUNCTION__,
526 serial->port[0]->number);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527 return 1;
528 }
529
530 priv = usb_get_serial_port_data(serial->port[0]);
531 priv->chiptype = CT_EARTHMATE;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -0500532
533 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534} /* cypress_earthmate_startup */
535
536
537static int cypress_hidcom_startup (struct usb_serial *serial)
538{
539 struct cypress_private *priv;
540
541 dbg("%s", __FUNCTION__);
542
543 if (generic_startup(serial)) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -0500544 dbg("%s - Failed setting up port %d", __FUNCTION__,
545 serial->port[0]->number);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546 return 1;
547 }
548
549 priv = usb_get_serial_port_data(serial->port[0]);
550 priv->chiptype = CT_CYPHIDCOM;
551
Lonnie Mendezb9db07f2005-07-12 17:21:31 -0500552 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553} /* cypress_hidcom_startup */
554
555
Lonnie Mendeza5c44e22006-03-01 10:45:24 -0600556static int cypress_ca42v2_startup (struct usb_serial *serial)
557{
558 struct cypress_private *priv;
559
560 dbg("%s", __FUNCTION__);
561
562 if (generic_startup(serial)) {
563 dbg("%s - Failed setting up port %d", __FUNCTION__,
564 serial->port[0]->number);
565 return 1;
566 }
567
568 priv = usb_get_serial_port_data(serial->port[0]);
569 priv->chiptype = CT_CA42V2;
570
571 return 0;
572} /* cypress_ca42v2_startup */
573
574
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575static void cypress_shutdown (struct usb_serial *serial)
576{
577 struct cypress_private *priv;
578
579 dbg ("%s - port %d", __FUNCTION__, serial->port[0]->number);
580
581 /* all open ports are closed at this point */
582
583 priv = usb_get_serial_port_data(serial->port[0]);
584
585 if (priv) {
586 cypress_buf_free(priv->buf);
587 kfree(priv);
588 usb_set_serial_port_data(serial->port[0], NULL);
589 }
590}
591
592
593static int cypress_open (struct usb_serial_port *port, struct file *filp)
594{
595 struct cypress_private *priv = usb_get_serial_port_data(port);
596 struct usb_serial *serial = port->serial;
597 unsigned long flags;
598 int result = 0;
599
600 dbg("%s - port %d", __FUNCTION__, port->number);
601
602 /* clear halts before open */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603 usb_clear_halt(serial->dev, 0x81);
604 usb_clear_halt(serial->dev, 0x02);
605
606 spin_lock_irqsave(&priv->lock, flags);
607 /* reset read/write statistics */
608 priv->bytes_in = 0;
609 priv->bytes_out = 0;
610 priv->cmd_count = 0;
611 priv->rx_flags = 0;
612 spin_unlock_irqrestore(&priv->lock, flags);
613
614 /* setting to zero could cause data loss */
615 port->tty->low_latency = 1;
616
617 /* raise both lines and set termios */
618 spin_lock_irqsave(&priv->lock, flags);
619 priv->line_control = CONTROL_DTR | CONTROL_RTS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620 priv->cmd_ctrl = 1;
621 spin_unlock_irqrestore(&priv->lock, flags);
622 result = cypress_write(port, NULL, 0);
623
624 if (result) {
625 dev_err(&port->dev, "%s - failed setting the control lines - error %d\n", __FUNCTION__, result);
626 return result;
627 } else
628 dbg("%s - success setting the control lines", __FUNCTION__);
629
630 cypress_set_termios(port, &priv->tmp_termios);
631
632 /* setup the port and start reading from the device */
633 if(!port->interrupt_in_urb){
634 err("%s - interrupt_in_urb is empty!", __FUNCTION__);
635 return(-1);
636 }
637
638 usb_fill_int_urb(port->interrupt_in_urb, serial->dev,
639 usb_rcvintpipe(serial->dev, port->interrupt_in_endpointAddress),
640 port->interrupt_in_urb->transfer_buffer, port->interrupt_in_urb->transfer_buffer_length,
Mike Isely0257fa92006-08-29 22:06:59 -0500641 cypress_read_int_callback, port, priv->read_urb_interval);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700642 result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
643
644 if (result){
645 dev_err(&port->dev, "%s - failed submitting read urb, error %d\n", __FUNCTION__, result);
646 }
647
648 return result;
649} /* cypress_open */
650
651
652static void cypress_close(struct usb_serial_port *port, struct file * filp)
653{
654 struct cypress_private *priv = usb_get_serial_port_data(port);
655 unsigned int c_cflag;
656 unsigned long flags;
657 int bps;
658 long timeout;
659 wait_queue_t wait;
660
661 dbg("%s - port %d", __FUNCTION__, port->number);
662
663 /* wait for data to drain from buffer */
664 spin_lock_irqsave(&priv->lock, flags);
665 timeout = CYPRESS_CLOSING_WAIT;
666 init_waitqueue_entry(&wait, current);
667 add_wait_queue(&port->tty->write_wait, &wait);
668 for (;;) {
669 set_current_state(TASK_INTERRUPTIBLE);
670 if (cypress_buf_data_avail(priv->buf) == 0
671 || timeout == 0 || signal_pending(current)
672 || !usb_get_intfdata(port->serial->interface))
673 break;
674 spin_unlock_irqrestore(&priv->lock, flags);
675 timeout = schedule_timeout(timeout);
676 spin_lock_irqsave(&priv->lock, flags);
677 }
678 set_current_state(TASK_RUNNING);
679 remove_wait_queue(&port->tty->write_wait, &wait);
680 /* clear out any remaining data in the buffer */
681 cypress_buf_clear(priv->buf);
682 spin_unlock_irqrestore(&priv->lock, flags);
683
684 /* wait for characters to drain from device */
685 bps = tty_get_baud_rate(port->tty);
686 if (bps > 1200)
687 timeout = max((HZ*2560)/bps,HZ/10);
688 else
689 timeout = 2*HZ;
Nishanth Aravamudan22c43862005-08-15 11:30:11 -0700690 schedule_timeout_interruptible(timeout);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691
692 dbg("%s - stopping urbs", __FUNCTION__);
693 usb_kill_urb (port->interrupt_in_urb);
694 usb_kill_urb (port->interrupt_out_urb);
695
696 if (port->tty) {
697 c_cflag = port->tty->termios->c_cflag;
698 if (c_cflag & HUPCL) {
699 /* drop dtr and rts */
700 priv = usb_get_serial_port_data(port);
701 spin_lock_irqsave(&priv->lock, flags);
702 priv->line_control = 0;
703 priv->cmd_ctrl = 1;
704 spin_unlock_irqrestore(&priv->lock, flags);
705 cypress_write(port, NULL, 0);
706 }
707 }
708
709 if (stats)
710 dev_info (&port->dev, "Statistics: %d Bytes In | %d Bytes Out | %d Commands Issued\n",
711 priv->bytes_in, priv->bytes_out, priv->cmd_count);
712} /* cypress_close */
713
714
715static int cypress_write(struct usb_serial_port *port, const unsigned char *buf, int count)
716{
717 struct cypress_private *priv = usb_get_serial_port_data(port);
718 unsigned long flags;
719
720 dbg("%s - port %d, %d bytes", __FUNCTION__, port->number, count);
721
722 /* line control commands, which need to be executed immediately,
723 are not put into the buffer for obvious reasons.
724 */
725 if (priv->cmd_ctrl) {
726 count = 0;
727 goto finish;
728 }
729
730 if (!count)
731 return count;
732
733 spin_lock_irqsave(&priv->lock, flags);
734 count = cypress_buf_put(priv->buf, buf, count);
735 spin_unlock_irqrestore(&priv->lock, flags);
736
737finish:
738 cypress_send(port);
739
740 return count;
741} /* cypress_write */
742
743
744static void cypress_send(struct usb_serial_port *port)
745{
746 int count = 0, result, offset, actual_size;
747 struct cypress_private *priv = usb_get_serial_port_data(port);
748 unsigned long flags;
749
750 dbg("%s - port %d", __FUNCTION__, port->number);
751 dbg("%s - interrupt out size is %d", __FUNCTION__, port->interrupt_out_size);
752
753 spin_lock_irqsave(&priv->lock, flags);
754 if (priv->write_urb_in_use) {
755 dbg("%s - can't write, urb in use", __FUNCTION__);
756 spin_unlock_irqrestore(&priv->lock, flags);
757 return;
758 }
759 spin_unlock_irqrestore(&priv->lock, flags);
760
761 /* clear buffer */
762 memset(port->interrupt_out_urb->transfer_buffer, 0, port->interrupt_out_size);
763
764 spin_lock_irqsave(&priv->lock, flags);
765 switch (port->interrupt_out_size) {
766 case 32:
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500767 /* this is for the CY7C64013... */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700768 offset = 2;
769 port->interrupt_out_buffer[0] = priv->line_control;
770 break;
771 case 8:
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500772 /* this is for the CY7C63743... */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773 offset = 1;
774 port->interrupt_out_buffer[0] = priv->line_control;
775 break;
776 default:
777 dbg("%s - wrong packet size", __FUNCTION__);
778 spin_unlock_irqrestore(&priv->lock, flags);
779 return;
780 }
781
782 if (priv->line_control & CONTROL_RESET)
783 priv->line_control &= ~CONTROL_RESET;
784
785 if (priv->cmd_ctrl) {
786 priv->cmd_count++;
787 dbg("%s - line control command being issued", __FUNCTION__);
788 spin_unlock_irqrestore(&priv->lock, flags);
789 goto send;
790 } else
791 spin_unlock_irqrestore(&priv->lock, flags);
792
793 count = cypress_buf_get(priv->buf, &port->interrupt_out_buffer[offset],
794 port->interrupt_out_size-offset);
795
796 if (count == 0) {
797 return;
798 }
799
800 switch (port->interrupt_out_size) {
801 case 32:
802 port->interrupt_out_buffer[1] = count;
803 break;
804 case 8:
805 port->interrupt_out_buffer[0] |= count;
806 }
807
808 dbg("%s - count is %d", __FUNCTION__, count);
809
810send:
811 spin_lock_irqsave(&priv->lock, flags);
812 priv->write_urb_in_use = 1;
813 spin_unlock_irqrestore(&priv->lock, flags);
814
815 if (priv->cmd_ctrl)
816 actual_size = 1;
817 else
818 actual_size = count + (port->interrupt_out_size == 32 ? 2 : 1);
819
820 usb_serial_debug_data(debug, &port->dev, __FUNCTION__, port->interrupt_out_size,
821 port->interrupt_out_urb->transfer_buffer);
822
823 port->interrupt_out_urb->transfer_buffer_length = actual_size;
824 port->interrupt_out_urb->dev = port->serial->dev;
Mike Isely0257fa92006-08-29 22:06:59 -0500825 port->interrupt_out_urb->interval = priv->write_urb_interval;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826 result = usb_submit_urb (port->interrupt_out_urb, GFP_ATOMIC);
827 if (result) {
828 dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __FUNCTION__,
829 result);
830 priv->write_urb_in_use = 0;
831 }
832
833 spin_lock_irqsave(&priv->lock, flags);
834 if (priv->cmd_ctrl) {
835 priv->cmd_ctrl = 0;
836 }
837 priv->bytes_out += count; /* do not count the line control and size bytes */
838 spin_unlock_irqrestore(&priv->lock, flags);
839
Pete Zaitcevcf2c7482006-05-22 21:58:49 -0700840 usb_serial_port_softint(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841} /* cypress_send */
842
843
844/* returns how much space is available in the soft buffer */
845static int cypress_write_room(struct usb_serial_port *port)
846{
847 struct cypress_private *priv = usb_get_serial_port_data(port);
848 int room = 0;
849 unsigned long flags;
850
851 dbg("%s - port %d", __FUNCTION__, port->number);
852
853 spin_lock_irqsave(&priv->lock, flags);
854 room = cypress_buf_space_avail(priv->buf);
855 spin_unlock_irqrestore(&priv->lock, flags);
856
857 dbg("%s - returns %d", __FUNCTION__, room);
858 return room;
859}
860
861
862static int cypress_tiocmget (struct usb_serial_port *port, struct file *file)
863{
864 struct cypress_private *priv = usb_get_serial_port_data(port);
865 __u8 status, control;
866 unsigned int result = 0;
867 unsigned long flags;
868
869 dbg("%s - port %d", __FUNCTION__, port->number);
870
871 spin_lock_irqsave(&priv->lock, flags);
872 control = priv->line_control;
873 status = priv->current_status;
874 spin_unlock_irqrestore(&priv->lock, flags);
875
876 result = ((control & CONTROL_DTR) ? TIOCM_DTR : 0)
877 | ((control & CONTROL_RTS) ? TIOCM_RTS : 0)
878 | ((status & UART_CTS) ? TIOCM_CTS : 0)
879 | ((status & UART_DSR) ? TIOCM_DSR : 0)
880 | ((status & UART_RI) ? TIOCM_RI : 0)
881 | ((status & UART_CD) ? TIOCM_CD : 0);
882
883 dbg("%s - result = %x", __FUNCTION__, result);
884
885 return result;
886}
887
888
889static int cypress_tiocmset (struct usb_serial_port *port, struct file *file,
890 unsigned int set, unsigned int clear)
891{
892 struct cypress_private *priv = usb_get_serial_port_data(port);
893 unsigned long flags;
894
895 dbg("%s - port %d", __FUNCTION__, port->number);
896
897 spin_lock_irqsave(&priv->lock, flags);
898 if (set & TIOCM_RTS)
899 priv->line_control |= CONTROL_RTS;
900 if (set & TIOCM_DTR)
901 priv->line_control |= CONTROL_DTR;
902 if (clear & TIOCM_RTS)
903 priv->line_control &= ~CONTROL_RTS;
904 if (clear & TIOCM_DTR)
905 priv->line_control &= ~CONTROL_DTR;
906 spin_unlock_irqrestore(&priv->lock, flags);
907
908 priv->cmd_ctrl = 1;
909 return cypress_write(port, NULL, 0);
910}
911
912
913static int cypress_ioctl (struct usb_serial_port *port, struct file * file, unsigned int cmd, unsigned long arg)
914{
915 struct cypress_private *priv = usb_get_serial_port_data(port);
916
917 dbg("%s - port %d, cmd 0x%.4x", __FUNCTION__, port->number, cmd);
918
919 switch (cmd) {
920 case TIOCGSERIAL:
921 if (copy_to_user((void __user *)arg, port->tty->termios, sizeof(struct termios))) {
922 return -EFAULT;
923 }
924 return (0);
925 break;
926 case TIOCSSERIAL:
927 if (copy_from_user(port->tty->termios, (void __user *)arg, sizeof(struct termios))) {
928 return -EFAULT;
929 }
930 /* here we need to call cypress_set_termios to invoke the new settings */
931 cypress_set_termios(port, &priv->tmp_termios);
932 return (0);
933 break;
934 /* these are called when setting baud rate from gpsd */
935 case TCGETS:
936 if (copy_to_user((void __user *)arg, port->tty->termios, sizeof(struct termios))) {
937 return -EFAULT;
938 }
939 return (0);
940 break;
941 case TCSETS:
942 if (copy_from_user(port->tty->termios, (void __user *)arg, sizeof(struct termios))) {
943 return -EFAULT;
944 }
945 /* here we need to call cypress_set_termios to invoke the new settings */
946 cypress_set_termios(port, &priv->tmp_termios);
947 return (0);
948 break;
949 /* This code comes from drivers/char/serial.c and ftdi_sio.c */
950 case TIOCMIWAIT:
951 while (priv != NULL) {
952 interruptible_sleep_on(&priv->delta_msr_wait);
953 /* see if a signal did it */
954 if (signal_pending(current))
955 return -ERESTARTSYS;
956 else {
957 char diff = priv->diff_status;
958
959 if (diff == 0) {
960 return -EIO; /* no change => error */
961 }
962
963 /* consume all events */
964 priv->diff_status = 0;
965
966 /* return 0 if caller wanted to know about these bits */
967 if ( ((arg & TIOCM_RNG) && (diff & UART_RI)) ||
968 ((arg & TIOCM_DSR) && (diff & UART_DSR)) ||
969 ((arg & TIOCM_CD) && (diff & UART_CD)) ||
970 ((arg & TIOCM_CTS) && (diff & UART_CTS)) ) {
971 return 0;
972 }
973 /* otherwise caller can't care less about what happened,
974 * and so we continue to wait for more events.
975 */
976 }
977 }
978 return 0;
979 break;
980 default:
981 break;
982 }
983
984 dbg("%s - arg not supported - it was 0x%04x - check include/asm/ioctls.h", __FUNCTION__, cmd);
985
986 return -ENOIOCTLCMD;
987} /* cypress_ioctl */
988
989
Lonnie Mendezb9db07f2005-07-12 17:21:31 -0500990static void cypress_set_termios (struct usb_serial_port *port,
991 struct termios *old_termios)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992{
993 struct cypress_private *priv = usb_get_serial_port_data(port);
994 struct tty_struct *tty;
995 int data_bits, stop_bits, parity_type, parity_enable;
996 unsigned cflag, iflag, baud_mask;
997 unsigned long flags;
998 __u8 oldlines;
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -0500999 int linechange = 0;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001000
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001 dbg("%s - port %d", __FUNCTION__, port->number);
1002
1003 tty = port->tty;
1004 if ((!tty) || (!tty->termios)) {
1005 dbg("%s - no tty structures", __FUNCTION__);
1006 return;
1007 }
1008
1009 spin_lock_irqsave(&priv->lock, flags);
1010 if (!priv->termios_initialized) {
1011 if (priv->chiptype == CT_EARTHMATE) {
1012 *(tty->termios) = tty_std_termios;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001013 tty->termios->c_cflag = B4800 | CS8 | CREAD | HUPCL |
1014 CLOCAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001015 } else if (priv->chiptype == CT_CYPHIDCOM) {
1016 *(tty->termios) = tty_std_termios;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001017 tty->termios->c_cflag = B9600 | CS8 | CREAD | HUPCL |
1018 CLOCAL;
Lonnie Mendeza5c44e22006-03-01 10:45:24 -06001019 } else if (priv->chiptype == CT_CA42V2) {
1020 *(tty->termios) = tty_std_termios;
1021 tty->termios->c_cflag = B9600 | CS8 | CREAD | HUPCL |
1022 CLOCAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001023 }
1024 priv->termios_initialized = 1;
1025 }
1026 spin_unlock_irqrestore(&priv->lock, flags);
1027
1028 cflag = tty->termios->c_cflag;
1029 iflag = tty->termios->c_iflag;
1030
1031 /* check if there are new settings */
1032 if (old_termios) {
1033 if ((cflag != old_termios->c_cflag) ||
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001034 (RELEVANT_IFLAG(iflag) !=
1035 RELEVANT_IFLAG(old_termios->c_iflag))) {
1036 dbg("%s - attempting to set new termios settings",
1037 __FUNCTION__);
1038 /* should make a copy of this in case something goes
1039 * wrong in the function, we can restore it */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001040 spin_lock_irqsave(&priv->lock, flags);
1041 priv->tmp_termios = *(tty->termios);
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001042 spin_unlock_irqrestore(&priv->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043 } else {
1044 dbg("%s - nothing to do, exiting", __FUNCTION__);
1045 return;
1046 }
1047 } else
1048 return;
1049
1050 /* set number of data bits, parity, stop bits */
1051 /* when parity is disabled the parity type bit is ignored */
1052
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001053 /* 1 means 2 stop bits, 0 means 1 stop bit */
1054 stop_bits = cflag & CSTOPB ? 1 : 0;
1055
Linus Torvalds1da177e2005-04-16 15:20:36 -07001056 if (cflag & PARENB) {
1057 parity_enable = 1;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001058 /* 1 means odd parity, 0 means even parity */
1059 parity_type = cflag & PARODD ? 1 : 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001060 } else
1061 parity_enable = parity_type = 0;
1062
1063 if (cflag & CSIZE) {
1064 switch (cflag & CSIZE) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001065 case CS5:
1066 data_bits = 0;
1067 break;
1068 case CS6:
1069 data_bits = 1;
1070 break;
1071 case CS7:
1072 data_bits = 2;
1073 break;
1074 case CS8:
1075 data_bits = 3;
1076 break;
1077 default:
1078 err("%s - CSIZE was set, but not CS5-CS8",
1079 __FUNCTION__);
1080 data_bits = 3;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001081 }
1082 } else
1083 data_bits = 3;
1084
1085 spin_lock_irqsave(&priv->lock, flags);
1086 oldlines = priv->line_control;
1087 if ((cflag & CBAUD) == B0) {
1088 /* drop dtr and rts */
1089 dbg("%s - dropping the lines, baud rate 0bps", __FUNCTION__);
1090 baud_mask = B0;
1091 priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
1092 } else {
1093 baud_mask = (cflag & CBAUD);
1094 switch(baud_mask) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001095 case B300:
1096 dbg("%s - setting baud 300bps", __FUNCTION__);
1097 break;
1098 case B600:
1099 dbg("%s - setting baud 600bps", __FUNCTION__);
1100 break;
1101 case B1200:
1102 dbg("%s - setting baud 1200bps", __FUNCTION__);
1103 break;
1104 case B2400:
1105 dbg("%s - setting baud 2400bps", __FUNCTION__);
1106 break;
1107 case B4800:
1108 dbg("%s - setting baud 4800bps", __FUNCTION__);
1109 break;
1110 case B9600:
1111 dbg("%s - setting baud 9600bps", __FUNCTION__);
1112 break;
1113 case B19200:
1114 dbg("%s - setting baud 19200bps", __FUNCTION__);
1115 break;
1116 case B38400:
1117 dbg("%s - setting baud 38400bps", __FUNCTION__);
1118 break;
1119 case B57600:
1120 dbg("%s - setting baud 57600bps", __FUNCTION__);
1121 break;
1122 case B115200:
1123 dbg("%s - setting baud 115200bps", __FUNCTION__);
1124 break;
1125 default:
1126 dbg("%s - unknown masked baud rate", __FUNCTION__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001127 }
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001128 priv->line_control = (CONTROL_DTR | CONTROL_RTS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001129 }
1130 spin_unlock_irqrestore(&priv->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001132 dbg("%s - sending %d stop_bits, %d parity_enable, %d parity_type, "
1133 "%d data_bits (+5)", __FUNCTION__, stop_bits,
1134 parity_enable, parity_type, data_bits);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001135
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001136 cypress_serial_control(port, baud_mask, data_bits, stop_bits,
1137 parity_enable, parity_type, 0, CYPRESS_SET_CONFIG);
1138
1139 /* we perform a CYPRESS_GET_CONFIG so that the current settings are
1140 * filled into the private structure this should confirm that all is
1141 * working if it returns what we just set */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001142 cypress_serial_control(port, 0, 0, 0, 0, 0, 0, CYPRESS_GET_CONFIG);
1143
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001144 /* Here we can define custom tty settings for devices; the main tty
1145 * termios flag base comes from empeg.c */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001146
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001147 spin_lock_irqsave(&priv->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001148 if ( (priv->chiptype == CT_EARTHMATE) && (priv->baud_rate == 4800) ) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001149 dbg("Using custom termios settings for a baud rate of "
1150 "4800bps.");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001151 /* define custom termios settings for NMEA protocol */
1152
Linus Torvalds1da177e2005-04-16 15:20:36 -07001153 tty->termios->c_iflag /* input modes - */
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001154 &= ~(IGNBRK /* disable ignore break */
1155 | BRKINT /* disable break causes interrupt */
1156 | PARMRK /* disable mark parity errors */
1157 | ISTRIP /* disable clear high bit of input char */
1158 | INLCR /* disable translate NL to CR */
1159 | IGNCR /* disable ignore CR */
1160 | ICRNL /* disable translate CR to NL */
1161 | IXON); /* disable enable XON/XOFF flow control */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001163 tty->termios->c_oflag /* output modes */
1164 &= ~OPOST; /* disable postprocess output char */
1165
1166 tty->termios->c_lflag /* line discipline modes */
1167 &= ~(ECHO /* disable echo input characters */
1168 | ECHONL /* disable echo new line */
1169 | ICANON /* disable erase, kill, werase, and rprnt
1170 special characters */
1171 | ISIG /* disable interrupt, quit, and suspend
1172 special characters */
1173 | IEXTEN); /* disable non-POSIX special characters */
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001174 } /* CT_CYPHIDCOM: Application should handle this for device */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001175
Linus Torvalds1da177e2005-04-16 15:20:36 -07001176 linechange = (priv->line_control != oldlines);
1177 spin_unlock_irqrestore(&priv->lock, flags);
1178
1179 /* if necessary, set lines */
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001180 if (linechange) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001181 priv->cmd_ctrl = 1;
1182 cypress_write(port, NULL, 0);
1183 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001184} /* cypress_set_termios */
1185
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001186
Linus Torvalds1da177e2005-04-16 15:20:36 -07001187/* returns amount of data still left in soft buffer */
1188static int cypress_chars_in_buffer(struct usb_serial_port *port)
1189{
1190 struct cypress_private *priv = usb_get_serial_port_data(port);
1191 int chars = 0;
1192 unsigned long flags;
1193
1194 dbg("%s - port %d", __FUNCTION__, port->number);
1195
1196 spin_lock_irqsave(&priv->lock, flags);
1197 chars = cypress_buf_data_avail(priv->buf);
1198 spin_unlock_irqrestore(&priv->lock, flags);
1199
1200 dbg("%s - returns %d", __FUNCTION__, chars);
1201 return chars;
1202}
1203
1204
1205static void cypress_throttle (struct usb_serial_port *port)
1206{
1207 struct cypress_private *priv = usb_get_serial_port_data(port);
1208 unsigned long flags;
1209
1210 dbg("%s - port %d", __FUNCTION__, port->number);
1211
1212 spin_lock_irqsave(&priv->lock, flags);
1213 priv->rx_flags = THROTTLED;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001214 spin_unlock_irqrestore(&priv->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001215}
1216
1217
1218static void cypress_unthrottle (struct usb_serial_port *port)
1219{
1220 struct cypress_private *priv = usb_get_serial_port_data(port);
1221 int actually_throttled, result;
1222 unsigned long flags;
1223
1224 dbg("%s - port %d", __FUNCTION__, port->number);
1225
1226 spin_lock_irqsave(&priv->lock, flags);
1227 actually_throttled = priv->rx_flags & ACTUALLY_THROTTLED;
1228 priv->rx_flags = 0;
1229 spin_unlock_irqrestore(&priv->lock, flags);
1230
1231 if (actually_throttled) {
1232 port->interrupt_in_urb->dev = port->serial->dev;
1233
1234 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
1235 if (result)
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001236 dev_err(&port->dev, "%s - failed submitting read urb, "
1237 "error %d\n", __FUNCTION__, result);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001238 }
1239}
1240
1241
1242static void cypress_read_int_callback(struct urb *urb, struct pt_regs *regs)
1243{
1244 struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
1245 struct cypress_private *priv = usb_get_serial_port_data(port);
1246 struct tty_struct *tty;
1247 unsigned char *data = urb->transfer_buffer;
1248 unsigned long flags;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001249 char tty_flag = TTY_NORMAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250 int havedata = 0;
1251 int bytes = 0;
1252 int result;
1253 int i = 0;
1254
1255 dbg("%s - port %d", __FUNCTION__, port->number);
1256
1257 if (urb->status) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001258 dbg("%s - nonzero read status received: %d", __FUNCTION__,
1259 urb->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001260 return;
1261 }
1262
1263 spin_lock_irqsave(&priv->lock, flags);
1264 if (priv->rx_flags & THROTTLED) {
1265 dbg("%s - now throttling", __FUNCTION__);
1266 priv->rx_flags |= ACTUALLY_THROTTLED;
1267 spin_unlock_irqrestore(&priv->lock, flags);
1268 return;
1269 }
1270 spin_unlock_irqrestore(&priv->lock, flags);
1271
1272 tty = port->tty;
1273 if (!tty) {
1274 dbg("%s - bad tty pointer - exiting", __FUNCTION__);
1275 return;
1276 }
1277
1278 spin_lock_irqsave(&priv->lock, flags);
1279 switch(urb->actual_length) {
1280 case 32:
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001281 /* This is for the CY7C64013... */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001282 priv->current_status = data[0] & 0xF8;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001283 bytes = data[1] + 2;
1284 i = 2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001285 if (bytes > 2)
1286 havedata = 1;
1287 break;
1288 case 8:
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001289 /* This is for the CY7C63743... */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290 priv->current_status = data[0] & 0xF8;
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001291 bytes = (data[0] & 0x07) + 1;
1292 i = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293 if (bytes > 1)
1294 havedata = 1;
1295 break;
1296 default:
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001297 dbg("%s - wrong packet size - received %d bytes",
1298 __FUNCTION__, urb->actual_length);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299 spin_unlock_irqrestore(&priv->lock, flags);
1300 goto continue_read;
1301 }
1302 spin_unlock_irqrestore(&priv->lock, flags);
1303
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001304 usb_serial_debug_data (debug, &port->dev, __FUNCTION__,
1305 urb->actual_length, data);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306
1307 spin_lock_irqsave(&priv->lock, flags);
1308 /* check to see if status has changed */
1309 if (priv != NULL) {
1310 if (priv->current_status != priv->prev_status) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001311 priv->diff_status |= priv->current_status ^
1312 priv->prev_status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001313 wake_up_interruptible(&priv->delta_msr_wait);
1314 priv->prev_status = priv->current_status;
1315 }
1316 }
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001317 spin_unlock_irqrestore(&priv->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001319 /* hangup, as defined in acm.c... this might be a bad place for it
1320 * though */
1321 if (tty && !(tty->termios->c_cflag & CLOCAL) &&
1322 !(priv->current_status & UART_CD)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001323 dbg("%s - calling hangup", __FUNCTION__);
1324 tty_hangup(tty);
1325 goto continue_read;
1326 }
1327
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001328 /* There is one error bit... I'm assuming it is a parity error
1329 * indicator as the generic firmware will set this bit to 1 if a
1330 * parity error occurs.
1331 * I can not find reference to any other error events. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332 spin_lock_irqsave(&priv->lock, flags);
1333 if (priv->current_status & CYP_ERROR) {
1334 spin_unlock_irqrestore(&priv->lock, flags);
1335 tty_flag = TTY_PARITY;
1336 dbg("%s - Parity Error detected", __FUNCTION__);
1337 } else
1338 spin_unlock_irqrestore(&priv->lock, flags);
1339
1340 /* process read if there is data other than line status */
1341 if (tty && (bytes > i)) {
Alan Cox33f0f882006-01-09 20:54:13 -08001342 bytes = tty_buffer_request_room(tty, bytes);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001343 for (; i < bytes ; ++i) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001344 dbg("pushing byte number %d - %d - %c", i, data[i],
1345 data[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346 tty_insert_flip_char(tty, data[i], tty_flag);
1347 }
1348 tty_flip_buffer_push(port->tty);
1349 }
1350
1351 spin_lock_irqsave(&priv->lock, flags);
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001352 /* control and status byte(s) are also counted */
1353 priv->bytes_in += bytes;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001354 spin_unlock_irqrestore(&priv->lock, flags);
1355
1356continue_read:
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001357
1358 /* Continue trying to always read... unless the port has closed. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359
1360 if (port->open_count > 0) {
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001361 usb_fill_int_urb(port->interrupt_in_urb, port->serial->dev,
1362 usb_rcvintpipe(port->serial->dev,
1363 port->interrupt_in_endpointAddress),
1364 port->interrupt_in_urb->transfer_buffer,
1365 port->interrupt_in_urb->transfer_buffer_length,
Mike Isely0257fa92006-08-29 22:06:59 -05001366 cypress_read_int_callback, port, priv->read_urb_interval);
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001367 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
1368 if (result)
1369 dev_err(&urb->dev->dev, "%s - failed resubmitting "
1370 "read urb, error %d\n", __FUNCTION__,
1371 result);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001372 }
Lonnie Mendezb9db07f2005-07-12 17:21:31 -05001373
Linus Torvalds1da177e2005-04-16 15:20:36 -07001374 return;
1375} /* cypress_read_int_callback */
1376
1377
1378static void cypress_write_int_callback(struct urb *urb, struct pt_regs *regs)
1379{
1380 struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
1381 struct cypress_private *priv = usb_get_serial_port_data(port);
1382 int result;
1383
1384 dbg("%s - port %d", __FUNCTION__, port->number);
1385
1386 switch (urb->status) {
1387 case 0:
1388 /* success */
1389 break;
1390 case -ECONNRESET:
1391 case -ENOENT:
1392 case -ESHUTDOWN:
1393 /* this urb is terminated, clean up */
1394 dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
1395 priv->write_urb_in_use = 0;
1396 return;
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001397 case -EPIPE: /* no break needed */
1398 usb_clear_halt(port->serial->dev, 0x02);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001399 default:
1400 /* error in the urb, so we have to resubmit it */
1401 dbg("%s - Overflow in write", __FUNCTION__);
1402 dbg("%s - nonzero write bulk status received: %d", __FUNCTION__, urb->status);
1403 port->interrupt_out_urb->transfer_buffer_length = 1;
1404 port->interrupt_out_urb->dev = port->serial->dev;
1405 result = usb_submit_urb(port->interrupt_out_urb, GFP_ATOMIC);
1406 if (result)
1407 dev_err(&urb->dev->dev, "%s - failed resubmitting write urb, error %d\n",
1408 __FUNCTION__, result);
1409 else
1410 return;
1411 }
1412
1413 priv->write_urb_in_use = 0;
1414
1415 /* send any buffered data */
1416 cypress_send(port);
1417}
1418
1419
1420/*****************************************************************************
1421 * Write buffer functions - buffering code from pl2303 used
1422 *****************************************************************************/
1423
1424/*
1425 * cypress_buf_alloc
1426 *
1427 * Allocate a circular buffer and all associated memory.
1428 */
1429
1430static struct cypress_buf *cypress_buf_alloc(unsigned int size)
1431{
1432
1433 struct cypress_buf *cb;
1434
1435
1436 if (size == 0)
1437 return NULL;
1438
1439 cb = (struct cypress_buf *)kmalloc(sizeof(struct cypress_buf), GFP_KERNEL);
1440 if (cb == NULL)
1441 return NULL;
1442
1443 cb->buf_buf = kmalloc(size, GFP_KERNEL);
1444 if (cb->buf_buf == NULL) {
1445 kfree(cb);
1446 return NULL;
1447 }
1448
1449 cb->buf_size = size;
1450 cb->buf_get = cb->buf_put = cb->buf_buf;
1451
1452 return cb;
1453
1454}
1455
1456
1457/*
1458 * cypress_buf_free
1459 *
1460 * Free the buffer and all associated memory.
1461 */
1462
1463static void cypress_buf_free(struct cypress_buf *cb)
1464{
Jesper Juhl1bc3c9e2005-04-18 17:39:34 -07001465 if (cb) {
1466 kfree(cb->buf_buf);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001467 kfree(cb);
1468 }
1469}
1470
1471
1472/*
1473 * cypress_buf_clear
1474 *
1475 * Clear out all data in the circular buffer.
1476 */
1477
1478static void cypress_buf_clear(struct cypress_buf *cb)
1479{
1480 if (cb != NULL)
1481 cb->buf_get = cb->buf_put;
1482 /* equivalent to a get of all data available */
1483}
1484
1485
1486/*
1487 * cypress_buf_data_avail
1488 *
1489 * Return the number of bytes of data available in the circular
1490 * buffer.
1491 */
1492
1493static unsigned int cypress_buf_data_avail(struct cypress_buf *cb)
1494{
1495 if (cb != NULL)
1496 return ((cb->buf_size + cb->buf_put - cb->buf_get) % cb->buf_size);
1497 else
1498 return 0;
1499}
1500
1501
1502/*
1503 * cypress_buf_space_avail
1504 *
1505 * Return the number of bytes of space available in the circular
1506 * buffer.
1507 */
1508
1509static unsigned int cypress_buf_space_avail(struct cypress_buf *cb)
1510{
1511 if (cb != NULL)
1512 return ((cb->buf_size + cb->buf_get - cb->buf_put - 1) % cb->buf_size);
1513 else
1514 return 0;
1515}
1516
1517
1518/*
1519 * cypress_buf_put
1520 *
1521 * Copy data data from a user buffer and put it into the circular buffer.
1522 * Restrict to the amount of space available.
1523 *
1524 * Return the number of bytes copied.
1525 */
1526
1527static unsigned int cypress_buf_put(struct cypress_buf *cb, const char *buf,
1528 unsigned int count)
1529{
1530
1531 unsigned int len;
1532
1533
1534 if (cb == NULL)
1535 return 0;
1536
1537 len = cypress_buf_space_avail(cb);
1538 if (count > len)
1539 count = len;
1540
1541 if (count == 0)
1542 return 0;
1543
1544 len = cb->buf_buf + cb->buf_size - cb->buf_put;
1545 if (count > len) {
1546 memcpy(cb->buf_put, buf, len);
1547 memcpy(cb->buf_buf, buf+len, count - len);
1548 cb->buf_put = cb->buf_buf + count - len;
1549 } else {
1550 memcpy(cb->buf_put, buf, count);
1551 if (count < len)
1552 cb->buf_put += count;
1553 else /* count == len */
1554 cb->buf_put = cb->buf_buf;
1555 }
1556
1557 return count;
1558
1559}
1560
1561
1562/*
1563 * cypress_buf_get
1564 *
1565 * Get data from the circular buffer and copy to the given buffer.
1566 * Restrict to the amount of data available.
1567 *
1568 * Return the number of bytes copied.
1569 */
1570
1571static unsigned int cypress_buf_get(struct cypress_buf *cb, char *buf,
1572 unsigned int count)
1573{
1574
1575 unsigned int len;
1576
1577
1578 if (cb == NULL)
1579 return 0;
1580
1581 len = cypress_buf_data_avail(cb);
1582 if (count > len)
1583 count = len;
1584
1585 if (count == 0)
1586 return 0;
1587
1588 len = cb->buf_buf + cb->buf_size - cb->buf_get;
1589 if (count > len) {
1590 memcpy(buf, cb->buf_get, len);
1591 memcpy(buf+len, cb->buf_buf, count - len);
1592 cb->buf_get = cb->buf_buf + count - len;
1593 } else {
1594 memcpy(buf, cb->buf_get, count);
1595 if (count < len)
1596 cb->buf_get += count;
1597 else /* count == len */
1598 cb->buf_get = cb->buf_buf;
1599 }
1600
1601 return count;
1602
1603}
1604
1605/*****************************************************************************
1606 * Module functions
1607 *****************************************************************************/
1608
1609static int __init cypress_init(void)
1610{
1611 int retval;
1612
1613 dbg("%s", __FUNCTION__);
1614
1615 retval = usb_serial_register(&cypress_earthmate_device);
1616 if (retval)
1617 goto failed_em_register;
1618 retval = usb_serial_register(&cypress_hidcom_device);
1619 if (retval)
1620 goto failed_hidcom_register;
Lonnie Mendeza5c44e22006-03-01 10:45:24 -06001621 retval = usb_serial_register(&cypress_ca42v2_device);
1622 if (retval)
1623 goto failed_ca42v2_register;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001624 retval = usb_register(&cypress_driver);
1625 if (retval)
1626 goto failed_usb_register;
1627
1628 info(DRIVER_DESC " " DRIVER_VERSION);
1629 return 0;
1630failed_usb_register:
1631 usb_deregister(&cypress_driver);
Lonnie Mendeza5c44e22006-03-01 10:45:24 -06001632failed_ca42v2_register:
1633 usb_serial_deregister(&cypress_ca42v2_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001634failed_hidcom_register:
1635 usb_serial_deregister(&cypress_hidcom_device);
1636failed_em_register:
1637 usb_serial_deregister(&cypress_earthmate_device);
1638
1639 return retval;
1640}
1641
1642
1643static void __exit cypress_exit (void)
1644{
1645 dbg("%s", __FUNCTION__);
1646
1647 usb_deregister (&cypress_driver);
1648 usb_serial_deregister (&cypress_earthmate_device);
1649 usb_serial_deregister (&cypress_hidcom_device);
Lonnie Mendeza5c44e22006-03-01 10:45:24 -06001650 usb_serial_deregister (&cypress_ca42v2_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001651}
1652
1653
1654module_init(cypress_init);
1655module_exit(cypress_exit);
1656
1657MODULE_AUTHOR( DRIVER_AUTHOR );
1658MODULE_DESCRIPTION( DRIVER_DESC );
1659MODULE_VERSION( DRIVER_VERSION );
1660MODULE_LICENSE("GPL");
1661
1662module_param(debug, bool, S_IRUGO | S_IWUSR);
1663MODULE_PARM_DESC(debug, "Debug enabled or not");
1664module_param(stats, bool, S_IRUGO | S_IWUSR);
1665MODULE_PARM_DESC(stats, "Enable statistics or not");
Lonnie Mendez3cb4a4f2005-05-03 17:02:20 -05001666module_param(interval, int, S_IRUGO | S_IWUSR);
1667MODULE_PARM_DESC(interval, "Overrides interrupt interval");