#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"
.major = 253,
.minor = JSM_MINOR_START,
.nr = NR_PORTS,
- .cons = NULL,
};
int jsm_debug;
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.
*/
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");
projects / GitHub / exynos8895 / android_kernel_samsung_universal8895.git / commitdiff