diff options
author | H Hartley Sweeten <hsweeten@visionengravers.com> | 2013-02-06 00:21:19 (GMT) |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2013-02-06 02:07:10 (GMT) |
commit | 49253d542cc0f5f771dc254d248162a2a666649d (patch) | |
tree | 262c1b1bb4f810a24202e8165d66276d943986d9 | |
parent | da7b18ee8b552b9b340c44fa8f6de1372a251a78 (diff) | |
download | linux-fsl-qoriq-49253d542cc0f5f771dc254d248162a2a666649d.tar.xz |
staging: comedi: vmk80xx: factor out usb endpoint detection
Factor the code that detects the usb endpoints out of vmk80xx_usb_probe().
Cleanup the detection code in the new function,
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>
-rw-r--r-- | drivers/staging/comedi/drivers/vmk80xx.c | 74 |
1 files changed, 39 insertions, 35 deletions
diff --git a/drivers/staging/comedi/drivers/vmk80xx.c b/drivers/staging/comedi/drivers/vmk80xx.c index 76b99ad..26c10a8 100644 --- a/drivers/staging/comedi/drivers/vmk80xx.c +++ b/drivers/staging/comedi/drivers/vmk80xx.c @@ -1138,6 +1138,40 @@ static int vmk80xx_pwm_winsn(struct comedi_device *dev, return n; } +static int vmk80xx_find_usb_endpoints(struct vmk80xx_private *devpriv, + struct usb_interface *intf) +{ + struct usb_host_interface *iface_desc = intf->cur_altsetting; + struct usb_endpoint_descriptor *ep_desc; + int i; + + if (iface_desc->desc.bNumEndpoints != 2) + return -ENODEV; + + for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) { + ep_desc = &iface_desc->endpoint[i].desc; + + if (usb_endpoint_is_int_in(ep_desc) || + usb_endpoint_is_bulk_in(ep_desc)) { + if (!devpriv->ep_rx) + devpriv->ep_rx = ep_desc; + continue; + } + + if (usb_endpoint_is_int_out(ep_desc) || + usb_endpoint_is_bulk_out(ep_desc)) { + if (!devpriv->ep_tx) + devpriv->ep_tx = ep_desc; + continue; + } + } + + if (!devpriv->ep_rx || !devpriv->ep_tx) + return -ENODEV; + + return 0; +} + static int vmk80xx_attach_common(struct comedi_device *dev, struct vmk80xx_private *devpriv) { @@ -1299,9 +1333,8 @@ static int vmk80xx_usb_probe(struct usb_interface *intf, { const struct vmk80xx_board *boardinfo; struct vmk80xx_private *devpriv; - struct usb_host_interface *iface_desc; - struct usb_endpoint_descriptor *ep_desc; size_t size; + int ret; int i; mutex_lock(&glb_mutex); @@ -1320,37 +1353,12 @@ static int vmk80xx_usb_probe(struct usb_interface *intf, memset(devpriv, 0x00, sizeof(*devpriv)); devpriv->count = i; - iface_desc = intf->cur_altsetting; - if (iface_desc->desc.bNumEndpoints != 2) - goto error; - - for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) { - ep_desc = &iface_desc->endpoint[i].desc; - - if (usb_endpoint_is_int_in(ep_desc)) { - devpriv->ep_rx = ep_desc; - continue; - } - - if (usb_endpoint_is_int_out(ep_desc)) { - devpriv->ep_tx = ep_desc; - continue; - } - - if (usb_endpoint_is_bulk_in(ep_desc)) { - devpriv->ep_rx = ep_desc; - continue; - } - - if (usb_endpoint_is_bulk_out(ep_desc)) { - devpriv->ep_tx = ep_desc; - continue; - } + ret = vmk80xx_find_usb_endpoints(devpriv, intf); + if (ret) { + mutex_unlock(&glb_mutex); + return ret; } - if (!devpriv->ep_rx || !devpriv->ep_tx) - goto error; - size = le16_to_cpu(devpriv->ep_rx->wMaxPacketSize); devpriv->usb_rx_buf = kmalloc(size, GFP_KERNEL); if (!devpriv->usb_rx_buf) { @@ -1406,10 +1414,6 @@ static int vmk80xx_usb_probe(struct usb_interface *intf, comedi_usb_auto_config(intf, &vmk80xx_driver); return 0; -error: - mutex_unlock(&glb_mutex); - - return -ENODEV; } static const struct usb_device_id vmk80xx_usb_id_table[] = { |