提交 8ee26468 编写于 作者: H H Hartley Sweeten 提交者: Greg Kroah-Hartman

staging: comedi: dt9812: factor the endpoint setup out of dt9812_probe()

When this driver is converted to the comedi (*auto_attach) mechanism the
endpoint setup will be done during the (*auto_attach). To make the
conversion cleaner, factor the endpoint setup out of the (*probe).
Signed-off-by: NH Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: NGreg Kroah-Hartman <gregkh@linuxfoundation.org>
上级 8f566937
......@@ -727,6 +727,53 @@ static int dt9812_ao_winsn(struct comedi_device *dev,
return n;
}
static int dt9812_find_endpoints(struct usb_interface *intf,
struct usb_dt9812 *devpriv)
{
struct usb_host_interface *host = intf->cur_altsetting;
struct usb_endpoint_descriptor *ep;
int i;
if (host->desc.bNumEndpoints != 5) {
dev_err(&intf->dev, "Wrong number of endpoints\n");
return -ENODEV;
}
for (i = 0; i < host->desc.bNumEndpoints; ++i) {
int dir = -1;
ep = &host->endpoint[i].desc;
switch (i) {
case 0:
/* unused message pipe */
dir = USB_DIR_IN;
break;
case 1:
dir = USB_DIR_OUT;
devpriv->cmd_wr.addr = ep->bEndpointAddress;
devpriv->cmd_wr.size = le16_to_cpu(ep->wMaxPacketSize);
break;
case 2:
dir = USB_DIR_IN;
devpriv->cmd_rd.addr = ep->bEndpointAddress;
devpriv->cmd_rd.size = le16_to_cpu(ep->wMaxPacketSize);
break;
case 3:
/* unused write stream */
dir = USB_DIR_OUT;
break;
case 4:
/* unused read stream */
dir = USB_DIR_IN;
break;
}
if ((ep->bEndpointAddress & USB_DIR_IN) != dir) {
dev_err(&intf->dev, "Endpoint has wrong direction\n");
return -ENODEV;
}
}
return 0;
}
static int dt9812_attach(struct comedi_device *dev, struct comedi_devconfig *it)
{
struct slot_dt9812 *slot = NULL;
......@@ -836,8 +883,6 @@ static int dt9812_probe(struct usb_interface *intf,
{
struct slot_dt9812 *slot = NULL;
struct usb_dt9812 *dev = NULL;
struct usb_host_interface *host;
struct usb_endpoint_descriptor *ep;
int retval = -ENOMEM;
int i;
u8 fw;
......@@ -871,49 +916,10 @@ static int dt9812_probe(struct usb_interface *intf,
dev->udev = usb_get_dev(interface_to_usbdev(intf));
/* Check endpoints */
host = intf->cur_altsetting;
if (host->desc.bNumEndpoints != 5) {
dev_err(&intf->dev, "Wrong number of endpoints.\n");
retval = -ENODEV;
retval = dt9812_find_endpoints(intf, dev);
if (retval)
goto error;
}
for (i = 0; i < host->desc.bNumEndpoints; ++i) {
int direction = -1;
ep = &host->endpoint[i].desc;
switch (i) {
case 0:
/* unused message pipe */
direction = USB_DIR_IN;
break;
case 1:
direction = USB_DIR_OUT;
dev->cmd_wr.addr = ep->bEndpointAddress;
dev->cmd_wr.size = le16_to_cpu(ep->wMaxPacketSize);
break;
case 2:
direction = USB_DIR_IN;
dev->cmd_rd.addr = ep->bEndpointAddress;
dev->cmd_rd.size = le16_to_cpu(ep->wMaxPacketSize);
break;
case 3:
/* unused write stream */
direction = USB_DIR_OUT;
break;
case 4:
/* unused read stream */
direction = USB_DIR_IN;
break;
}
if ((ep->bEndpointAddress & USB_DIR_IN) != direction) {
dev_err(&intf->dev,
"Endpoint has wrong direction.\n");
retval = -ENODEV;
goto error;
}
}
if (dt9812_read_info(dev, 0, &fw, sizeof(fw)) != 0) {
/*
* Seems like a configuration reset is necessary if driver is
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册