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: H Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

diff --git a/drivers/staging/comedi/drivers/dt9812.c b/drivers/staging/comedi/drivers/dt9812.c
index be00acb..42a4a9d 100644 (file)
--- a/drivers/staging/comedi/drivers/dt9812.c
+++ b/drivers/staging/comedi/drivers/dt9812.c
@@ -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