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

Commit 9cde5bf0 authored by Jiri Slaby's avatar Jiri Slaby Committed by Linus Torvalds
Browse files

[PATCH] Char: moxa, pci_probing prepare



- change pci conf prototype and rename it to moxa_pci_probe
- move some code to moxa_pci_probe
- create moxa_pci_remove

Signed-off-by: default avatarJiri Slaby <jirislaby@gmail.com>
Signed-off-by: default avatarAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@linux-foundation.org>
parent 181d6f4f
Loading
Loading
Loading
Loading
+46 −18
Original line number Diff line number Diff line
@@ -275,10 +275,35 @@ static DEFINE_TIMER(moxaTimer, moxa_poll, 0, 0);
static DEFINE_SPINLOCK(moxa_lock);

#ifdef CONFIG_PCI
static int moxa_get_PCI_conf(struct pci_dev *p, int board_type,
		struct moxa_board_conf *board)
static int __devinit moxa_pci_probe(struct pci_dev *pdev,
		const struct pci_device_id *ent)
{
	board->baseAddr = pci_resource_start (p, 2);
	struct moxa_board_conf *board;
	unsigned int i;
	int board_type = ent->driver_data;
	int retval;

	retval = pci_enable_device(pdev);
	if (retval)
		goto err;

	for (i = 0; i < MAX_BOARDS; i++)
		if (moxa_boards[i].basemem == NULL)
			break;

	retval = -ENODEV;
	if (i >= MAX_BOARDS) {
		if (verbose)
			printk("More than %d MOXA Intellio family boards "
				"found. Board is ignored.\n", MAX_BOARDS);
		goto err;
	}

	board = &moxa_boards[i];
	board->basemem = pci_iomap(pdev, 2, 0x4000);
	if (board->basemem == NULL)
		goto err;

	board->boardType = board_type;
	switch (board_type) {
	case MOXA_BOARD_C218_ISA:
@@ -295,9 +320,21 @@ static int moxa_get_PCI_conf(struct pci_dev *p, int board_type,
	}
	board->busType = MOXA_BUS_TYPE_PCI;
	/* don't lose the reference in the next pci_get_device iteration */
	board->pdev = pci_dev_get(p);
	board->pdev = pci_dev_get(pdev);
	pci_set_drvdata(pdev, board);

	return (0);
err:
	return retval;
}

static void __devexit moxa_pci_remove(struct pci_dev *pdev)
{
	struct moxa_board_conf *brd = pci_get_drvdata(pdev);

	pci_iounmap(pdev, brd->basemem);
	brd->basemem = NULL;
	pci_dev_put(pdev);
}
#endif /* CONFIG_PCI */

@@ -401,18 +438,7 @@ static int __init moxa_init(void)
		i = 0;
		while (i < n) {
			while ((p = pci_get_device(moxa_pcibrds[i].vendor, moxa_pcibrds[i].device, p))!=NULL)
			{
				if (pci_enable_device(p))
					continue;
				if (numBoards >= MAX_BOARDS) {
					if (verbose)
						printk("More than %d MOXA Intellio family boards found. Board is ignored.", MAX_BOARDS);
				} else {
					moxa_get_PCI_conf(p, moxa_pcibrds[i].driver_data,
						&moxa_boards[numBoards]);
					numBoards++;
				}
			}
				moxa_pci_probe(p, &moxa_pcibrds[i]);
			i++;
		}
	}
@@ -442,10 +468,12 @@ static void __exit moxa_exit(void)
	put_tty_driver(moxaDriver);

	for (i = 0; i < MAX_BOARDS; i++) {
#ifdef CONFIG_PCI
		if (moxa_boards[i].busType == MOXA_BUS_TYPE_PCI)
			moxa_pci_remove(moxa_boards[i].pdev);
#endif
		if (moxa_boards[i].basemem)
			iounmap(moxa_boards[i].basemem);
		if (moxa_boards[i].busType == MOXA_BUS_TYPE_PCI)
			pci_dev_put(moxa_boards[i].pdev);
	}

	if (verbose)