From 2094e757afb9ecf2daf433e54e02b61f99bf487f Mon Sep 17 00:00:00 2001 From: Jiri Slaby Date: Fri, 8 Dec 2006 02:38:33 -0800 Subject: [PATCH] [PATCH] Char: mxser_new, pci probing Finally, the intention of the patch serie: PCI probing for this driver. add pci_driver structure, (un)register it and add some stuff, which this needs. Remove pdev pointer from board structure, because it's no longer needed. Signed-off-by: Jiri Slaby Cc: Alan Cox Signed-off-by: Andrew Morton Signed-off-by: Linus Torvalds --- drivers/char/mxser_new.c | 175 ++++++++++++++++++++------------------- 1 file changed, 88 insertions(+), 87 deletions(-) diff --git a/drivers/char/mxser_new.c b/drivers/char/mxser_new.c index 792524ab348..c06c5920bf1 100644 --- a/drivers/char/mxser_new.c +++ b/drivers/char/mxser_new.c @@ -283,8 +283,7 @@ struct mxser_port { }; struct mxser_board { - struct pci_dev *pdev; /* temporary (until pci probing) */ - + unsigned int idx; int irq; const struct mxser_cardinfo *info; unsigned long vector; @@ -2383,10 +2382,9 @@ static const struct tty_operations mxser_ops = { * The MOXA Smartio/Industio serial driver boot-time initialization code! */ -static void mxser_release_res(struct mxser_board *brd, unsigned int irq) +static void mxser_release_res(struct mxser_board *brd, struct pci_dev *pdev, + unsigned int irq) { - struct pci_dev *pdev = brd->pdev; - if (irq) free_irq(brd->irq, brd); if (pdev != NULL) { /* PCI */ @@ -2399,7 +2397,8 @@ static void mxser_release_res(struct mxser_board *brd, unsigned int irq) } } -static int __devinit mxser_initbrd(struct mxser_board *brd) +static int __devinit mxser_initbrd(struct mxser_board *brd, + struct pci_dev *pdev) { struct mxser_port *info; unsigned int i; @@ -2450,7 +2449,7 @@ static int __devinit mxser_initbrd(struct mxser_board *brd) "conflict with another device.\n", brd->info->name, brd->irq); /* We hold resources, we need to release them. */ - mxser_release_res(brd, 0); + mxser_release_res(brd, pdev, 0); return retval; } return 0; @@ -2552,20 +2551,43 @@ static int __init mxser_get_ISA_conf(int cap, struct mxser_board *brd) return brd->info->nports; } -static int __init mxser_get_PCI_conf(const struct pci_device_id *ent, - struct mxser_board *brd, struct pci_dev *pdev) +static int __devinit mxser_probe(struct pci_dev *pdev, + const struct pci_device_id *ent) { + struct mxser_board *brd; unsigned int i, j; unsigned long ioaddress; - int retval; + int retval = -EINVAL; + + for (i = 0; i < MXSER_BOARDS; i++) + if (mxser_boards[i].info == NULL) + break; + + if (i >= MXSER_BOARDS) { + printk(KERN_ERR "Too many Smartio/Industio family boards found " + "(maximum %d), board not configured\n", MXSER_BOARDS); + goto err; + } + + brd = &mxser_boards[i]; + brd->idx = i * MXSER_PORTS_PER_BOARD; + printk(KERN_INFO "Found MOXA %s board (BusNo=%d, DevNo=%d)\n", + mxser_cards[ent->driver_data].name, + pdev->bus->number, PCI_SLOT(pdev->devfn)); + + retval = pci_enable_device(pdev); + if (retval) { + printk(KERN_ERR "Moxa SmartI/O PCI enable fail !\n"); + goto err; + } /* io address */ - brd->info = &mxser_cards[ent->driver_data]; ioaddress = pci_resource_start(pdev, 2); retval = pci_request_region(pdev, 2, "mxser(IO)"); if (retval) goto err; + brd->info = &mxser_cards[ent->driver_data]; for (i = 0; i < brd->info->nports; i++) brd->ports[i].ioaddr = ioaddress + 8 * i; @@ -2612,20 +2634,50 @@ static int __init mxser_get_PCI_conf(const struct pci_device_id *ent, brd->vector_mask |= (1 << i); brd->ports[i].baud_base = 921600; } + + /* mxser_initbrd will hook ISR. */ + if (mxser_initbrd(brd, pdev) < 0) + goto err_relvec; + + for (i = 0; i < brd->info->nports; i++) + tty_register_device(mxvar_sdriver, brd->idx + i, &pdev->dev); + + pci_set_drvdata(pdev, brd); + return 0; +err_relvec: + pci_release_region(pdev, 3); err_relio: pci_release_region(pdev, 2); + brd->info = NULL; err: return retval; } +static void __devexit mxser_remove(struct pci_dev *pdev) +{ + struct mxser_board *brd = pci_get_drvdata(pdev); + unsigned int i; + + for (i = 0; i < brd->info->nports; i++) + tty_unregister_device(mxvar_sdriver, brd->idx + i); + + mxser_release_res(brd, pdev, 1); +} + +static struct pci_driver mxser_driver = { + .name = "mxser", + .id_table = mxser_pcibrds, + .probe = mxser_probe, + .remove = __devexit_p(mxser_remove) +}; + static int __init mxser_module_init(void) { - struct pci_dev *pdev = NULL; struct mxser_board *brd; unsigned long cap; unsigned int i, m, isaloop; - int retval, b, n; + int retval, b; pr_debug("Loading module mxser ...\n"); @@ -2696,87 +2748,31 @@ static int __init mxser_module_init(void) printk(KERN_ERR "Invalid I/O address, " "board not configured\n"); + brd->info = NULL; continue; } - brd->pdev = NULL; - /* mxser_initbrd will hook ISR. */ - if (mxser_initbrd(brd) < 0) - continue; - - for (i = 0; i < brd->info->nports; i++) - tty_register_device(mxvar_sdriver, - m * MXSER_PORTS_PER_BOARD + i, NULL); - - m++; - } - - /* start finding PCI board here */ - n = ARRAY_SIZE(mxser_pcibrds) - 1; - b = 0; - while (b < n) { - pdev = pci_get_device(mxser_pcibrds[b].vendor, - mxser_pcibrds[b].device, pdev); - if (pdev == NULL) { - b++; - continue; - } - printk(KERN_INFO "Found MOXA %s board(BusNo=%d,DevNo=%d)\n", - mxser_cards[mxser_pcibrds[b].driver_data].name, - pdev->bus->number, PCI_SLOT(pdev->devfn)); - if (m >= MXSER_BOARDS) - printk(KERN_ERR - "Too many Smartio/Industio family boards find " - "(maximum %d), board not configured\n", - MXSER_BOARDS); - else { - if (pci_enable_device(pdev)) { - printk(KERN_ERR "Moxa SmartI/O PCI enable " - "fail !\n"); - continue; - } - brd = &mxser_boards[m]; - brd->pdev = pdev; - retval = mxser_get_PCI_conf(&mxser_pcibrds[b], - brd, pdev); - if (retval < 0) { - if (retval == MXSER_ERR_IRQ) - printk(KERN_ERR - "Invalid interrupt number, " - "board not configured\n"); - else if (retval == MXSER_ERR_IRQ_CONFLIT) - printk(KERN_ERR - "Invalid interrupt number, " - "board not configured\n"); - else if (retval == MXSER_ERR_VECTOR) - printk(KERN_ERR - "Invalid interrupt vector, " - "board not configured\n"); - else if (retval == MXSER_ERR_IOADDR) - printk(KERN_ERR - "Invalid I/O address, " - "board not configured\n"); + if (mxser_initbrd(brd, NULL) < 0) { + brd->info = NULL; continue; } - /* mxser_initbrd will hook ISR. */ - if (mxser_initbrd(brd) < 0) - continue; + + brd->idx = m * MXSER_PORTS_PER_BOARD; for (i = 0; i < brd->info->nports; i++) - tty_register_device(mxvar_sdriver, - m * MXSER_PORTS_PER_BOARD + i, - &pdev->dev); + tty_register_device(mxvar_sdriver, brd->idx + i, + NULL); m++; - /* Keep an extra reference if we succeeded. It will - be returned at unload time */ - pci_dev_get(pdev); } - } - if (!m) { - retval = -ENODEV; - goto err_unr; + retval = pci_register_driver(&mxser_driver); + if (retval) { + printk(KERN_ERR "Can't register pci driver\n"); + if (!m) { + retval = -ENODEV; + goto err_unr; + } /* else: we have some ISA cards under control */ } pr_debug("Done.\n"); @@ -2791,18 +2787,23 @@ err_put: static void __exit mxser_module_exit(void) { - unsigned int i; + unsigned int i, j; pr_debug("Unloading module mxser ...\n"); - for (i = 0; i < MXSER_PORTS; i++) - tty_unregister_device(mxvar_sdriver, i); + pci_unregister_driver(&mxser_driver); + + for (i = 0; i < MXSER_BOARDS; i++) /* ISA remains */ + if (mxser_boards[i].info != NULL) + for (j = 0; j < mxser_boards[i].info->nports; j++) + tty_unregister_device(mxvar_sdriver, + mxser_boards[i].idx + j); tty_unregister_driver(mxvar_sdriver); put_tty_driver(mxvar_sdriver); for (i = 0; i < MXSER_BOARDS; i++) if (mxser_boards[i].info != NULL) - mxser_release_res(&mxser_boards[i], 1); + mxser_release_res(&mxser_boards[i], NULL, 1); pr_debug("Done.\n"); } -- 2.20.1