Commit eccf2a4e authored by Oliver Neukum's avatar Oliver Neukum Committed by Greg Kroah-Hartman

cdc-acm: use the common parser

This introduces the common parser for extra CDC headers now that it no longer
depends on usbnet.
Signed-off-by: default avatarOliver Neukum <ONeukum@suse.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent e4c6fb77
...@@ -1147,6 +1147,7 @@ static int acm_probe(struct usb_interface *intf, ...@@ -1147,6 +1147,7 @@ static int acm_probe(struct usb_interface *intf,
{ {
struct usb_cdc_union_desc *union_header = NULL; struct usb_cdc_union_desc *union_header = NULL;
struct usb_cdc_country_functional_desc *cfd = NULL; struct usb_cdc_country_functional_desc *cfd = NULL;
struct usb_cdc_call_mgmt_descriptor *cmd = NULL;
unsigned char *buffer = intf->altsetting->extra; unsigned char *buffer = intf->altsetting->extra;
int buflen = intf->altsetting->extralen; int buflen = intf->altsetting->extralen;
struct usb_interface *control_interface; struct usb_interface *control_interface;
...@@ -1155,18 +1156,16 @@ static int acm_probe(struct usb_interface *intf, ...@@ -1155,18 +1156,16 @@ static int acm_probe(struct usb_interface *intf,
struct usb_endpoint_descriptor *epread = NULL; struct usb_endpoint_descriptor *epread = NULL;
struct usb_endpoint_descriptor *epwrite = NULL; struct usb_endpoint_descriptor *epwrite = NULL;
struct usb_device *usb_dev = interface_to_usbdev(intf); struct usb_device *usb_dev = interface_to_usbdev(intf);
struct usb_cdc_parsed_header hdr;
struct acm *acm; struct acm *acm;
int minor; int minor;
int ctrlsize, readsize; int ctrlsize, readsize;
u8 *buf; u8 *buf;
u8 ac_management_function = 0;
u8 call_management_function = 0;
int call_interface_num = -1; int call_interface_num = -1;
int data_interface_num = -1; int data_interface_num = -1;
unsigned long quirks; unsigned long quirks;
int num_rx_buf; int num_rx_buf;
int i; int i;
unsigned int elength = 0;
int combined_interfaces = 0; int combined_interfaces = 0;
struct device *tty_dev; struct device *tty_dev;
int rv = -ENOMEM; int rv = -ENOMEM;
...@@ -1210,61 +1209,11 @@ static int acm_probe(struct usb_interface *intf, ...@@ -1210,61 +1209,11 @@ static int acm_probe(struct usb_interface *intf,
} }
} }
while (buflen > 0) { cdc_parse_cdc_header(&hdr, intf, buffer, buflen);
elength = buffer[0]; union_header = hdr.usb_cdc_union_desc;
if (!elength) { cmd = hdr.usb_cdc_call_mgmt_descriptor;
dev_err(&intf->dev, "skipping garbage byte\n"); if (cmd)
elength = 1; call_interface_num = cmd->bDataInterface;
goto next_desc;
}
if (buffer[1] != USB_DT_CS_INTERFACE) {
dev_err(&intf->dev, "skipping garbage\n");
goto next_desc;
}
switch (buffer[2]) {
case USB_CDC_UNION_TYPE: /* we've found it */
if (elength < sizeof(struct usb_cdc_union_desc))
goto next_desc;
if (union_header) {
dev_err(&intf->dev, "More than one "
"union descriptor, skipping ...\n");
goto next_desc;
}
union_header = (struct usb_cdc_union_desc *)buffer;
break;
case USB_CDC_COUNTRY_TYPE: /* export through sysfs*/
if (elength < sizeof(struct usb_cdc_country_functional_desc))
goto next_desc;
cfd = (struct usb_cdc_country_functional_desc *)buffer;
break;
case USB_CDC_HEADER_TYPE: /* maybe check version */
break; /* for now we ignore it */
case USB_CDC_ACM_TYPE:
if (elength < 4)
goto next_desc;
ac_management_function = buffer[3];
break;
case USB_CDC_CALL_MANAGEMENT_TYPE:
if (elength < 5)
goto next_desc;
call_management_function = buffer[3];
call_interface_num = buffer[4];
break;
default:
/*
* there are LOTS more CDC descriptors that
* could legitimately be found here.
*/
dev_dbg(&intf->dev, "Ignoring descriptor: "
"type %02x, length %ud\n",
buffer[2], elength);
break;
}
next_desc:
buflen -= elength;
buffer += elength;
}
if (!union_header) { if (!union_header) {
if (call_interface_num > 0) { if (call_interface_num > 0) {
...@@ -1394,7 +1343,8 @@ static int acm_probe(struct usb_interface *intf, ...@@ -1394,7 +1343,8 @@ static int acm_probe(struct usb_interface *intf,
acm->data = data_interface; acm->data = data_interface;
acm->minor = minor; acm->minor = minor;
acm->dev = usb_dev; acm->dev = usb_dev;
acm->ctrl_caps = ac_management_function; if (hdr.usb_cdc_acm_descriptor)
acm->ctrl_caps = hdr.usb_cdc_acm_descriptor->bmCapabilities;
if (quirks & NO_CAP_LINE) if (quirks & NO_CAP_LINE)
acm->ctrl_caps &= ~USB_CDC_CAP_LINE; acm->ctrl_caps &= ~USB_CDC_CAP_LINE;
acm->ctrlsize = ctrlsize; acm->ctrlsize = ctrlsize;
...@@ -1488,6 +1438,7 @@ static int acm_probe(struct usb_interface *intf, ...@@ -1488,6 +1438,7 @@ static int acm_probe(struct usb_interface *intf,
if (i < 0) if (i < 0)
goto alloc_fail7; goto alloc_fail7;
cfd = hdr.usb_cdc_country_functional_desc;
if (cfd) { /* export the country data */ if (cfd) { /* export the country data */
acm->country_codes = kmalloc(cfd->bLength - 4, GFP_KERNEL); acm->country_codes = kmalloc(cfd->bLength - 4, GFP_KERNEL);
if (!acm->country_codes) if (!acm->country_codes)
......
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