linux/drivers/tty/serial/jsm/jsm_driver.c
<<
>>
Prefs
   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#include <linux/slab.h>
  30
  31#include "jsm.h"
  32
  33MODULE_AUTHOR("Digi International, http://www.digi.com");
  34MODULE_DESCRIPTION("Driver for the Digi International "
  35                   "Neo PCI based product line");
  36MODULE_LICENSE("GPL");
  37MODULE_SUPPORTED_DEVICE("jsm");
  38
  39#define JSM_DRIVER_NAME "jsm"
  40#define NR_PORTS        32
  41#define JSM_MINOR_START 0
  42
  43struct uart_driver jsm_uart_driver = {
  44        .owner          = THIS_MODULE,
  45        .driver_name    = JSM_DRIVER_NAME,
  46        .dev_name       = "ttyn",
  47        .major          = 0,
  48        .minor          = JSM_MINOR_START,
  49        .nr             = NR_PORTS,
  50};
  51
  52static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
  53                                       pci_channel_state_t state);
  54static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev);
  55static void jsm_io_resume(struct pci_dev *pdev);
  56
  57static struct pci_error_handlers jsm_err_handler = {
  58        .error_detected = jsm_io_error_detected,
  59        .slot_reset = jsm_io_slot_reset,
  60        .resume = jsm_io_resume,
  61};
  62
  63int jsm_debug;
  64module_param(jsm_debug, int, 0);
  65MODULE_PARM_DESC(jsm_debug, "Driver debugging level");
  66
  67static int __devinit jsm_probe_one(struct pci_dev *pdev, const struct pci_device_id *ent)
  68{
  69        int rc = 0;
  70        struct jsm_board *brd;
  71        static int adapter_count = 0;
  72
  73        rc = pci_enable_device(pdev);
  74        if (rc) {
  75                dev_err(&pdev->dev, "Device enable FAILED\n");
  76                goto out;
  77        }
  78
  79        rc = pci_request_regions(pdev, "jsm");
  80        if (rc) {
  81                dev_err(&pdev->dev, "pci_request_region FAILED\n");
  82                goto out_disable_device;
  83        }
  84
  85        brd = kzalloc(sizeof(struct jsm_board), GFP_KERNEL);
  86        if (!brd) {
  87                dev_err(&pdev->dev,
  88                        "memory allocation for board structure failed\n");
  89                rc = -ENOMEM;
  90                goto out_release_regions;
  91        }
  92
  93        /* store the info for the board we've found */
  94        brd->boardnum = adapter_count++;
  95        brd->pci_dev = pdev;
  96        if (pdev->device == PCIE_DEVICE_ID_NEO_4_IBM)
  97                brd->maxports = 4;
  98        else if (pdev->device == PCI_DEVICE_ID_DIGI_NEO_8)
  99                brd->maxports = 8;
 100        else
 101                brd->maxports = 2;
 102
 103        spin_lock_init(&brd->bd_intr_lock);
 104
 105        /* store which revision we have */
 106        brd->rev = pdev->revision;
 107
 108        brd->irq = pdev->irq;
 109
 110        jsm_printk(INIT, INFO, &brd->pci_dev,
 111                "jsm_found_board - NEO adapter\n");
 112
 113        /* get the PCI Base Address Registers */
 114        brd->membase    = pci_resource_start(pdev, 0);
 115        brd->membase_end = pci_resource_end(pdev, 0);
 116
 117        if (brd->membase & 1)
 118                brd->membase &= ~3;
 119        else
 120                brd->membase &= ~15;
 121
 122        /* Assign the board_ops struct */
 123        brd->bd_ops = &jsm_neo_ops;
 124
 125        brd->bd_uart_offset = 0x200;
 126        brd->bd_dividend = 921600;
 127
 128        brd->re_map_membase = ioremap(brd->membase, 0x1000);
 129        if (!brd->re_map_membase) {
 130                dev_err(&pdev->dev,
 131                        "card has no PCI Memory resources, "
 132                        "failing board.\n");
 133                rc = -ENOMEM;
 134                goto out_kfree_brd;
 135        }
 136
 137        rc = request_irq(brd->irq, brd->bd_ops->intr,
 138                        IRQF_SHARED, "JSM", brd);
 139        if (rc) {
 140                printk(KERN_WARNING "Failed to hook IRQ %d\n",brd->irq);
 141                goto out_iounmap;
 142        }
 143
 144        rc = jsm_tty_init(brd);
 145        if (rc < 0) {
 146                dev_err(&pdev->dev, "Can't init tty devices (%d)\n", rc);
 147                rc = -ENXIO;
 148                goto out_free_irq;
 149        }
 150
 151        rc = jsm_uart_port_init(brd);
 152        if (rc < 0) {
 153                /* XXX: leaking all resources from jsm_tty_init here! */
 154                dev_err(&pdev->dev, "Can't init uart port (%d)\n", rc);
 155                rc = -ENXIO;
 156                goto out_free_irq;
 157        }
 158
 159        /* Log the information about the board */
 160        dev_info(&pdev->dev, "board %d: Digi Neo (rev %d), irq %d\n",
 161                        adapter_count, brd->rev, brd->irq);
 162
 163        /*
 164         * allocate flip buffer for board.
 165         *
 166         * Okay to malloc with GFP_KERNEL, we are not at interrupt
 167         * context, and there are no locks held.
 168         */
 169        brd->flipbuf = kzalloc(MYFLIPLEN, GFP_KERNEL);
 170        if (!brd->flipbuf) {
 171                /* XXX: leaking all resources from jsm_tty_init and
 172                        jsm_uart_port_init here! */
 173                dev_err(&pdev->dev, "memory allocation for flipbuf failed\n");
 174                rc = -ENOMEM;
 175                goto out_free_uart;
 176        }
 177
 178        pci_set_drvdata(pdev, brd);
 179        pci_save_state(pdev);
 180
 181        return 0;
 182 out_free_uart:
 183        jsm_remove_uart_port(brd);
 184 out_free_irq:
 185        jsm_remove_uart_port(brd);
 186        free_irq(brd->irq, brd);
 187 out_iounmap:
 188        iounmap(brd->re_map_membase);
 189 out_kfree_brd:
 190        kfree(brd);
 191 out_release_regions:
 192        pci_release_regions(pdev);
 193 out_disable_device:
 194        pci_disable_device(pdev);
 195 out:
 196        return rc;
 197}
 198
 199static void __devexit jsm_remove_one(struct pci_dev *pdev)
 200{
 201        struct jsm_board *brd = pci_get_drvdata(pdev);
 202        int i = 0;
 203
 204        jsm_remove_uart_port(brd);
 205
 206        free_irq(brd->irq, brd);
 207        iounmap(brd->re_map_membase);
 208
 209        /* Free all allocated channels structs */
 210        for (i = 0; i < brd->maxports; i++) {
 211                if (brd->channels[i]) {
 212                        kfree(brd->channels[i]->ch_rqueue);
 213                        kfree(brd->channels[i]->ch_equeue);
 214                        kfree(brd->channels[i]->ch_wqueue);
 215                        kfree(brd->channels[i]);
 216                }
 217        }
 218
 219        pci_release_regions(pdev);
 220        pci_disable_device(pdev);
 221        kfree(brd->flipbuf);
 222        kfree(brd);
 223}
 224
 225static struct pci_device_id jsm_pci_tbl[] = {
 226        { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9), 0, 0, 0 },
 227        { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2DB9PRI), 0, 0, 1 },
 228        { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45), 0, 0, 2 },
 229        { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_NEO_2RJ45PRI), 0, 0, 3 },
 230        { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCIE_DEVICE_ID_NEO_4_IBM), 0, 0, 4 },
 231        { PCI_DEVICE(PCI_VENDOR_ID_DIGI, PCI_DEVICE_ID_DIGI_NEO_8), 0, 0, 5 },
 232        { 0, }
 233};
 234MODULE_DEVICE_TABLE(pci, jsm_pci_tbl);
 235
 236static struct pci_driver jsm_driver = {
 237        .name           = "jsm",
 238        .id_table       = jsm_pci_tbl,
 239        .probe          = jsm_probe_one,
 240        .remove         = __devexit_p(jsm_remove_one),
 241        .err_handler    = &jsm_err_handler,
 242};
 243
 244static pci_ers_result_t jsm_io_error_detected(struct pci_dev *pdev,
 245                                        pci_channel_state_t state)
 246{
 247        struct jsm_board *brd = pci_get_drvdata(pdev);
 248
 249        jsm_remove_uart_port(brd);
 250
 251        return PCI_ERS_RESULT_NEED_RESET;
 252}
 253
 254static pci_ers_result_t jsm_io_slot_reset(struct pci_dev *pdev)
 255{
 256        int rc;
 257
 258        rc = pci_enable_device(pdev);
 259
 260        if (rc)
 261                return PCI_ERS_RESULT_DISCONNECT;
 262
 263        pci_set_master(pdev);
 264
 265        return PCI_ERS_RESULT_RECOVERED;
 266}
 267
 268static void jsm_io_resume(struct pci_dev *pdev)
 269{
 270        struct jsm_board *brd = pci_get_drvdata(pdev);
 271
 272        pci_restore_state(pdev);
 273
 274        jsm_uart_port_init(brd);
 275}
 276
 277static int __init jsm_init_module(void)
 278{
 279        int rc;
 280
 281        rc = uart_register_driver(&jsm_uart_driver);
 282        if (!rc) {
 283                rc = pci_register_driver(&jsm_driver);
 284                if (rc)
 285                        uart_unregister_driver(&jsm_uart_driver);
 286        }
 287        return rc;
 288}
 289
 290static void __exit jsm_exit_module(void)
 291{
 292        pci_unregister_driver(&jsm_driver);
 293        uart_unregister_driver(&jsm_uart_driver);
 294}
 295
 296module_init(jsm_init_module);
 297module_exit(jsm_exit_module);
 298