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

staging: comedi: cb_pcimdas: factor out the "find pci device" code



Factor the "find pci device" code out of the attach function.

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 cdb82250
Loading
Loading
Loading
Loading
+32 −29
Original line number Diff line number Diff line
@@ -175,30 +175,11 @@ static int cb_pcimdas_ao_rinsn(struct comedi_device *dev,
			       struct comedi_subdevice *s,
			       struct comedi_insn *insn, unsigned int *data);

/*
 * Attach is called by the Comedi core to configure the driver
 * for a particular board.  If you specified a board_name array
 * in the driver structure, dev->board_ptr contains that
 * address.
 */
static int cb_pcimdas_attach(struct comedi_device *dev,
static struct pci_dev *cb_pcimdas_find_pci_dev(struct comedi_device *dev,
					       struct comedi_devconfig *it)
{
	struct comedi_subdevice *s;
	struct pci_dev *pcidev = NULL;
	int index;
	int ret;
	/* int i; */

/*
 * Allocate the private structure area.
 */
	if (alloc_private(dev, sizeof(struct cb_pcimdas_private)) < 0)
		return -ENOMEM;

/*
 * Probe the device to determine what device in the series it is.
 */

	for_each_pci_dev(pcidev) {
		/*  is it not a computer boards card? */
@@ -217,21 +198,43 @@ static int cb_pcimdas_attach(struct comedi_device *dev,
					continue;
				}
			}
			devpriv->pci_dev = pcidev;
			dev->board_ptr = cb_pcimdas_boards + index;
			goto found;
			dev_dbg(dev->class_dev,
				"Found %s on bus %i, slot %i\n",
				cb_pcimdas_boards[index].name,
				pcidev->bus->number,
				PCI_SLOT(pcidev->devfn));
			return pcidev;
		}
	}

	dev_err(dev->class_dev,
		"No supported ComputerBoards/MeasurementComputing card found on requested position\n");
	return -EIO;
	return NULL;
}

/*
 * Attach is called by the Comedi core to configure the driver
 * for a particular board.  If you specified a board_name array
 * in the driver structure, dev->board_ptr contains that
 * address.
 */
static int cb_pcimdas_attach(struct comedi_device *dev,
			     struct comedi_devconfig *it)
{
	struct pci_dev *pcidev;
	struct comedi_subdevice *s;
	int ret;

found:
/*
 * Allocate the private structure area.
 */
	if (alloc_private(dev, sizeof(struct cb_pcimdas_private)) < 0)
		return -ENOMEM;

	dev_dbg(dev->class_dev, "Found %s on bus %i, slot %i\n",
		cb_pcimdas_boards[index].name, pcidev->bus->number,
		PCI_SLOT(pcidev->devfn));
	pcidev = cb_pcimdas_find_pci_dev(dev, it);
	if (!pcidev)
		return -EIO;
	devpriv->pci_dev = pcidev;

	/*  Warn about non-tested features */
	switch (thisboard->device_id) {