Commit 6d1bf48e authored by Johan Hovold's avatar Johan Hovold Committed by Greg Kroah-Hartman

USB: safe_serial: straighten out read processing

Clean up read processing logic.

Tested using a cp210x device in a loopback setup.
Signed-off-by: default avatarJohan Hovold <jhovold@gmail.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 12e2e52c
...@@ -218,7 +218,9 @@ static void safe_process_read_urb(struct urb *urb) ...@@ -218,7 +218,9 @@ static void safe_process_read_urb(struct urb *urb)
struct usb_serial_port *port = urb->context; struct usb_serial_port *port = urb->context;
unsigned char *data = urb->transfer_buffer; unsigned char *data = urb->transfer_buffer;
unsigned char length = urb->actual_length; unsigned char length = urb->actual_length;
int actual_length;
struct tty_struct *tty; struct tty_struct *tty;
__u16 fcs;
if (!length) if (!length)
return; return;
...@@ -227,30 +229,27 @@ static void safe_process_read_urb(struct urb *urb) ...@@ -227,30 +229,27 @@ static void safe_process_read_urb(struct urb *urb)
if (!tty) if (!tty)
return; return;
if (safe) { if (!safe)
__u16 fcs; goto out;
fcs = fcs_compute10(data, length, CRC10_INITFCS);
if (!fcs) { fcs = fcs_compute10(data, length, CRC10_INITFCS);
int actual_length = data[length - 2] >> 2; if (fcs) {
if (actual_length <= (length - 2)) { dev_err(&port->dev, "%s - bad CRC %x\n", __func__, fcs);
dev_info(&urb->dev->dev, "%s - actual: %d\n", goto err;
__func__, actual_length);
tty_insert_flip_string(tty,
data, actual_length);
tty_flip_buffer_push(tty);
} else {
dev_err(&port->dev,
"%s - inconsistent lengths %d:%d\n",
__func__, actual_length, length);
}
} else {
dev_err(&port->dev, "%s - bad CRC %x\n", __func__, fcs);
}
} else {
tty_insert_flip_string(tty, data, length);
tty_flip_buffer_push(tty);
} }
actual_length = data[length - 2] >> 2;
if (actual_length > (length - 2)) {
dev_err(&port->dev, "%s - inconsistent lengths %d:%d\n",
__func__, actual_length, length);
goto err;
}
dev_info(&urb->dev->dev, "%s - actual: %d\n", __func__, actual_length);
length = actual_length;
out:
tty_insert_flip_string(tty, data, length);
tty_flip_buffer_push(tty);
err:
tty_kref_put(tty); tty_kref_put(tty);
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment