Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 8ee26468 authored by H Hartley Sweeten's avatar H Hartley Sweeten Committed by Greg Kroah-Hartman
Browse files

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: default avatarH Hartley Sweeten <hsweeten@visionengravers.com>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent 8f566937
Loading
Loading
Loading
Loading
+49 −43
Original line number Diff line number Diff line
@@ -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