kernel/2.6.29.6-aldebaran-rt/drivers/serial/jsm/jsm_driver.c

   1 /************************************************************************
   2  * Copyright 2003 Digi International (www.digi.com)
   3  *
   4  * Copyright (C) 2004 IBM Corporation. All rights reserved.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2, or (at your option)
   9  * any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED; without even the
  13  * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
  14  * PURPOSE.  See the GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 59 * Temple Place - Suite 330, Boston,
  19  * MA  02111-1307, USA.
  20  *
  21  * Contact Information:
  22  * Scott H Kilau <Scott_Kilau@digi.com>
  23  * Wendy Xiong   <wendyx@us.ibm.com>
  24  *
  25  *
  26  ***********************************************************************/
  27 #include <linux/moduleparam.h>
  28 #include <linux/pci.h>
  29
  30 #include "jsm.h"
  31
  32 MODULE_AUTHOR("Digi International, http://www.digi.com");
  33 MODULE_DESCRIPTION("Driver for the Digi International "
  34                    "Neo PCI based product line");
  35 MODULE_LICENSE("GPL");
  36 MODULE_SUPPORTED_DEVICE("jsm");
  37
  38 #define JSM_DRIVER_NAME "jsm"
  39 #define NR_PORTS        32
  40 #define JSM_MINOR_START 0
  41
  42 struct uart_driver jsm_uart_driver = {
  43         .owner          = THIS_MODULE,
  44         .driver_name    = JSM_DRIVER_NAME,
  45         .dev_name       = "ttyn",
  46         .major          = 0,
  47         .minor          = JSM_MINOR_START,
  48         .nr             = NR_PORTS,
  49 };
  50
  51 int jsm_debug;
  52 module_param(jsm_debug, int, 0);
  53 MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
  54
  55 static int jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
  56 {
  57         int rc = 0;
  58         struct jsm_board *brd;
  59         static int adapter_count = 0;
  60         int retval;
  61
  62         rc = pci_enable_device(pdev);
  63         if (rc) {
  64                 dev_err(&pdev->dev, "Device enable FAILED\n");
  65                 goto out;
  66         }
  67
  68         rc = pci_request_regions(pdev, "jsm");
  69         if (rc) {
  70                 dev_err(&pdev->dev, "pci_request_region FAILED\n");
  71                 goto out_disable_device;
  72         }
  73
  74         brd = kzalloc(sizeof(struct jsm_board), GFP_KERNEL);
  75         if (!brd) {
  76                 dev_err(&pdev->dev,
  77                         "memory allocation for board structure failed\n");
  78                 rc = -ENOMEM;
  79                 goto out_release_regions;
  80         }
  81
  82         /* store the info for the board we've found */
  83         brd->boardnum = adapter_count++;
  84         brd->pci_dev = pdev;
  85         if (pdev->device == PCIE_DEVICE_ID_NEO_4_IBM)
  86                 brd->maxports = 4;
  87         else if (pdev->device == PCI_DEVICE_ID_DIGI_NEO_8)
  88                 brd->maxports = 8;
  89         else
  90                 brd->maxports = 2;
  91
  92         spin_lock_init(&brd->bd_lock);
  93         spin_lock_init(&brd->bd_intr_lock);
  94
  95         /* store which revision we have */
  96         brd->rev = pdev->revision;
  97
  98         brd->irq = pdev->irq;
  99
 100         jsm_printk(INIT, INFO, &brd->pci_dev,
 101                 "jsm_found_board - NEO adapter\n");
 102
 103         /* get the PCI Base Address Registers */
 104         brd->membase    = pci_resource_start(pdev, 0);
 105         brd->membase_end = pci_resource_end(pdev, 0);
 106
 107         if (brd->membase & 1)
 108                 brd->membase &= ~3;
 109         else
 110                 brd->membase &= ~15;
 111
 112         /* Assign the board_ops struct */
 113         brd->bd_ops = &jsm_neo_ops;
 114
 115         brd->bd_uart_offset = 0x200;
 116         brd->bd_dividend = 921600;
 117
 118         brd->re_map_membase = ioremap(brd->membase, 0x1000);
 119         if (!brd->re_map_membase) {
 120                 dev_err(&pdev->dev,
 121                         "card has no PCI Memory resources, "
 122                         "failing board.\n");
 123                 rc = -ENOMEM;
 124                 goto out_kfree_brd;
 125         }
 126
 127         rc = request_irq(brd->irq, brd->bd_ops->intr,
 128                         IRQF_DISABLED|IRQF_SHARED, "JSM", brd);
 129         if (rc) {
 130                 printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
 131                 goto out_iounmap;
 132         }
 133
 134         rc = jsm_tty_init(brd);
 135         if (rc < 0) {
 136                 dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
 137                 retval = -ENXIO;
 138                 goto out_free_irq;
 139         }
 140
 141         rc = jsm_uart_port_init(brd);
 142         if (rc < 0) {
 143                 /* XXX: leaking all resources from jsm_tty_init here! */
 144                 dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
 145                 retval = -ENXIO;
 146                 goto out_free_irq;
 147         }
 148
 149         /* Log the information about the board */
 150         dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
 151                         adapter_count, brd->rev, brd->irq);
 152
 153         /*
 154          * allocate flip buffer for board.
 155          *
 156          * Okay to malloc with GFP_KERNEL, we are not at interrupt
 157          * context, and there are no locks held.
 158          */
 159         brd->flipbuf = kzalloc(MYFLIPLEN, GFP_KERNEL);
 160         if (!brd->flipbuf) {
 161                 /* XXX: leaking all resources from jsm_tty_init and
 162                         jsm_uart_port_init here! */
 163                 dev_err(&pdev->dev, "memory allocation for flipbuf failed\n");
 164                 retval = -ENOMEM;
 165                 goto out_free_irq;
 166         }
 167
 168         pci_set_drvdata(pdev, brd);
 169
 170         return 0;
 171  out_free_irq:
 172         free_irq(brd->irq, brd);
 173  out_iounmap:
 174         iounmap(brd->re_map_membase);
 175  out_kfree_brd:
 176         kfree(brd);
 177  out_release_regions:
 178         pci_release_regions(pdev);
 179  out_disable_device:
 180         pci_disable_device(pdev);
 181  out:
 182         return rc;
 183 }
 184
 185 static void __devexit jsm_remove_one(struct pci_dev *pdev)
 186 {
 187         struct jsm_board *brd = pci_get_drvdata(pdev);
 188         int i = 0;
 189
 190         jsm_remove_uart_port(brd);
 191
 192         free_irq(brd->irq, brd);
 193         iounmap(brd->re_map_membase);
 194
 195         /* Free all allocated channels structs */
 196         for (i = 0; i < brd->maxports; i++) {
 197                 if (brd->channels[i]) {
 198                         kfree(brd->channels[i]->ch_rqueue);
 199                         kfree(brd->channels[i]->ch_equeue);
 200                         kfree(brd->channels[i]->ch_wqueue);
 201                         kfree(brd->channels[i]);
 202                 }
 203         }
 204
 205         pci_release_regions(pdev);
 206         pci_disable_device(pdev);
 207         kfree(brd->flipbuf);
 208         kfree(brd);
 209 }
 210
 211 static struct pci_device_id jsm_pci_tbl[] = {
 212         { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
 213         { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
 214         { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
 215         { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
 216         { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
 217         { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
 218         { 0, }
 219 };
 220 MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
 221
 222 static struct pci_driver jsm_driver = {
 223         .name           = "jsm",
 224         .id_table       = jsm_pci_tbl,
 225         .probe          = jsm_probe_one,
 226         .remove         = __devexit_p(jsm_remove_one),
 227 };
 228
 229 static int __init jsm_init_module(void)
 230 {
 231         int rc;
 232
 233         rc = uart_register_driver(&jsm_uart_driver);
 234         if (!rc) {
 235                 rc = pci_register_driver(&jsm_driver);
 236                 if (rc)
 237                         uart_unregister_driver(&jsm_uart_driver);
 238         }
 239         return rc;
 240 }
 241
 242 static void __exit jsm_exit_module(void)
 243 {
 244         pci_unregister_driver(&jsm_driver);
 245         uart_unregister_driver(&jsm_uart_driver);
 246 }
 247
 248 module_init(jsm_init_module);
 249 module_exit(jsm_exit_module);