|
@@ -29,7 +29,9 @@
|
|
|
#include "jsm.h"
|
|
|
|
|
|
MODULE_AUTHOR("Digi International, http://www.digi.com");
|
|
|
-MODULE_DESCRIPTION("Driver for the Digi International Neo PCI based product line");
|
|
|
+MODULE_DESCRIPTION("Driver for the Digi International "
|
|
|
+ "Neo PCI based product line");
|
|
|
+MODULE_LICENSE("GPL");
|
|
|
MODULE_SUPPORTED_DEVICE("jsm");
|
|
|
|
|
|
#define JSM_DRIVER_NAME "jsm"
|
|
@@ -43,7 +45,6 @@ struct uart_driver jsm_uart_driver = {
|
|
|
.major = 253,
|
|
|
.minor = JSM_MINOR_START,
|
|
|
.nr = NR_PORTS,
|
|
|
- .cons = NULL,
|
|
|
};
|
|
|
|
|
|
int jsm_debug;
|
|
@@ -53,193 +54,99 @@ module_param(jsm_rawreadok, int, 0);
|
|
|
MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
|
|
|
MODULE_PARM_DESC(jsm_rawreadok, "Bypass flip buffers on input");
|
|
|
|
|
|
-/*
|
|
|
- * Globals
|
|
|
- */
|
|
|
-int jsm_driver_state = DRIVER_INITIALIZED;
|
|
|
-spinlock_t jsm_board_head_lock = SPIN_LOCK_UNLOCKED;
|
|
|
-LIST_HEAD(jsm_board_head);
|
|
|
-
|
|
|
-static struct pci_device_id jsm_pci_tbl[] = {
|
|
|
- { PCI_DEVICE (PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
|
|
|
- { PCI_DEVICE (PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
|
|
|
- { PCI_DEVICE (PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
|
|
|
- { PCI_DEVICE (PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
|
|
|
- { 0,} /* 0 terminated list. */
|
|
|
-};
|
|
|
-MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
|
|
|
-
|
|
|
-static struct board_id jsm_Ids[] = {
|
|
|
- { PCI_DEVICE_NEO_2DB9_PCI_NAME, 2 },
|
|
|
- { PCI_DEVICE_NEO_2DB9PRI_PCI_NAME, 2 },
|
|
|
- { PCI_DEVICE_NEO_2RJ45_PCI_NAME, 2 },
|
|
|
- { PCI_DEVICE_NEO_2RJ45PRI_PCI_NAME, 2 },
|
|
|
- { NULL, 0 }
|
|
|
-};
|
|
|
-
|
|
|
-char *jsm_driver_state_text[] = {
|
|
|
- "Driver Initialized",
|
|
|
- "Driver Ready."
|
|
|
-};
|
|
|
-
|
|
|
-static int jsm_finalize_board_init(struct jsm_board *brd)
|
|
|
+static int jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
|
|
|
{
|
|
|
int rc = 0;
|
|
|
+ struct jsm_board *brd;
|
|
|
+ static int adapter_count = 0;
|
|
|
+ int retval;
|
|
|
|
|
|
- jsm_printk(INIT, INFO, &brd->pci_dev, "start\n");
|
|
|
-
|
|
|
- if (brd->irq) {
|
|
|
- rc = request_irq(brd->irq, brd->bd_ops->intr, SA_INTERRUPT|SA_SHIRQ, "JSM", brd);
|
|
|
-
|
|
|
- if (rc) {
|
|
|
- printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
|
|
|
- brd->state = BOARD_FAILED;
|
|
|
- brd->dpastatus = BD_NOFEP;
|
|
|
- rc = -ENODEV;
|
|
|
- } else
|
|
|
- jsm_printk(INIT, INFO, &brd->pci_dev,
|
|
|
- "Requested and received usage of IRQ %d\n", brd->irq);
|
|
|
+ rc = pci_enable_device(pdev);
|
|
|
+ if (rc) {
|
|
|
+ dev_err(&pdev->dev, "Device enable FAILED\n");
|
|
|
+ goto out;
|
|
|
}
|
|
|
- return rc;
|
|
|
-}
|
|
|
|
|
|
-/*
|
|
|
- * jsm_found_board()
|
|
|
- *
|
|
|
- * A board has been found, init it.
|
|
|
- */
|
|
|
-static int jsm_found_board(struct pci_dev *pdev, int id)
|
|
|
-{
|
|
|
- struct jsm_board *brd;
|
|
|
- int i = 0;
|
|
|
- int rc = 0;
|
|
|
- struct list_head *tmp;
|
|
|
- struct jsm_board *cur_board_entry;
|
|
|
- unsigned long lock_flags;
|
|
|
- int adapter_count = 0;
|
|
|
- int retval;
|
|
|
+ rc = pci_request_regions(pdev, "jsm");
|
|
|
+ if (rc) {
|
|
|
+ dev_err(&pdev->dev, "pci_request_region FAILED\n");
|
|
|
+ goto out_disable_device;
|
|
|
+ }
|
|
|
|
|
|
brd = kmalloc(sizeof(struct jsm_board), GFP_KERNEL);
|
|
|
if (!brd) {
|
|
|
- dev_err(&pdev->dev, "memory allocation for board structure failed\n");
|
|
|
- return -ENOMEM;
|
|
|
+ dev_err(&pdev->dev,
|
|
|
+ "memory allocation for board structure failed\n");
|
|
|
+ rc = -ENOMEM;
|
|
|
+ goto out_release_regions;
|
|
|
}
|
|
|
memset(brd, 0, sizeof(struct jsm_board));
|
|
|
|
|
|
- spin_lock_irqsave(&jsm_board_head_lock, lock_flags);
|
|
|
- list_for_each(tmp, &jsm_board_head) {
|
|
|
- cur_board_entry =
|
|
|
- list_entry(tmp, struct jsm_board,
|
|
|
- jsm_board_entry);
|
|
|
- if (cur_board_entry->boardnum != adapter_count) {
|
|
|
- break;
|
|
|
- }
|
|
|
- adapter_count++;
|
|
|
- }
|
|
|
-
|
|
|
- list_add_tail(&brd->jsm_board_entry, &jsm_board_head);
|
|
|
- spin_unlock_irqrestore(&jsm_board_head_lock, lock_flags);
|
|
|
-
|
|
|
/* store the info for the board we've found */
|
|
|
- brd->boardnum = adapter_count;
|
|
|
+ brd->boardnum = adapter_count++;
|
|
|
brd->pci_dev = pdev;
|
|
|
- brd->name = jsm_Ids[id].name;
|
|
|
- brd->maxports = jsm_Ids[id].maxports;
|
|
|
- brd->dpastatus = BD_NOFEP;
|
|
|
- init_waitqueue_head(&brd->state_wait);
|
|
|
+ brd->maxports = 2;
|
|
|
|
|
|
spin_lock_init(&brd->bd_lock);
|
|
|
spin_lock_init(&brd->bd_intr_lock);
|
|
|
|
|
|
- brd->state = BOARD_FOUND;
|
|
|
-
|
|
|
- for (i = 0; i < brd->maxports; i++)
|
|
|
- brd->channels[i] = NULL;
|
|
|
-
|
|
|
/* store which revision we have */
|
|
|
pci_read_config_byte(pdev, PCI_REVISION_ID, &brd->rev);
|
|
|
|
|
|
brd->irq = pdev->irq;
|
|
|
|
|
|
- switch(brd->pci_dev->device) {
|
|
|
-
|
|
|
- case PCI_DEVICE_ID_NEO_2DB9:
|
|
|
- case PCI_DEVICE_ID_NEO_2DB9PRI:
|
|
|
- case PCI_DEVICE_ID_NEO_2RJ45:
|
|
|
- case PCI_DEVICE_ID_NEO_2RJ45PRI:
|
|
|
-
|
|
|
- /*
|
|
|
- * This chip is set up 100% when we get to it.
|
|
|
- * No need to enable global interrupts or anything.
|
|
|
- */
|
|
|
- brd->dpatype = T_NEO | T_PCIBUS;
|
|
|
+ jsm_printk(INIT, INFO, &brd->pci_dev,
|
|
|
+ "jsm_found_board - NEO adapter\n");
|
|
|
|
|
|
- jsm_printk(INIT, INFO, &brd->pci_dev,
|
|
|
- "jsm_found_board - NEO adapter\n");
|
|
|
+ /* get the PCI Base Address Registers */
|
|
|
+ brd->membase = pci_resource_start(pdev, 0);
|
|
|
+ brd->membase_end = pci_resource_end(pdev, 0);
|
|
|
|
|
|
- /* get the PCI Base Address Registers */
|
|
|
- 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;
|
|
|
|
|
|
- if (brd->membase & 1)
|
|
|
- brd->membase &= ~3;
|
|
|
- else
|
|
|
- brd->membase &= ~15;
|
|
|
+ /* Assign the board_ops struct */
|
|
|
+ brd->bd_ops = &jsm_neo_ops;
|
|
|
|
|
|
- /* Assign the board_ops struct */
|
|
|
- brd->bd_ops = &jsm_neo_ops;
|
|
|
+ brd->bd_uart_offset = 0x200;
|
|
|
+ brd->bd_dividend = 921600;
|
|
|
|
|
|
- brd->bd_uart_offset = 0x200;
|
|
|
- brd->bd_dividend = 921600;
|
|
|
-
|
|
|
- brd->re_map_membase = ioremap(brd->membase, 0x1000);
|
|
|
- jsm_printk(INIT, INFO, &brd->pci_dev,
|
|
|
- "remapped mem: 0x%p\n", brd->re_map_membase);
|
|
|
- if (!brd->re_map_membase) {
|
|
|
- kfree(brd);
|
|
|
- dev_err(&pdev->dev, "card has no PCI Memory resources, failing board.\n");
|
|
|
- return -ENOMEM;
|
|
|
- }
|
|
|
- break;
|
|
|
-
|
|
|
- default:
|
|
|
- dev_err(&pdev->dev, "Did not find any compatible Neo or Classic PCI boards in system.\n");
|
|
|
- kfree(brd);
|
|
|
- return -ENXIO;
|
|
|
+ brd->re_map_membase = ioremap(brd->membase, 0x1000);
|
|
|
+ if (!brd->re_map_membase) {
|
|
|
+ dev_err(&pdev->dev,
|
|
|
+ "card has no PCI Memory resources, "
|
|
|
+ "failing board.\n");
|
|
|
+ rc = -ENOMEM;
|
|
|
+ goto out_kfree_brd;
|
|
|
}
|
|
|
|
|
|
- /*
|
|
|
- * Do tty device initialization.
|
|
|
- */
|
|
|
- rc = jsm_finalize_board_init(brd);
|
|
|
- if (rc < 0) {
|
|
|
- dev_err(&pdev->dev, "Can't finalize board init (%d)\n", rc);
|
|
|
- brd->state = BOARD_FAILED;
|
|
|
- retval = -ENXIO;
|
|
|
- goto failed0;
|
|
|
+ rc = request_irq(brd->irq, brd->bd_ops->intr,
|
|
|
+ SA_INTERRUPT|SA_SHIRQ, "JSM", brd);
|
|
|
+ if (rc) {
|
|
|
+ printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
|
|
|
+ goto out_iounmap;
|
|
|
}
|
|
|
|
|
|
rc = jsm_tty_init(brd);
|
|
|
if (rc < 0) {
|
|
|
dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
|
|
|
- brd->state = BOARD_FAILED;
|
|
|
retval = -ENXIO;
|
|
|
- goto failed1;
|
|
|
+ goto out_free_irq;
|
|
|
}
|
|
|
|
|
|
rc = jsm_uart_port_init(brd);
|
|
|
if (rc < 0) {
|
|
|
+ /* XXX: leaking all resources from jsm_tty_init here! */
|
|
|
dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
|
|
|
- brd->state = BOARD_FAILED;
|
|
|
retval = -ENXIO;
|
|
|
- goto failed1;
|
|
|
+ goto out_free_irq;
|
|
|
}
|
|
|
|
|
|
- brd->state = BOARD_READY;
|
|
|
- brd->dpastatus = BD_RUNNING;
|
|
|
-
|
|
|
/* Log the information about the board */
|
|
|
- dev_info(&pdev->dev, "board %d: %s (rev %d), irq %d\n",adapter_count, brd->name, brd->rev, brd->irq);
|
|
|
+ dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
|
|
|
+ adapter_count, brd->rev, brd->irq);
|
|
|
|
|
|
/*
|
|
|
* allocate flip buffer for board.
|
|
@@ -249,156 +156,91 @@ static int jsm_found_board(struct pci_dev *pdev, int id)
|
|
|
*/
|
|
|
brd->flipbuf = kmalloc(MYFLIPLEN, GFP_KERNEL);
|
|
|
if (!brd->flipbuf) {
|
|
|
+ /* XXX: leaking all resources from jsm_tty_init and
|
|
|
+ jsm_uart_port_init here! */
|
|
|
dev_err(&pdev->dev, "memory allocation for flipbuf failed\n");
|
|
|
- brd->state = BOARD_FAILED;
|
|
|
retval = -ENOMEM;
|
|
|
- goto failed1;
|
|
|
+ goto out_free_irq;
|
|
|
}
|
|
|
memset(brd->flipbuf, 0, MYFLIPLEN);
|
|
|
|
|
|
- jsm_create_driver_sysfiles(pdev->dev.driver);
|
|
|
+ pci_set_drvdata(pdev, brd);
|
|
|
|
|
|
- wake_up_interruptible(&brd->state_wait);
|
|
|
return 0;
|
|
|
-failed1:
|
|
|
+ out_free_irq:
|
|
|
free_irq(brd->irq, brd);
|
|
|
-failed0:
|
|
|
- kfree(brd);
|
|
|
+ out_iounmap:
|
|
|
iounmap(brd->re_map_membase);
|
|
|
- return retval;
|
|
|
-}
|
|
|
-
|
|
|
-/* returns count (>= 0), or negative on error */
|
|
|
-static int jsm_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
|
|
|
-{
|
|
|
- int rc;
|
|
|
-
|
|
|
- rc = pci_enable_device(pdev);
|
|
|
- if (rc) {
|
|
|
- dev_err(&pdev->dev, "Device enable FAILED\n");
|
|
|
- return rc;
|
|
|
- }
|
|
|
-
|
|
|
- if ((rc = pci_request_regions(pdev, "jsm"))) {
|
|
|
- dev_err(&pdev->dev, "pci_request_region FAILED\n");
|
|
|
- pci_disable_device(pdev);
|
|
|
- return rc;
|
|
|
- }
|
|
|
-
|
|
|
- if ((rc = jsm_found_board(pdev, ent->driver_data))) {
|
|
|
- dev_err(&pdev->dev, "jsm_found_board FAILED\n");
|
|
|
- pci_release_regions(pdev);
|
|
|
- pci_disable_device(pdev);
|
|
|
- return rc;
|
|
|
- }
|
|
|
+ out_kfree_brd:
|
|
|
+ kfree(brd);
|
|
|
+ out_release_regions:
|
|
|
+ pci_release_regions(pdev);
|
|
|
+ out_disable_device:
|
|
|
+ pci_disable_device(pdev);
|
|
|
+ out:
|
|
|
return rc;
|
|
|
}
|
|
|
|
|
|
-
|
|
|
-/*
|
|
|
- * jsm_cleanup_board()
|
|
|
- *
|
|
|
- * Free all the memory associated with a board
|
|
|
- */
|
|
|
-static void jsm_cleanup_board(struct jsm_board *brd)
|
|
|
+static void jsm_remove_one(struct pci_dev *pdev)
|
|
|
{
|
|
|
+ struct jsm_board *brd = pci_get_drvdata(pdev);
|
|
|
int i = 0;
|
|
|
|
|
|
+ jsm_remove_uart_port(brd);
|
|
|
+
|
|
|
free_irq(brd->irq, brd);
|
|
|
iounmap(brd->re_map_membase);
|
|
|
|
|
|
/* Free all allocated channels structs */
|
|
|
for (i = 0; i < brd->maxports; i++) {
|
|
|
if (brd->channels[i]) {
|
|
|
- if (brd->channels[i]->ch_rqueue)
|
|
|
- kfree(brd->channels[i]->ch_rqueue);
|
|
|
- if (brd->channels[i]->ch_equeue)
|
|
|
- kfree(brd->channels[i]->ch_equeue);
|
|
|
- if (brd->channels[i]->ch_wqueue)
|
|
|
- kfree(brd->channels[i]->ch_wqueue);
|
|
|
+ kfree(brd->channels[i]->ch_rqueue);
|
|
|
+ kfree(brd->channels[i]->ch_equeue);
|
|
|
+ kfree(brd->channels[i]->ch_wqueue);
|
|
|
kfree(brd->channels[i]);
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- pci_release_regions(brd->pci_dev);
|
|
|
- pci_disable_device(brd->pci_dev);
|
|
|
+ pci_release_regions(pdev);
|
|
|
+ pci_disable_device(pdev);
|
|
|
kfree(brd->flipbuf);
|
|
|
kfree(brd);
|
|
|
}
|
|
|
|
|
|
-static void jsm_remove_one(struct pci_dev *dev)
|
|
|
-{
|
|
|
- unsigned long lock_flags;
|
|
|
- struct list_head *tmp;
|
|
|
- struct jsm_board *brd;
|
|
|
-
|
|
|
- spin_lock_irqsave(&jsm_board_head_lock, lock_flags);
|
|
|
- list_for_each(tmp, &jsm_board_head) {
|
|
|
- brd = list_entry(tmp, struct jsm_board,
|
|
|
- jsm_board_entry);
|
|
|
- if ( brd != NULL && brd->pci_dev == dev) {
|
|
|
- jsm_remove_uart_port(brd);
|
|
|
- jsm_cleanup_board(brd);
|
|
|
- list_del(&brd->jsm_board_entry);
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- spin_unlock_irqrestore(&jsm_board_head_lock, lock_flags);
|
|
|
- return;
|
|
|
-}
|
|
|
+static struct pci_device_id jsm_pci_tbl[] = {
|
|
|
+ { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
|
|
|
+ { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
|
|
|
+ { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
|
|
|
+ { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
|
|
|
+ { 0, }
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
|
|
|
|
|
|
-struct pci_driver jsm_driver = {
|
|
|
+static struct pci_driver jsm_driver = {
|
|
|
.name = "jsm",
|
|
|
- .probe = jsm_init_one,
|
|
|
.id_table = jsm_pci_tbl,
|
|
|
+ .probe = jsm_probe_one,
|
|
|
.remove = __devexit_p(jsm_remove_one),
|
|
|
};
|
|
|
|
|
|
-/*
|
|
|
- * jsm_init_module()
|
|
|
- *
|
|
|
- * Module load. This is where it all starts.
|
|
|
- */
|
|
|
static int __init jsm_init_module(void)
|
|
|
{
|
|
|
- int rc = 0;
|
|
|
-
|
|
|
- printk(KERN_INFO "%s, Digi International Part Number %s\n",
|
|
|
- JSM_VERSION, JSM_VERSION);
|
|
|
-
|
|
|
- /*
|
|
|
- * Initialize global stuff
|
|
|
- */
|
|
|
+ int rc;
|
|
|
|
|
|
rc = uart_register_driver(&jsm_uart_driver);
|
|
|
- if (rc < 0) {
|
|
|
- return rc;
|
|
|
- }
|
|
|
-
|
|
|
- rc = pci_register_driver(&jsm_driver);
|
|
|
- if (rc < 0) {
|
|
|
- uart_unregister_driver(&jsm_uart_driver);
|
|
|
- return rc;
|
|
|
+ if (!rc) {
|
|
|
+ rc = pci_register_driver(&jsm_driver);
|
|
|
+ if (rc)
|
|
|
+ uart_unregister_driver(&jsm_uart_driver);
|
|
|
}
|
|
|
- jsm_driver_state = DRIVER_READY;
|
|
|
-
|
|
|
return rc;
|
|
|
}
|
|
|
|
|
|
-module_init(jsm_init_module);
|
|
|
-
|
|
|
-/*
|
|
|
- * jsm_exit_module()
|
|
|
- *
|
|
|
- * Module unload. This is where it all ends.
|
|
|
- */
|
|
|
static void __exit jsm_exit_module(void)
|
|
|
{
|
|
|
- jsm_remove_driver_sysfiles(&jsm_driver.driver);
|
|
|
-
|
|
|
pci_unregister_driver(&jsm_driver);
|
|
|
-
|
|
|
uart_unregister_driver(&jsm_uart_driver);
|
|
|
}
|
|
|
+
|
|
|
+module_init(jsm_init_module);
|
|
|
module_exit(jsm_exit_module);
|
|
|
-MODULE_LICENSE("GPL");
|