usb-serial: Move USB_TOKEN_IN into a helper function
We'll be adding a loop, so move the code into a helper function. breaks are replaced with returns. While making this change, add braces to single line if statements to comply with coding style and keep checkpatch happy. Signed-off-by: Jason Andryuk <jandryuk@gmail.com> Message-id: 20200316174610.115820-2-jandryuk@gmail.com Signed-off-by: Gerd Hoffmann <kraxel@redhat.com>
This commit is contained in:
parent
61c265f066
commit
2bcf4e9ff9
|
@ -358,13 +358,56 @@ static void usb_serial_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void usb_serial_token_in(USBSerialState *s, USBPacket *p)
|
||||||
|
{
|
||||||
|
int first_len, len;
|
||||||
|
uint8_t header[2];
|
||||||
|
|
||||||
|
first_len = RECV_BUF - s->recv_ptr;
|
||||||
|
len = p->iov.size;
|
||||||
|
if (len <= 2) {
|
||||||
|
p->status = USB_RET_NAK;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
header[0] = usb_get_modem_lines(s) | 1;
|
||||||
|
/* We do not have the uart details */
|
||||||
|
/* handle serial break */
|
||||||
|
if (s->event_trigger && s->event_trigger & FTDI_BI) {
|
||||||
|
s->event_trigger &= ~FTDI_BI;
|
||||||
|
header[1] = FTDI_BI;
|
||||||
|
usb_packet_copy(p, header, 2);
|
||||||
|
return;
|
||||||
|
} else {
|
||||||
|
header[1] = 0;
|
||||||
|
}
|
||||||
|
len -= 2;
|
||||||
|
if (len > s->recv_used) {
|
||||||
|
len = s->recv_used;
|
||||||
|
}
|
||||||
|
if (!len) {
|
||||||
|
p->status = USB_RET_NAK;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if (first_len > len) {
|
||||||
|
first_len = len;
|
||||||
|
}
|
||||||
|
usb_packet_copy(p, header, 2);
|
||||||
|
usb_packet_copy(p, s->recv_buf + s->recv_ptr, first_len);
|
||||||
|
if (len > first_len) {
|
||||||
|
usb_packet_copy(p, s->recv_buf, len - first_len);
|
||||||
|
}
|
||||||
|
s->recv_used -= len;
|
||||||
|
s->recv_ptr = (s->recv_ptr + len) % RECV_BUF;
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
static void usb_serial_handle_data(USBDevice *dev, USBPacket *p)
|
static void usb_serial_handle_data(USBDevice *dev, USBPacket *p)
|
||||||
{
|
{
|
||||||
USBSerialState *s = (USBSerialState *)dev;
|
USBSerialState *s = (USBSerialState *)dev;
|
||||||
uint8_t devep = p->ep->nr;
|
uint8_t devep = p->ep->nr;
|
||||||
struct iovec *iov;
|
struct iovec *iov;
|
||||||
uint8_t header[2];
|
int i;
|
||||||
int i, first_len, len;
|
|
||||||
|
|
||||||
switch (p->pid) {
|
switch (p->pid) {
|
||||||
case USB_TOKEN_OUT:
|
case USB_TOKEN_OUT:
|
||||||
|
@ -382,38 +425,7 @@ static void usb_serial_handle_data(USBDevice *dev, USBPacket *p)
|
||||||
case USB_TOKEN_IN:
|
case USB_TOKEN_IN:
|
||||||
if (devep != 1)
|
if (devep != 1)
|
||||||
goto fail;
|
goto fail;
|
||||||
first_len = RECV_BUF - s->recv_ptr;
|
usb_serial_token_in(s, p);
|
||||||
len = p->iov.size;
|
|
||||||
if (len <= 2) {
|
|
||||||
p->status = USB_RET_NAK;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
header[0] = usb_get_modem_lines(s) | 1;
|
|
||||||
/* We do not have the uart details */
|
|
||||||
/* handle serial break */
|
|
||||||
if (s->event_trigger && s->event_trigger & FTDI_BI) {
|
|
||||||
s->event_trigger &= ~FTDI_BI;
|
|
||||||
header[1] = FTDI_BI;
|
|
||||||
usb_packet_copy(p, header, 2);
|
|
||||||
break;
|
|
||||||
} else {
|
|
||||||
header[1] = 0;
|
|
||||||
}
|
|
||||||
len -= 2;
|
|
||||||
if (len > s->recv_used)
|
|
||||||
len = s->recv_used;
|
|
||||||
if (!len) {
|
|
||||||
p->status = USB_RET_NAK;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if (first_len > len)
|
|
||||||
first_len = len;
|
|
||||||
usb_packet_copy(p, header, 2);
|
|
||||||
usb_packet_copy(p, s->recv_buf + s->recv_ptr, first_len);
|
|
||||||
if (len > first_len)
|
|
||||||
usb_packet_copy(p, s->recv_buf, len - first_len);
|
|
||||||
s->recv_used -= len;
|
|
||||||
s->recv_ptr = (s->recv_ptr + len) % RECV_BUF;
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
|
|
Loading…
Reference in a new issue