| /* | |
| * Copyright 2003 Digi International (www.digi.com) | |
| * Scott H Kilau <Scott_Kilau at digi dot com> | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License as published by | |
| * the Free Software Foundation; either version 2, or (at your option) | |
| * any later version. | |
| * | |
| * This program is distributed in the hope that it will be useful, | |
| * but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; without even the | |
| * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR | |
| * PURPOSE. See the GNU General Public License for more details. | |
| */ | |
| #include <linux/kernel.h> | |
| #include <linux/module.h> | |
| #include <linux/pci.h> | |
| #include <linux/slab.h> | |
| #include <linux/sched.h> | |
| #include "dgnc_driver.h" | |
| #include "dgnc_pci.h" | |
| #include "dgnc_mgmt.h" | |
| #include "dgnc_tty.h" | |
| #include "dgnc_cls.h" | |
| #include "dgnc_neo.h" | |
| MODULE_LICENSE("GPL"); | |
| MODULE_AUTHOR("Digi International, http://www.digi.com"); | |
| MODULE_DESCRIPTION("Driver for the Digi International Neo and Classic PCI based product line"); | |
| MODULE_SUPPORTED_DEVICE("dgnc"); | |
| static const struct file_operations dgnc_board_fops = { | |
| .owner = THIS_MODULE, | |
| .unlocked_ioctl = dgnc_mgmt_ioctl, | |
| .open = dgnc_mgmt_open, | |
| .release = dgnc_mgmt_close | |
| }; | |
| uint dgnc_num_boards; | |
| struct dgnc_board *dgnc_board[MAXBOARDS]; | |
| DEFINE_SPINLOCK(dgnc_global_lock); | |
| DEFINE_SPINLOCK(dgnc_poll_lock); /* Poll scheduling lock */ | |
| uint dgnc_major; | |
| int dgnc_poll_tick = 20; /* Poll interval - 20 ms */ | |
| static struct class *dgnc_class; | |
| static ulong dgnc_poll_time; /* Time of next poll */ | |
| static uint dgnc_poll_stop; /* Used to tell poller to stop */ | |
| static struct timer_list dgnc_poll_timer; | |
| static const struct pci_device_id dgnc_pci_tbl[] = { | |
| {PCI_DEVICE(DIGI_VID, PCI_DEVICE_CLASSIC_4_DID), .driver_data = 0}, | |
| {PCI_DEVICE(DIGI_VID, PCI_DEVICE_CLASSIC_4_422_DID), .driver_data = 1}, | |
| {PCI_DEVICE(DIGI_VID, PCI_DEVICE_CLASSIC_8_DID), .driver_data = 2}, | |
| {PCI_DEVICE(DIGI_VID, PCI_DEVICE_CLASSIC_8_422_DID), .driver_data = 3}, | |
| {0,} | |
| }; | |
| MODULE_DEVICE_TABLE(pci, dgnc_pci_tbl); | |
| struct board_id { | |
| unsigned char *name; | |
| uint maxports; | |
| unsigned int is_pci_express; | |
| }; | |
| static const struct board_id dgnc_ids[] = { | |
| { PCI_DEVICE_CLASSIC_4_PCI_NAME, 4, 0 }, | |
| { PCI_DEVICE_CLASSIC_4_422_PCI_NAME, 4, 0 }, | |
| { PCI_DEVICE_CLASSIC_8_PCI_NAME, 8, 0 }, | |
| { PCI_DEVICE_CLASSIC_8_422_PCI_NAME, 8, 0 }, | |
| { PCI_DEVICE_NEO_4_PCI_NAME, 4, 0 }, | |
| { PCI_DEVICE_NEO_8_PCI_NAME, 8, 0 }, | |
| { PCI_DEVICE_NEO_2DB9_PCI_NAME, 2, 0 }, | |
| { PCI_DEVICE_NEO_2DB9PRI_PCI_NAME, 2, 0 }, | |
| { PCI_DEVICE_NEO_2RJ45_PCI_NAME, 2, 0 }, | |
| { PCI_DEVICE_NEO_2RJ45PRI_PCI_NAME, 2, 0 }, | |
| { PCI_DEVICE_NEO_1_422_PCI_NAME, 1, 0 }, | |
| { PCI_DEVICE_NEO_1_422_485_PCI_NAME, 1, 0 }, | |
| { PCI_DEVICE_NEO_2_422_485_PCI_NAME, 2, 0 }, | |
| { PCI_DEVICE_NEO_EXPRESS_8_PCI_NAME, 8, 1 }, | |
| { PCI_DEVICE_NEO_EXPRESS_4_PCI_NAME, 4, 1 }, | |
| { PCI_DEVICE_NEO_EXPRESS_4RJ45_PCI_NAME, 4, 1 }, | |
| { PCI_DEVICE_NEO_EXPRESS_8RJ45_PCI_NAME, 8, 1 }, | |
| { NULL, 0, 0 } | |
| }; | |
| /* Remap PCI memory. */ | |
| static int dgnc_do_remap(struct dgnc_board *brd) | |
| { | |
| brd->re_map_membase = ioremap(brd->membase, 0x1000); | |
| if (!brd->re_map_membase) | |
| return -ENOMEM; | |
| return 0; | |
| } | |
| /* A board has been found, initialize it. */ | |
| static struct dgnc_board *dgnc_found_board(struct pci_dev *pdev, int id) | |
| { | |
| struct dgnc_board *brd; | |
| unsigned int pci_irq; | |
| int i = 0; | |
| int rc = 0; | |
| brd = kzalloc(sizeof(*brd), GFP_KERNEL); | |
| if (!brd) | |
| return ERR_PTR(-ENOMEM); | |
| /* store the info for the board we've found */ | |
| brd->boardnum = dgnc_num_boards; | |
| brd->vendor = dgnc_pci_tbl[id].vendor; | |
| brd->device = dgnc_pci_tbl[id].device; | |
| brd->pdev = pdev; | |
| brd->pci_bus = pdev->bus->number; | |
| brd->pci_slot = PCI_SLOT(pdev->devfn); | |
| brd->name = dgnc_ids[id].name; | |
| brd->maxports = dgnc_ids[id].maxports; | |
| if (dgnc_ids[i].is_pci_express) | |
| brd->bd_flags |= BD_IS_PCI_EXPRESS; | |
| brd->dpastatus = BD_NOFEP; | |
| init_waitqueue_head(&brd->state_wait); | |
| spin_lock_init(&brd->bd_lock); | |
| spin_lock_init(&brd->bd_intr_lock); | |
| brd->state = BOARD_FOUND; | |
| /* store which card & revision we have */ | |
| pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID, &brd->subvendor); | |
| pci_read_config_word(pdev, PCI_SUBSYSTEM_ID, &brd->subdevice); | |
| pci_read_config_byte(pdev, PCI_REVISION_ID, &brd->rev); | |
| pci_irq = pdev->irq; | |
| brd->irq = pci_irq; | |
| switch (brd->device) { | |
| case PCI_DEVICE_CLASSIC_4_DID: | |
| case PCI_DEVICE_CLASSIC_8_DID: | |
| case PCI_DEVICE_CLASSIC_4_422_DID: | |
| case PCI_DEVICE_CLASSIC_8_422_DID: | |
| brd->dpatype = T_CLASSIC | T_PCIBUS; | |
| /* | |
| * For PCI ClassicBoards | |
| * PCI Local Address (i.e. "resource" number) space | |
| * 0 PLX Memory Mapped Config | |
| * 1 PLX I/O Mapped Config | |
| * 2 I/O Mapped UARTs and Status | |
| * 3 Memory Mapped VPD | |
| * 4 Memory Mapped UARTs and Status | |
| */ | |
| brd->membase = pci_resource_start(pdev, 4); | |
| if (!brd->membase) { | |
| dev_err(&brd->pdev->dev, | |
| "Card has no PCI IO resources, failing.\n"); | |
| rc = -ENODEV; | |
| goto failed; | |
| } | |
| brd->membase_end = pci_resource_end(pdev, 4); | |
| if (brd->membase & 1) | |
| brd->membase &= ~3; | |
| else | |
| brd->membase &= ~15; | |
| brd->iobase = pci_resource_start(pdev, 1); | |
| brd->iobase_end = pci_resource_end(pdev, 1); | |
| brd->iobase = ((unsigned int)(brd->iobase)) & 0xFFFE; | |
| brd->bd_ops = &dgnc_cls_ops; | |
| brd->bd_uart_offset = 0x8; | |
| brd->bd_dividend = 921600; | |
| rc = dgnc_do_remap(brd); | |
| if (rc < 0) | |
| goto failed; | |
| /* Get and store the board VPD, if it exists */ | |
| brd->bd_ops->vpd(brd); | |
| /* | |
| * Enable Local Interrupt 1 (0x1), | |
| * Local Interrupt 1 Polarity Active high (0x2), | |
| * Enable PCI interrupt (0x40) | |
| */ | |
| outb(0x43, brd->iobase + 0x4c); | |
| break; | |
| case PCI_DEVICE_NEO_4_DID: | |
| case PCI_DEVICE_NEO_8_DID: | |
| case PCI_DEVICE_NEO_2DB9_DID: | |
| case PCI_DEVICE_NEO_2DB9PRI_DID: | |
| case PCI_DEVICE_NEO_2RJ45_DID: | |
| case PCI_DEVICE_NEO_2RJ45PRI_DID: | |
| case PCI_DEVICE_NEO_1_422_DID: | |
| case PCI_DEVICE_NEO_1_422_485_DID: | |
| case PCI_DEVICE_NEO_2_422_485_DID: | |
| case PCI_DEVICE_NEO_EXPRESS_8_DID: | |
| case PCI_DEVICE_NEO_EXPRESS_4_DID: | |
| case PCI_DEVICE_NEO_EXPRESS_4RJ45_DID: | |
| case PCI_DEVICE_NEO_EXPRESS_8RJ45_DID: | |
| /* | |
| * This chip is set up 100% when we get to it. | |
| * No need to enable global interrupts or anything. | |
| */ | |
| if (brd->bd_flags & BD_IS_PCI_EXPRESS) | |
| brd->dpatype = T_NEO_EXPRESS | T_PCIBUS; | |
| else | |
| brd->dpatype = T_NEO | T_PCIBUS; | |
| brd->membase = pci_resource_start(pdev, 0); | |
| brd->membase_end = pci_resource_end(pdev, 0); | |
| if (brd->membase & 1) | |
| brd->membase &= ~3; | |
| else | |
| brd->membase &= ~15; | |
| brd->bd_ops = &dgnc_neo_ops; | |
| brd->bd_uart_offset = 0x200; | |
| brd->bd_dividend = 921600; | |
| rc = dgnc_do_remap(brd); | |
| if (rc < 0) | |
| goto failed; | |
| /* Read and store the dvid after remapping */ | |
| brd->dvid = readb(brd->re_map_membase + 0x8D); | |
| /* Get and store the board VPD, if it exists */ | |
| brd->bd_ops->vpd(brd); | |
| break; | |
| default: | |
| dev_err(&brd->pdev->dev, | |
| "Didn't find any compatible Neo/Classic PCI boards.\n"); | |
| rc = -ENXIO; | |
| goto failed; | |
| } | |
| tasklet_init(&brd->helper_tasklet, | |
| brd->bd_ops->tasklet, | |
| (unsigned long)brd); | |
| wake_up_interruptible(&brd->state_wait); | |
| return brd; | |
| failed: | |
| kfree(brd); | |
| return ERR_PTR(rc); | |
| } | |
| static int dgnc_request_irq(struct dgnc_board *brd) | |
| { | |
| if (brd->irq) { | |
| int rc = request_irq(brd->irq, brd->bd_ops->intr, | |
| IRQF_SHARED, "DGNC", brd); | |
| if (rc) { | |
| dev_err(&brd->pdev->dev, | |
| "Failed to hook IRQ %d\n", brd->irq); | |
| brd->state = BOARD_FAILED; | |
| brd->dpastatus = BD_NOFEP; | |
| return -ENODEV; | |
| } | |
| } | |
| return 0; | |
| } | |
| static void dgnc_free_irq(struct dgnc_board *brd) | |
| { | |
| if (brd->irq) | |
| free_irq(brd->irq, brd); | |
| } | |
| /* | |
| * As each timer expires, it determines (a) whether the "transmit" | |
| * waiter needs to be woken up, and (b) whether the poller needs to | |
| * be rescheduled. | |
| */ | |
| static void dgnc_poll_handler(ulong dummy) | |
| { | |
| struct dgnc_board *brd; | |
| unsigned long flags; | |
| int i; | |
| unsigned long new_time; | |
| for (i = 0; i < dgnc_num_boards; i++) { | |
| brd = dgnc_board[i]; | |
| spin_lock_irqsave(&brd->bd_lock, flags); | |
| if (brd->state == BOARD_FAILED) { | |
| spin_unlock_irqrestore(&brd->bd_lock, flags); | |
| continue; | |
| } | |
| tasklet_schedule(&brd->helper_tasklet); | |
| spin_unlock_irqrestore(&brd->bd_lock, flags); | |
| } | |
| /* Schedule ourself back at the nominal wakeup interval. */ | |
| spin_lock_irqsave(&dgnc_poll_lock, flags); | |
| dgnc_poll_time += dgnc_jiffies_from_ms(dgnc_poll_tick); | |
| new_time = dgnc_poll_time - jiffies; | |
| if ((ulong)new_time >= 2 * dgnc_poll_tick) | |
| dgnc_poll_time = jiffies + dgnc_jiffies_from_ms(dgnc_poll_tick); | |
| setup_timer(&dgnc_poll_timer, dgnc_poll_handler, 0); | |
| dgnc_poll_timer.expires = dgnc_poll_time; | |
| spin_unlock_irqrestore(&dgnc_poll_lock, flags); | |
| if (!dgnc_poll_stop) | |
| add_timer(&dgnc_poll_timer); | |
| } | |
| /* returns count (>= 0), or negative on error */ | |
| static int dgnc_init_one(struct pci_dev *pdev, const struct pci_device_id *ent) | |
| { | |
| int rc; | |
| struct dgnc_board *brd; | |
| rc = pci_enable_device(pdev); | |
| if (rc) | |
| return -EIO; | |
| brd = dgnc_found_board(pdev, ent->driver_data); | |
| if (IS_ERR(brd)) | |
| return PTR_ERR(brd); | |
| rc = dgnc_tty_register(brd); | |
| if (rc < 0) { | |
| pr_err(DRVSTR ": Can't register tty devices (%d)\n", rc); | |
| goto failed; | |
| } | |
| rc = dgnc_request_irq(brd); | |
| if (rc < 0) { | |
| pr_err(DRVSTR ": Can't finalize board init (%d)\n", rc); | |
| goto unregister_tty; | |
| } | |
| rc = dgnc_tty_init(brd); | |
| if (rc < 0) { | |
| pr_err(DRVSTR ": Can't init tty devices (%d)\n", rc); | |
| goto free_irq; | |
| } | |
| brd->state = BOARD_READY; | |
| brd->dpastatus = BD_RUNNING; | |
| dgnc_board[dgnc_num_boards++] = brd; | |
| return 0; | |
| free_irq: | |
| dgnc_free_irq(brd); | |
| unregister_tty: | |
| dgnc_tty_unregister(brd); | |
| failed: | |
| kfree(brd); | |
| return rc; | |
| } | |
| static struct pci_driver dgnc_driver = { | |
| .name = "dgnc", | |
| .probe = dgnc_init_one, | |
| .id_table = dgnc_pci_tbl, | |
| }; | |
| static int dgnc_start(void) | |
| { | |
| int rc = 0; | |
| unsigned long flags; | |
| struct device *dev; | |
| init_timer(&dgnc_poll_timer); | |
| rc = register_chrdev(0, "dgnc", &dgnc_board_fops); | |
| if (rc < 0) { | |
| pr_err(DRVSTR ": Can't register dgnc driver device (%d)\n", rc); | |
| return rc; | |
| } | |
| dgnc_major = rc; | |
| dgnc_class = class_create(THIS_MODULE, "dgnc_mgmt"); | |
| if (IS_ERR(dgnc_class)) { | |
| rc = PTR_ERR(dgnc_class); | |
| pr_err(DRVSTR ": Can't create dgnc_mgmt class (%d)\n", rc); | |
| goto failed_class; | |
| } | |
| dev = device_create(dgnc_class, NULL, | |
| MKDEV(dgnc_major, 0), | |
| NULL, "dgnc_mgmt"); | |
| if (IS_ERR(dev)) { | |
| rc = PTR_ERR(dev); | |
| pr_err(DRVSTR ": Can't create device (%d)\n", rc); | |
| goto failed_device; | |
| } | |
| /* Start the poller */ | |
| spin_lock_irqsave(&dgnc_poll_lock, flags); | |
| setup_timer(&dgnc_poll_timer, dgnc_poll_handler, 0); | |
| dgnc_poll_time = jiffies + dgnc_jiffies_from_ms(dgnc_poll_tick); | |
| dgnc_poll_timer.expires = dgnc_poll_time; | |
| spin_unlock_irqrestore(&dgnc_poll_lock, flags); | |
| add_timer(&dgnc_poll_timer); | |
| return 0; | |
| failed_device: | |
| class_destroy(dgnc_class); | |
| failed_class: | |
| unregister_chrdev(dgnc_major, "dgnc"); | |
| return rc; | |
| } | |
| /* Free all the memory associated with a board */ | |
| static void dgnc_cleanup_board(struct dgnc_board *brd) | |
| { | |
| int i = 0; | |
| if (!brd) | |
| return; | |
| switch (brd->device) { | |
| case PCI_DEVICE_CLASSIC_4_DID: | |
| case PCI_DEVICE_CLASSIC_8_DID: | |
| case PCI_DEVICE_CLASSIC_4_422_DID: | |
| case PCI_DEVICE_CLASSIC_8_422_DID: | |
| /* Tell card not to interrupt anymore. */ | |
| outb(0, brd->iobase + 0x4c); | |
| break; | |
| default: | |
| break; | |
| } | |
| if (brd->irq) | |
| free_irq(brd->irq, brd); | |
| tasklet_kill(&brd->helper_tasklet); | |
| if (brd->re_map_membase) { | |
| iounmap(brd->re_map_membase); | |
| brd->re_map_membase = NULL; | |
| } | |
| for (i = 0; i < MAXPORTS ; i++) { | |
| if (brd->channels[i]) { | |
| kfree(brd->channels[i]->ch_rqueue); | |
| kfree(brd->channels[i]->ch_equeue); | |
| kfree(brd->channels[i]->ch_wqueue); | |
| kfree(brd->channels[i]); | |
| brd->channels[i] = NULL; | |
| } | |
| } | |
| dgnc_board[brd->boardnum] = NULL; | |
| kfree(brd); | |
| } | |
| /* Driver load/unload functions */ | |
| static void cleanup(void) | |
| { | |
| int i; | |
| unsigned long flags; | |
| spin_lock_irqsave(&dgnc_poll_lock, flags); | |
| dgnc_poll_stop = 1; | |
| spin_unlock_irqrestore(&dgnc_poll_lock, flags); | |
| /* Turn off poller right away. */ | |
| del_timer_sync(&dgnc_poll_timer); | |
| device_destroy(dgnc_class, MKDEV(dgnc_major, 0)); | |
| class_destroy(dgnc_class); | |
| unregister_chrdev(dgnc_major, "dgnc"); | |
| for (i = 0; i < dgnc_num_boards; ++i) { | |
| dgnc_cleanup_tty(dgnc_board[i]); | |
| dgnc_cleanup_board(dgnc_board[i]); | |
| } | |
| } | |
| static void __exit dgnc_cleanup_module(void) | |
| { | |
| cleanup(); | |
| pci_unregister_driver(&dgnc_driver); | |
| } | |
| static int __init dgnc_init_module(void) | |
| { | |
| int rc; | |
| /* Initialize global stuff */ | |
| rc = dgnc_start(); | |
| if (rc < 0) | |
| return rc; | |
| /* Find and configure all the cards */ | |
| rc = pci_register_driver(&dgnc_driver); | |
| if (rc) { | |
| pr_warn("WARNING: dgnc driver load failed. No Digi Neo or Classic boards found.\n"); | |
| cleanup(); | |
| return rc; | |
| } | |
| return 0; | |
| } | |
| module_init(dgnc_init_module); | |
| module_exit(dgnc_cleanup_module); |