USB: usblcd: refactor endpoint retrieval
Use the new endpoint helpers to lookup the required bulk-in and bulk-out endpoints. Signed-off-by: Johan Hovold <johan@kernel.org> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
9b181166f1
commit
aac96ef9ed
|
@ -313,16 +313,15 @@ static int lcd_probe(struct usb_interface *interface,
|
|||
const struct usb_device_id *id)
|
||||
{
|
||||
struct usb_lcd *dev = NULL;
|
||||
struct usb_host_interface *iface_desc;
|
||||
struct usb_endpoint_descriptor *endpoint;
|
||||
size_t buffer_size;
|
||||
struct usb_endpoint_descriptor *bulk_in, *bulk_out;
|
||||
int i;
|
||||
int retval = -ENOMEM;
|
||||
int retval;
|
||||
|
||||
/* allocate memory for our device state and initialize it */
|
||||
dev = kzalloc(sizeof(*dev), GFP_KERNEL);
|
||||
if (!dev)
|
||||
goto error;
|
||||
return -ENOMEM;
|
||||
|
||||
kref_init(&dev->kref);
|
||||
sema_init(&dev->limit_sem, USB_LCD_CONCURRENT_WRITES);
|
||||
init_usb_anchor(&dev->submitted);
|
||||
|
@ -338,33 +337,24 @@ static int lcd_probe(struct usb_interface *interface,
|
|||
|
||||
/* set up the endpoint information */
|
||||
/* use only the first bulk-in and bulk-out endpoints */
|
||||
iface_desc = interface->cur_altsetting;
|
||||
for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
|
||||
endpoint = &iface_desc->endpoint[i].desc;
|
||||
|
||||
if (!dev->bulk_in_endpointAddr &&
|
||||
usb_endpoint_is_bulk_in(endpoint)) {
|
||||
/* we found a bulk in endpoint */
|
||||
buffer_size = usb_endpoint_maxp(endpoint);
|
||||
dev->bulk_in_size = buffer_size;
|
||||
dev->bulk_in_endpointAddr = endpoint->bEndpointAddress;
|
||||
dev->bulk_in_buffer = kmalloc(buffer_size, GFP_KERNEL);
|
||||
if (!dev->bulk_in_buffer)
|
||||
goto error;
|
||||
}
|
||||
|
||||
if (!dev->bulk_out_endpointAddr &&
|
||||
usb_endpoint_is_bulk_out(endpoint)) {
|
||||
/* we found a bulk out endpoint */
|
||||
dev->bulk_out_endpointAddr = endpoint->bEndpointAddress;
|
||||
}
|
||||
}
|
||||
if (!(dev->bulk_in_endpointAddr && dev->bulk_out_endpointAddr)) {
|
||||
retval = usb_find_common_endpoints(interface->cur_altsetting,
|
||||
&bulk_in, &bulk_out, NULL, NULL);
|
||||
if (retval) {
|
||||
dev_err(&interface->dev,
|
||||
"Could not find both bulk-in and bulk-out endpoints\n");
|
||||
goto error;
|
||||
}
|
||||
|
||||
dev->bulk_in_size = usb_endpoint_maxp(bulk_in);
|
||||
dev->bulk_in_endpointAddr = bulk_in->bEndpointAddress;
|
||||
dev->bulk_in_buffer = kmalloc(dev->bulk_in_size, GFP_KERNEL);
|
||||
if (!dev->bulk_in_buffer) {
|
||||
retval = -ENOMEM;
|
||||
goto error;
|
||||
}
|
||||
|
||||
dev->bulk_out_endpointAddr = bulk_out->bEndpointAddress;
|
||||
|
||||
/* save our data pointer in this interface device */
|
||||
usb_set_intfdata(interface, dev);
|
||||
|
||||
|
@ -390,8 +380,7 @@ static int lcd_probe(struct usb_interface *interface,
|
|||
return 0;
|
||||
|
||||
error:
|
||||
if (dev)
|
||||
kref_put(&dev->kref, lcd_delete);
|
||||
kref_put(&dev->kref, lcd_delete);
|
||||
return retval;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue