[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: Jiri Slaby <jirislaby@gmail.com> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
This commit is contained in:
parent
181d6f4fac
commit
9cde5bf027
|
@ -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)
|
||||
|
|
Loading…
Reference in New Issue