Skip to content

R
raspberrypi-kernel

openeuler / raspberrypi-kernel

通知 13
Star 1
Fork 0
R
raspberrypi-kernel
提交 813a224f 编写于 作者: A Alan Cox 提交者： Linus Torvalds
浏览文件
操作

cypress_m8: coding style 

Coding style clean ups
Signed-off-by: NAlan Cox <alan@redhat.com>
Signed-off-by: NGreg Kroah-Hartman <gregkh@suse.de>
Signed-off-by: NLinus Torvalds <torvalds@linux-foundation.org>
上级 b9c52f15
显示空白变更内容
内联 并排
Showing with 324 addition and 293 deletion
drivers/usb/serial/cypress_m8.c
浏览文件 @ 813a224f
...@@ -11,19 +11,21 @@ ...@@ -11,19 +11,21 @@
* the Free Software Foundation; either version 2 of the License, or * the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version. * (at your option) any later version.
* *
* See Documentation/usb/usb-serial.txt for more information on using this driver * See Documentation/usb/usb-serial.txt for more information on using this
* driver
* *
* See http://geocities.com/i0xox0i for information on this driver and the * See http://geocities.com/i0xox0i for information on this driver and the
* earthmate usb device. * earthmate usb device.
* *
* Lonnie Mendez <dignome@gmail.com> * Lonnie Mendez <dignome@gmail.com>
* 4-29-2005 * 4-29-2005
* Fixed problem where setting or retreiving the serial config would fail with * Fixed problem where setting or retreiving the serial config would fail
* EPIPE. Removed CRTS toggling so the driver behaves more like other usbserial * with EPIPE. Removed CRTS toggling so the driver behaves more like
* adapters. Issued new interval of 1ms instead of the default 10ms. As a * other usbserial adapters. Issued new interval of 1ms instead of the
* result, transfer speed has been substantially increased. From avg. 850bps to * default 10ms. As a result, transfer speed has been substantially
* avg. 3300bps. initial termios has also been modified. Cleaned up code and * increased from avg. 850bps to avg. 3300bps. initial termios has also
* formatting issues so it is more readable. Replaced the C++ style comments. * been modified. Cleaned up code and formatting issues so it is more
* readable. Replaced the C++ style comments.
* *
* Lonnie Mendez <dignome@gmail.com> * Lonnie Mendez <dignome@gmail.com>
* 12-15-2004 * 12-15-2004
...@@ -42,10 +44,11 @@ ...@@ -42,10 +44,11 @@
* *
*/ */
/* Thanks to Neil Whelchel for writing the first cypress m8 implementation for linux. */ /* Thanks to Neil Whelchel for writing the first cypress m8 implementation
for linux. */
/* Thanks to cypress for providing references for the hid reports. */ /* Thanks to cypress for providing references for the hid reports. */
/* Thanks to Jiang Zhang for providing links and for general help. */ /* Thanks to Jiang Zhang for providing links and for general help. */
/* Code originates and was built up from ftdi_sio, belkin, pl2303 and others. */ /* Code originates and was built up from ftdi_sio, belkin, pl2303 and others.*/
#include <linux/kernel.h> #include <linux/kernel.h>
...@@ -62,7 +65,7 @@ ...@@ -62,7 +65,7 @@
#include <linux/usb/serial.h> #include <linux/usb/serial.h>
#include <linux/serial.h> #include <linux/serial.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <asm/uaccess.h> #include <linux/uaccess.h>
#include "cypress_m8.h" #include "cypress_m8.h"
...@@ -112,7 +115,7 @@ static struct usb_device_id id_table_combined [] = { ...@@ -112,7 +115,7 @@ static struct usb_device_id id_table_combined [] = {
{ } /* Terminating entry */ { } /* Terminating entry */
}; };
MODULE_DEVICE_TABLE (usb, id_table_combined); MODULE_DEVICE_TABLE(usb, id_table_combined);
static struct usb_driver cypress_driver = { static struct usb_driver cypress_driver = {
.name = "cypress", .name = "cypress",
...@@ -146,11 +149,13 @@ struct cypress_private { ...@@ -146,11 +149,13 @@ struct cypress_private {
__u8 rx_flags; /* throttling - used from whiteheat/ftdi_sio */ __u8 rx_flags; /* throttling - used from whiteheat/ftdi_sio */
enum packet_format pkt_fmt; /* format to use for packet send / receive */ enum packet_format pkt_fmt; /* format to use for packet send / receive */
int get_cfg_unsafe; /* If true, the CYPRESS_GET_CONFIG is unsafe */ int get_cfg_unsafe; /* If true, the CYPRESS_GET_CONFIG is unsafe */
int baud_rate; /* stores current baud rate in integer form */ int baud_rate; /* stores current baud rate in
integer form */
int isthrottled; /* if throttled, discard reads */ int isthrottled; /* if throttled, discard reads */
wait_queue_head_t delta_msr_wait; /* used for TIOCMIWAIT */ wait_queue_head_t delta_msr_wait; /* used for TIOCMIWAIT */
char prev_status, diff_status; /* used for TIOCMIWAIT */ char prev_status, diff_status; /* used for TIOCMIWAIT */
/* we pass a pointer to this as the arguement sent to cypress_set_termios old_termios */ /* we pass a pointer to this as the arguement sent to
cypress_set_termios old_termios */
struct ktermios tmp_termios; /* stores the old termios settings */ struct ktermios tmp_termios; /* stores the old termios settings */
}; };
...@@ -163,33 +168,41 @@ struct cypress_buf { ...@@ -163,33 +168,41 @@ struct cypress_buf {
}; };
/* function prototypes for the Cypress USB to serial device */ /* function prototypes for the Cypress USB to serial device */
static int cypress_earthmate_startup (struct usb_serial *serial); static int cypress_earthmate_startup(struct usb_serial *serial);
static int cypress_hidcom_startup (struct usb_serial *serial); static int cypress_hidcom_startup(struct usb_serial *serial);
static int cypress_ca42v2_startup (struct usb_serial *serial); static int cypress_ca42v2_startup(struct usb_serial *serial);
static void cypress_shutdown (struct usb_serial *serial); static void cypress_shutdown(struct usb_serial *serial);
static int cypress_open (struct tty_struct *tty, struct usb_serial_port *port, struct file *filp); static int cypress_open(struct tty_struct *tty,
static void cypress_close (struct tty_struct *tty, struct usb_serial_port *port, struct file *filp); struct usb_serial_port *port, struct file *filp);
static int cypress_write (struct tty_struct *tty, struct usb_serial_port *port, const unsigned char *buf, int count); static void cypress_close(struct tty_struct *tty,
static void cypress_send (struct usb_serial_port *port); struct usb_serial_port *port, struct file *filp);
static int cypress_write_room (struct tty_struct *tty); static int cypress_write(struct tty_struct *tty, struct usb_serial_port *port,
static int cypress_ioctl (struct tty_struct *tty, struct file * file, unsigned int cmd, unsigned long arg); const unsigned char *buf, int count);
static void cypress_set_termios (struct tty_struct *tty, struct usb_serial_port *port, struct ktermios * old); static void cypress_send(struct usb_serial_port *port);
static int cypress_tiocmget (struct tty_struct *tty, struct file *file); static int cypress_write_room(struct tty_struct *tty);
static int cypress_tiocmset (struct tty_struct *tty, struct file *file, unsigned int set, unsigned int clear); static int cypress_ioctl(struct tty_struct *tty, struct file *file,
static int cypress_chars_in_buffer (struct tty_struct *tty); unsigned int cmd, unsigned long arg);
static void cypress_throttle (struct tty_struct *tty); static void cypress_set_termios(struct tty_struct *tty,
static void cypress_unthrottle (struct tty_struct *tty); struct usb_serial_port *port, struct ktermios *old);
static void cypress_set_dead (struct usb_serial_port *port); static int cypress_tiocmget(struct tty_struct *tty, struct file *file);
static void cypress_read_int_callback (struct urb *urb); static int cypress_tiocmset(struct tty_struct *tty, struct file *file,
static void cypress_write_int_callback (struct urb *urb); unsigned int set, unsigned int clear);
static int cypress_chars_in_buffer(struct tty_struct *tty);
static void cypress_throttle(struct tty_struct *tty);
static void cypress_unthrottle(struct tty_struct *tty);
static void cypress_set_dead(struct usb_serial_port *port);
static void cypress_read_int_callback(struct urb *urb);
static void cypress_write_int_callback(struct urb *urb);
/* write buffer functions */ /* write buffer functions */
static struct cypress_buf *cypress_buf_alloc(unsigned int size); static struct cypress_buf *cypress_buf_alloc(unsigned int size);
static void cypress_buf_free(struct cypress_buf *cb); static void cypress_buf_free(struct cypress_buf *cb);
static void cypress_buf_clear(struct cypress_buf *cb); static void cypress_buf_clear(struct cypress_buf *cb);
static unsigned int cypress_buf_data_avail(struct cypress_buf *cb); static unsigned int cypress_buf_data_avail(struct cypress_buf *cb);
static unsigned int cypress_buf_space_avail(struct cypress_buf *cb); static unsigned int cypress_buf_space_avail(struct cypress_buf *cb);
static unsigned int cypress_buf_put(struct cypress_buf *cb, const char *buf, unsigned int count); static unsigned int cypress_buf_put(struct cypress_buf *cb,
static unsigned int cypress_buf_get(struct cypress_buf *cb, char *buf, unsigned int count); const char *buf, unsigned int count);
static unsigned int cypress_buf_get(struct cypress_buf *cb,
char *buf, unsigned int count);
static struct usb_serial_driver cypress_earthmate_device = { static struct usb_serial_driver cypress_earthmate_device = {
...@@ -322,7 +335,7 @@ static int analyze_baud_rate(struct usb_serial_port *port, speed_t new_rate) ...@@ -322,7 +335,7 @@ static int analyze_baud_rate(struct usb_serial_port *port, speed_t new_rate)
/* This function can either set or retrieve the current serial line settings */ /* This function can either set or retrieve the current serial line settings */
static int cypress_serial_control (struct tty_struct *tty, static int cypress_serial_control(struct tty_struct *tty,
struct usb_serial_port *port, speed_t baud_rate, int data_bits, struct usb_serial_port *port, speed_t baud_rate, int data_bits,
int stop_bits, int parity_enable, int parity_type, int reset, int stop_bits, int parity_enable, int parity_type, int reset,
int cypress_request_type) int cypress_request_type)
...@@ -339,7 +352,7 @@ static int cypress_serial_control (struct tty_struct *tty, ...@@ -339,7 +352,7 @@ static int cypress_serial_control (struct tty_struct *tty,
if (!priv->comm_is_ok) if (!priv->comm_is_ok)
return -ENODEV; return -ENODEV;
switch(cypress_request_type) { switch (cypress_request_type) {
case CYPRESS_SET_CONFIG: case CYPRESS_SET_CONFIG:
new_baudrate = priv->baud_rate; new_baudrate = priv->baud_rate;
/* 0 means 'Hang up' so doesn't change the true bit rate */ /* 0 means 'Hang up' so doesn't change the true bit rate */
...@@ -355,12 +368,12 @@ static int cypress_serial_control (struct tty_struct *tty, ...@@ -355,12 +368,12 @@ static int cypress_serial_control (struct tty_struct *tty,
__func__, new_baudrate); __func__, new_baudrate);
} }
} }
dbg("%s - baud rate is being sent as %d", __func__, new_baudrate); dbg("%s - baud rate is being sent as %d",
__func__, new_baudrate);
memset(feature_buffer, 0, sizeof(feature_buffer)); memset(feature_buffer, 0, sizeof(feature_buffer));
/* fill the feature_buffer with new configuration */ /* fill the feature_buffer with new configuration */
*((u_int32_t *)feature_buffer) = new_baudrate; *((u_int32_t *)feature_buffer) = new_baudrate;
feature_buffer[4] |= data_bits; /* assign data bits in 2 bit space ( max 3 ) */ feature_buffer[4] |= data_bits; /* assign data bits in 2 bit space ( max 3 ) */
/* 1 bit gap */ /* 1 bit gap */
feature_buffer[4] |= (stop_bits << 3); /* assign stop bits in 1 bit space */ feature_buffer[4] |= (stop_bits << 3); /* assign stop bits in 1 bit space */
...@@ -369,9 +382,12 @@ static int cypress_serial_control (struct tty_struct *tty, ...@@ -369,9 +382,12 @@ static int cypress_serial_control (struct tty_struct *tty,
/* 1 bit gap */ /* 1 bit gap */
feature_buffer[4] |= (reset << 7); /* assign reset at end of byte, 1 bit space */ feature_buffer[4] |= (reset << 7); /* assign reset at end of byte, 1 bit space */
dbg("%s - device is being sent this feature report:", __func__); dbg("%s - device is being sent this feature report:",
dbg("%s - %02X - %02X - %02X - %02X - %02X", __func__, feature_buffer[0], feature_buffer[1], __func__);
feature_buffer[2], feature_buffer[3], feature_buffer[4]); dbg("%s - %02X - %02X - %02X - %02X - %02X", __func__,
feature_buffer[0], feature_buffer[1],
feature_buffer[2], feature_buffer[3],
feature_buffer[4]);
do { do {
retval = usb_control_msg(port->serial->dev, retval = usb_control_msg(port->serial->dev,
...@@ -388,7 +404,8 @@ static int cypress_serial_control (struct tty_struct *tty, ...@@ -388,7 +404,8 @@ static int cypress_serial_control (struct tty_struct *tty,
retval != -ENODEV); retval != -ENODEV);
if (retval != sizeof(feature_buffer)) { if (retval != sizeof(feature_buffer)) {
err("%s - failed sending serial line settings - %d", __func__, retval); err("%s - failed sending serial line settings - %d",
__func__, retval);
cypress_set_dead(port); cypress_set_dead(port);
} else { } else {
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
...@@ -422,9 +439,8 @@ static int cypress_serial_control (struct tty_struct *tty, ...@@ -422,9 +439,8 @@ static int cypress_serial_control (struct tty_struct *tty,
if (tries++ >= 3) if (tries++ >= 3)
break; break;
} while (retval != sizeof(feature_buffer)
} while (retval != sizeof(feature_buffer) && && retval != -ENODEV);
retval != -ENODEV);
if (retval != sizeof(feature_buffer)) { if (retval != sizeof(feature_buffer)) {
err("%s - failed to retrieve serial line settings - %d", __func__, retval); err("%s - failed to retrieve serial line settings - %d", __func__, retval);
...@@ -432,8 +448,8 @@ static int cypress_serial_control (struct tty_struct *tty, ...@@ -432,8 +448,8 @@ static int cypress_serial_control (struct tty_struct *tty,
return retval; return retval;
} else { } else {
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
/* store the config in one byte, and later
/* store the config in one byte, and later use bit masks to check values */ use bit masks to check values */
priv->current_config = feature_buffer[4]; priv->current_config = feature_buffer[4];
priv->baud_rate = *((u_int32_t *)feature_buffer); priv->baud_rate = *((u_int32_t *)feature_buffer);
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
...@@ -470,14 +486,14 @@ static void cypress_set_dead(struct usb_serial_port *port) ...@@ -470,14 +486,14 @@ static void cypress_set_dead(struct usb_serial_port *port)
*****************************************************************************/ *****************************************************************************/
static int generic_startup (struct usb_serial *serial) static int generic_startup(struct usb_serial *serial)
{ {
struct cypress_private *priv; struct cypress_private *priv;
struct usb_serial_port *port = serial->port[0]; struct usb_serial_port *port = serial->port[0];
dbg("%s - port %d", __func__, port->number); dbg("%s - port %d", __func__, port->number);
priv = kzalloc(sizeof (struct cypress_private), GFP_KERNEL); priv = kzalloc(sizeof(struct cypress_private), GFP_KERNEL);
if (!priv) if (!priv)
return -ENOMEM; return -ENOMEM;
...@@ -490,7 +506,7 @@ static int generic_startup (struct usb_serial *serial) ...@@ -490,7 +506,7 @@ static int generic_startup (struct usb_serial *serial)
} }
init_waitqueue_head(&priv->delta_msr_wait); init_waitqueue_head(&priv->delta_msr_wait);
usb_reset_configuration (serial->dev); usb_reset_configuration(serial->dev);
priv->cmd_ctrl = 0; priv->cmd_ctrl = 0;
priv->line_control = 0; priv->line_control = 0;
...@@ -502,22 +518,22 @@ static int generic_startup (struct usb_serial *serial) ...@@ -502,22 +518,22 @@ static int generic_startup (struct usb_serial *serial)
small. Otherwise we can use the slightly more compact small. Otherwise we can use the slightly more compact
format. This is in accordance with the cypress_m8 serial format. This is in accordance with the cypress_m8 serial
converter app note. */ converter app note. */
if (port->interrupt_out_size > 9) { if (port->interrupt_out_size > 9)
priv->pkt_fmt = packet_format_1; priv->pkt_fmt = packet_format_1;
} else { else
priv->pkt_fmt = packet_format_2; priv->pkt_fmt = packet_format_2;
}
if (interval > 0) { if (interval > 0) {
priv->write_urb_interval = interval; priv->write_urb_interval = interval;
priv->read_urb_interval = interval; priv->read_urb_interval = interval;
dbg("%s - port %d read & write intervals forced to %d", dbg("%s - port %d read & write intervals forced to %d",
__func__,port->number,interval); __func__, port->number, interval);
} else { } else {
priv->write_urb_interval = port->interrupt_out_urb->interval; priv->write_urb_interval = port->interrupt_out_urb->interval;
priv->read_urb_interval = port->interrupt_in_urb->interval; priv->read_urb_interval = port->interrupt_in_urb->interval;
dbg("%s - port %d intervals: read=%d write=%d", dbg("%s - port %d intervals: read=%d write=%d",
__func__,port->number, __func__, port->number,
priv->read_urb_interval,priv->write_urb_interval); priv->read_urb_interval, priv->write_urb_interval);
} }
usb_set_serial_port_data(port, priv); usb_set_serial_port_data(port, priv);
...@@ -525,7 +541,7 @@ static int generic_startup (struct usb_serial *serial) ...@@ -525,7 +541,7 @@ static int generic_startup (struct usb_serial *serial)
} }
static int cypress_earthmate_startup (struct usb_serial *serial) static int cypress_earthmate_startup(struct usb_serial *serial)
{ {
struct cypress_private *priv; struct cypress_private *priv;
struct usb_serial_port *port = serial->port[0]; struct usb_serial_port *port = serial->port[0];
...@@ -543,7 +559,8 @@ static int cypress_earthmate_startup (struct usb_serial *serial) ...@@ -543,7 +559,8 @@ static int cypress_earthmate_startup (struct usb_serial *serial)
/* All Earthmate devices use the separated-count packet /* All Earthmate devices use the separated-count packet
format! Idiotic. */ format! Idiotic. */
priv->pkt_fmt = packet_format_1; priv->pkt_fmt = packet_format_1;
if (serial->dev->descriptor.idProduct != cpu_to_le16(PRODUCT_ID_EARTHMATEUSB)) { if (serial->dev->descriptor.idProduct !=
cpu_to_le16(PRODUCT_ID_EARTHMATEUSB)) {
/* The old original USB Earthmate seemed able to /* The old original USB Earthmate seemed able to
handle GET_CONFIG requests; everything they've handle GET_CONFIG requests; everything they've
produced since that time crashes if this command is produced since that time crashes if this command is
...@@ -557,7 +574,7 @@ static int cypress_earthmate_startup (struct usb_serial *serial) ...@@ -557,7 +574,7 @@ static int cypress_earthmate_startup (struct usb_serial *serial)
} /* cypress_earthmate_startup */ } /* cypress_earthmate_startup */
static int cypress_hidcom_startup (struct usb_serial *serial) static int cypress_hidcom_startup(struct usb_serial *serial)
{ {
struct cypress_private *priv; struct cypress_private *priv;
...@@ -576,7 +593,7 @@ static int cypress_hidcom_startup (struct usb_serial *serial) ...@@ -576,7 +593,7 @@ static int cypress_hidcom_startup (struct usb_serial *serial)
} /* cypress_hidcom_startup */ } /* cypress_hidcom_startup */
static int cypress_ca42v2_startup (struct usb_serial *serial) static int cypress_ca42v2_startup(struct usb_serial *serial)
{ {
struct cypress_private *priv; struct cypress_private *priv;
...@@ -595,11 +612,11 @@ static int cypress_ca42v2_startup (struct usb_serial *serial) ...@@ -595,11 +612,11 @@ static int cypress_ca42v2_startup (struct usb_serial *serial)
} /* cypress_ca42v2_startup */ } /* cypress_ca42v2_startup */
static void cypress_shutdown (struct usb_serial *serial) static void cypress_shutdown(struct usb_serial *serial)
{ {
struct cypress_private *priv; struct cypress_private *priv;
dbg ("%s - port %d", __func__, serial->port[0]->number); dbg("%s - port %d", __func__, serial->port[0]->number);
/* all open ports are closed at this point */ /* all open ports are closed at this point */
...@@ -650,7 +667,9 @@ static int cypress_open(struct tty_struct *tty, ...@@ -650,7 +667,9 @@ static int cypress_open(struct tty_struct *tty,
result = cypress_write(tty, port, NULL, 0); result = cypress_write(tty, port, NULL, 0);
if (result) { if (result) {
dev_err(&port->dev, "%s - failed setting the control lines - error %d\n", __func__, result); dev_err(&port->dev,
"%s - failed setting the control lines - error %d\n",
__func__, result);
return result; return result;
} else } else
dbg("%s - success setting the control lines", __func__); dbg("%s - success setting the control lines", __func__);
...@@ -659,19 +678,22 @@ static int cypress_open(struct tty_struct *tty, ...@@ -659,19 +678,22 @@ static int cypress_open(struct tty_struct *tty,
cypress_set_termios(tty, port, &priv->tmp_termios); cypress_set_termios(tty, port, &priv->tmp_termios);
/* setup the port and start reading from the device */ /* setup the port and start reading from the device */
if(!port->interrupt_in_urb){ if (!port->interrupt_in_urb) {
err("%s - interrupt_in_urb is empty!", __func__); err("%s - interrupt_in_urb is empty!", __func__);
return(-1); return -1;
} }
usb_fill_int_urb(port->interrupt_in_urb, serial->dev, usb_fill_int_urb(port->interrupt_in_urb, serial->dev,
usb_rcvintpipe(serial->dev, port->interrupt_in_endpointAddress), usb_rcvintpipe(serial->dev, port->interrupt_in_endpointAddress),
port->interrupt_in_urb->transfer_buffer, port->interrupt_in_urb->transfer_buffer_length, port->interrupt_in_urb->transfer_buffer,
port->interrupt_in_urb->transfer_buffer_length,
cypress_read_int_callback, port, priv->read_urb_interval); cypress_read_int_callback, port, priv->read_urb_interval);
result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL); result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
if (result){ if (result) {
dev_err(&port->dev, "%s - failed submitting read urb, error %d\n", __func__, result); dev_err(&port->dev,
"%s - failed submitting read urb, error %d\n",
__func__, result);
cypress_set_dead(port); cypress_set_dead(port);
} }
...@@ -680,7 +702,7 @@ static int cypress_open(struct tty_struct *tty, ...@@ -680,7 +702,7 @@ static int cypress_open(struct tty_struct *tty,
static void cypress_close(struct tty_struct *tty, static void cypress_close(struct tty_struct *tty,
struct usb_serial_port *port, struct file * filp) struct usb_serial_port *port, struct file *filp)
{ {
struct cypress_private *priv = usb_get_serial_port_data(port); struct cypress_private *priv = usb_get_serial_port_data(port);
unsigned int c_cflag; unsigned int c_cflag;
...@@ -722,15 +744,15 @@ static void cypress_close(struct tty_struct *tty, ...@@ -722,15 +744,15 @@ static void cypress_close(struct tty_struct *tty,
if (tty) { if (tty) {
bps = tty_get_baud_rate(tty); bps = tty_get_baud_rate(tty);
if (bps > 1200) if (bps > 1200)
timeout = max((HZ*2560)/bps,HZ/10); timeout = max((HZ * 2560) / bps, HZ / 10);
else else
timeout = 2*HZ; timeout = 2 * HZ;
schedule_timeout_interruptible(timeout); schedule_timeout_interruptible(timeout);
} }
dbg("%s - stopping urbs", __func__); dbg("%s - stopping urbs", __func__);
usb_kill_urb (port->interrupt_in_urb); usb_kill_urb(port->interrupt_in_urb);
usb_kill_urb (port->interrupt_out_urb); usb_kill_urb(port->interrupt_out_urb);
if (tty) { if (tty) {
c_cflag = tty->termios->c_cflag; c_cflag = tty->termios->c_cflag;
...@@ -746,7 +768,7 @@ static void cypress_close(struct tty_struct *tty, ...@@ -746,7 +768,7 @@ static void cypress_close(struct tty_struct *tty,
} }
if (stats) if (stats)
dev_info (&port->dev, "Statistics: %d Bytes In | %d Bytes Out | %d Commands Issued\n", dev_info(&port->dev, "Statistics: %d Bytes In | %d Bytes Out | %d Commands Issued\n",
priv->bytes_in, priv->bytes_out, priv->cmd_count); priv->bytes_in, priv->bytes_out, priv->cmd_count);
mutex_unlock(&port->serial->disc_mutex); mutex_unlock(&port->serial->disc_mutex);
} /* cypress_close */ } /* cypress_close */
...@@ -792,7 +814,8 @@ static void cypress_send(struct usb_serial_port *port) ...@@ -792,7 +814,8 @@ static void cypress_send(struct usb_serial_port *port)
return; return;
dbg("%s - port %d", __func__, port->number); dbg("%s - port %d", __func__, port->number);
dbg("%s - interrupt out size is %d", __func__, port->interrupt_out_size); dbg("%s - interrupt out size is %d", __func__,
port->interrupt_out_size);
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
if (priv->write_urb_in_use) { if (priv->write_urb_in_use) {
...@@ -803,7 +826,8 @@ static void cypress_send(struct usb_serial_port *port) ...@@ -803,7 +826,8 @@ static void cypress_send(struct usb_serial_port *port)
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
/* clear buffer */ /* clear buffer */
memset(port->interrupt_out_urb->transfer_buffer, 0, port->interrupt_out_size); memset(port->interrupt_out_urb->transfer_buffer, 0,
port->interrupt_out_size);
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
switch (priv->pkt_fmt) { switch (priv->pkt_fmt) {
...@@ -834,9 +858,8 @@ static void cypress_send(struct usb_serial_port *port) ...@@ -834,9 +858,8 @@ static void cypress_send(struct usb_serial_port *port)
count = cypress_buf_get(priv->buf, &port->interrupt_out_buffer[offset], count = cypress_buf_get(priv->buf, &port->interrupt_out_buffer[offset],
port->interrupt_out_size-offset); port->interrupt_out_size-offset);
if (count == 0) { if (count == 0)
return; return;
}
switch (priv->pkt_fmt) { switch (priv->pkt_fmt) {
default: default:
...@@ -860,26 +883,29 @@ static void cypress_send(struct usb_serial_port *port) ...@@ -860,26 +883,29 @@ static void cypress_send(struct usb_serial_port *port)
actual_size = count + actual_size = count +
(priv->pkt_fmt == packet_format_1 ? 2 : 1); (priv->pkt_fmt == packet_format_1 ? 2 : 1);
usb_serial_debug_data(debug, &port->dev, __func__, port->interrupt_out_size, usb_serial_debug_data(debug, &port->dev, __func__,
port->interrupt_out_size,
port->interrupt_out_urb->transfer_buffer); port->interrupt_out_urb->transfer_buffer);
usb_fill_int_urb(port->interrupt_out_urb, port->serial->dev, usb_fill_int_urb(port->interrupt_out_urb, port->serial->dev,
usb_sndintpipe(port->serial->dev, port->interrupt_out_endpointAddress), usb_sndintpipe(port->serial->dev, port->interrupt_out_endpointAddress),
port->interrupt_out_buffer, port->interrupt_out_size, port->interrupt_out_buffer, port->interrupt_out_size,
cypress_write_int_callback, port, priv->write_urb_interval); cypress_write_int_callback, port, priv->write_urb_interval);
result = usb_submit_urb (port->interrupt_out_urb, GFP_ATOMIC); result = usb_submit_urb(port->interrupt_out_urb, GFP_ATOMIC);
if (result) { if (result) {
dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __func__, dev_err(&port->dev,
result); "%s - failed submitting write urb, error %d\n",
__func__, result);
priv->write_urb_in_use = 0; priv->write_urb_in_use = 0;
cypress_set_dead(port); cypress_set_dead(port);
} }
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
if (priv->cmd_ctrl) { if (priv->cmd_ctrl)
priv->cmd_ctrl = 0; priv->cmd_ctrl = 0;
}
priv->bytes_out += count; /* do not count the line control and size bytes */ /* do not count the line control and size bytes */
priv->bytes_out += count;
spin_unlock_irqrestore(&priv->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
usb_serial_port_softint(port); usb_serial_port_softint(port);
...@@ -958,7 +984,7 @@ static int cypress_tiocmset(struct tty_struct *tty, struct file *file, ...@@ -958,7 +984,7 @@ static int cypress_tiocmset(struct tty_struct *tty, struct file *file,
} }
static int cypress_ioctl(struct tty_struct *tty, struct file * file, static int cypress_ioctl(struct tty_struct *tty, struct file *file,
unsigned int cmd, unsigned long arg) unsigned int cmd, unsigned long arg)
{ {
struct usb_serial_port *port = tty->driver_data; struct usb_serial_port *port = tty->driver_data;
...@@ -976,23 +1002,22 @@ static int cypress_ioctl(struct tty_struct *tty, struct file * file, ...@@ -976,23 +1002,22 @@ static int cypress_ioctl(struct tty_struct *tty, struct file * file,
return -ERESTARTSYS; return -ERESTARTSYS;
else { else {
char diff = priv->diff_status; char diff = priv->diff_status;
if (diff == 0)
if (diff == 0) {
return -EIO; /* no change => error */ return -EIO; /* no change => error */
}
/* consume all events */ /* consume all events */
priv->diff_status = 0; priv->diff_status = 0;
/* return 0 if caller wanted to know about these bits */ /* return 0 if caller wanted to know about
if ( ((arg & TIOCM_RNG) && (diff & UART_RI)) || these bits */
if (((arg & TIOCM_RNG) && (diff & UART_RI)) ||
((arg & TIOCM_DSR) && (diff & UART_DSR)) || ((arg & TIOCM_DSR) && (diff & UART_DSR)) ||
((arg & TIOCM_CD) && (diff & UART_CD)) || ((arg & TIOCM_CD) && (diff & UART_CD)) ||
((arg & TIOCM_CTS) && (diff & UART_CTS)) ) { ((arg & TIOCM_CTS) && (diff & UART_CTS)))
return 0; return 0;
} /* otherwise caller can't care less about what
/* otherwise caller can't care less about what happened, * happened, and so we continue to wait for
* and so we continue to wait for more events. * more events.
*/ */
} }
} }
...@@ -1086,7 +1111,6 @@ static void cypress_set_termios(struct tty_struct *tty, ...@@ -1086,7 +1111,6 @@ static void cypress_set_termios(struct tty_struct *tty,
err("%s - CSIZE was set, but not CS5-CS8", err("%s - CSIZE was set, but not CS5-CS8",
__func__); __func__);
data_bits = 3; data_bits = 3;
}
} else } else
data_bits = 3; data_bits = 3;
...@@ -1104,8 +1128,10 @@ static void cypress_set_termios(struct tty_struct *tty, ...@@ -1104,8 +1128,10 @@ static void cypress_set_termios(struct tty_struct *tty,
"%d data_bits (+5)", __func__, stop_bits, "%d data_bits (+5)", __func__, stop_bits,
parity_enable, parity_type, data_bits); parity_enable, parity_type, data_bits);
cypress_serial_control(tty, port, tty_get_baud_rate(tty), data_bits, stop_bits, cypress_serial_control(tty, port, tty_get_baud_rate(tty),
parity_enable, parity_type, 0, CYPRESS_SET_CONFIG); data_bits, stop_bits,
parity_enable, parity_type,
0, CYPRESS_SET_CONFIG);
/* we perform a CYPRESS_GET_CONFIG so that the current settings are /* we perform a CYPRESS_GET_CONFIG so that the current settings are
* filled into the private structure this should confirm that all is * filled into the private structure this should confirm that all is
...@@ -1116,7 +1142,7 @@ static void cypress_set_termios(struct tty_struct *tty, ...@@ -1116,7 +1142,7 @@ static void cypress_set_termios(struct tty_struct *tty,
* termios flag base comes from empeg.c */ * termios flag base comes from empeg.c */
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
if ( (priv->chiptype == CT_EARTHMATE) && (priv->baud_rate == 4800) ) { if (priv->chiptype == CT_EARTHMATE && priv->baud_rate == 4800) {
dbg("Using custom termios settings for a baud rate of " dbg("Using custom termios settings for a baud rate of "
"4800bps."); "4800bps.");
/* define custom termios settings for NMEA protocol */ /* define custom termios settings for NMEA protocol */
...@@ -1243,11 +1269,12 @@ static void cypress_read_int_callback(struct urb *urb) ...@@ -1243,11 +1269,12 @@ static void cypress_read_int_callback(struct urb *urb)
/* precursor to disconnect so just go away */ /* precursor to disconnect so just go away */
return; return;
case -EPIPE: case -EPIPE:
usb_clear_halt(port->serial->dev,0x81); usb_clear_halt(port->serial->dev, 0x81);
break; break;
default: default:
/* something ugly is going on... */ /* something ugly is going on... */
dev_err(&urb->dev->dev,"%s - unexpected nonzero read status received: %d\n", dev_err(&urb->dev->dev,
"%s - unexpected nonzero read status received: %d\n",
__func__, status); __func__, status);
cypress_set_dead(port); cypress_set_dead(port);
return; return;
...@@ -1296,7 +1323,7 @@ static void cypress_read_int_callback(struct urb *urb) ...@@ -1296,7 +1323,7 @@ static void cypress_read_int_callback(struct urb *urb)
goto continue_read; goto continue_read;
} }
usb_serial_debug_data (debug, &port->dev, __func__, usb_serial_debug_data(debug, &port->dev, __func__,
urb->actual_length, data); urb->actual_length, data);
spin_lock_irqsave(&priv->lock, flags); spin_lock_irqsave(&priv->lock, flags);
...@@ -1356,7 +1383,8 @@ static void cypress_read_int_callback(struct urb *urb) ...@@ -1356,7 +1383,8 @@ static void cypress_read_int_callback(struct urb *urb)
port->interrupt_in_endpointAddress), port->interrupt_in_endpointAddress),
port->interrupt_in_urb->transfer_buffer, port->interrupt_in_urb->transfer_buffer,
port->interrupt_in_urb->transfer_buffer_length, port->interrupt_in_urb->transfer_buffer_length,
cypress_read_int_callback, port, priv->read_urb_interval); cypress_read_int_callback, port,
priv->read_urb_interval);
result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC); result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
if (result) { if (result) {
dev_err(&urb->dev->dev, "%s - failed resubmitting " dev_err(&urb->dev->dev, "%s - failed resubmitting "
...@@ -1403,17 +1431,18 @@ static void cypress_write_int_callback(struct urb *urb) ...@@ -1403,17 +1431,18 @@ static void cypress_write_int_callback(struct urb *urb)
result = usb_submit_urb(port->interrupt_out_urb, GFP_ATOMIC); result = usb_submit_urb(port->interrupt_out_urb, GFP_ATOMIC);
if (!result) if (!result)
return; return;
dev_err(&urb->dev->dev, "%s - failed resubmitting write urb, error %d\n", dev_err(&urb->dev->dev,
"%s - failed resubmitting write urb, error %d\n",
__func__, result); __func__, result);
cypress_set_dead(port); cypress_set_dead(port);
break; break;
default: default:
dev_err(&urb->dev->dev,"%s - unexpected nonzero write status received: %d\n", dev_err(&urb->dev->dev,
"%s - unexpected nonzero write status received: %d\n",
__func__, status); __func__, status);
cypress_set_dead(port); cypress_set_dead(port);
break; break;
} }
priv->write_urb_in_use = 0; priv->write_urb_in_use = 0;
/* send any buffered data */ /* send any buffered data */
...@@ -1497,7 +1526,8 @@ static void cypress_buf_clear(struct cypress_buf *cb) ...@@ -1497,7 +1526,8 @@ static void cypress_buf_clear(struct cypress_buf *cb)
static unsigned int cypress_buf_data_avail(struct cypress_buf *cb) static unsigned int cypress_buf_data_avail(struct cypress_buf *cb)
{ {
if (cb != NULL) if (cb != NULL)
return ((cb->buf_size + cb->buf_put - cb->buf_get) % cb->buf_size); return (cb->buf_size + cb->buf_put - cb->buf_get)
% cb->buf_size;
else else
return 0; return 0;
} }
...@@ -1513,7 +1543,8 @@ static unsigned int cypress_buf_data_avail(struct cypress_buf *cb) ...@@ -1513,7 +1543,8 @@ static unsigned int cypress_buf_data_avail(struct cypress_buf *cb)
static unsigned int cypress_buf_space_avail(struct cypress_buf *cb) static unsigned int cypress_buf_space_avail(struct cypress_buf *cb)
{ {
if (cb != NULL) if (cb != NULL)
return ((cb->buf_size + cb->buf_get - cb->buf_put - 1) % cb->buf_size); return (cb->buf_size + cb->buf_get - cb->buf_put - 1)
% cb->buf_size;
else else
return 0; return 0;
} }
...@@ -1643,23 +1674,23 @@ static int __init cypress_init(void) ...@@ -1643,23 +1674,23 @@ static int __init cypress_init(void)
} }
static void __exit cypress_exit (void) static void __exit cypress_exit(void)
{ {
dbg("%s", __func__); dbg("%s", __func__);
usb_deregister (&cypress_driver); usb_deregister(&cypress_driver);
usb_serial_deregister (&cypress_earthmate_device); usb_serial_deregister(&cypress_earthmate_device);
usb_serial_deregister (&cypress_hidcom_device); usb_serial_deregister(&cypress_hidcom_device);
usb_serial_deregister (&cypress_ca42v2_device); usb_serial_deregister(&cypress_ca42v2_device);
} }
module_init(cypress_init); module_init(cypress_init);
module_exit(cypress_exit); module_exit(cypress_exit);
MODULE_AUTHOR( DRIVER_AUTHOR ); MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION( DRIVER_DESC ); MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_VERSION( DRIVER_VERSION ); MODULE_VERSION(DRIVER_VERSION);
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
module_param(debug, bool, S_IRUGO | S_IWUSR); module_param(debug, bool, S_IRUGO | S_IWUSR);
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或