drivers/uio/uio_netx.c

   1 /*
   2  * UIO driver for Hilscher NetX based fieldbus cards (cifX, comX).
   3  * See http://www.hilscher.com for details.
   4  *
   5  * (C) 2007 Hans J. Koch <hjk@linutronix.de>
   6  * (C) 2008 Manuel Traut <manut@linutronix.de>
   7  *
   8  * Licensed under GPL version 2 only.
   9  *
  10  */
  11
  12 #include <linux/device.h>
  13 #include <linux/io.h>
  14 #include <linux/module.h>
  15 #include <linux/pci.h>
  16 #include <linux/uio_driver.h>
  17
  18 #define PCI_VENDOR_ID_HILSCHER          0x15CF
  19 #define PCI_DEVICE_ID_HILSCHER_NETX     0x0000
  20 #define PCI_SUBDEVICE_ID_NXSB_PCA       0x3235
  21 #define PCI_SUBDEVICE_ID_NXPCA          0x3335
  22
  23 #define DPM_HOST_INT_EN0        0xfff0
  24 #define DPM_HOST_INT_STAT0      0xffe0
  25
  26 #define DPM_HOST_INT_MASK       0xe600ffff
  27 #define DPM_HOST_INT_GLOBAL_EN  0x80000000
  28
  29 static irqreturn_t netx_handler(int irq, struct uio_info *dev_info)
  30 {
  31         void __iomem *int_enable_reg = dev_info->mem[0].internal_addr
  32                                         + DPM_HOST_INT_EN0;
  33         void __iomem *int_status_reg = dev_info->mem[0].internal_addr
  34                                         + DPM_HOST_INT_STAT0;
  35
  36         /* Is one of our interrupts enabled and active ? */
  37         if (!(ioread32(int_enable_reg) & ioread32(int_status_reg)
  38                 & DPM_HOST_INT_MASK))
  39                 return IRQ_NONE;
  40
  41         /* Disable interrupt */
  42         iowrite32(ioread32(int_enable_reg) & ~DPM_HOST_INT_GLOBAL_EN,
  43                 int_enable_reg);
  44         return IRQ_HANDLED;
  45 }
  46
  47 static int __devinit netx_pci_probe(struct pci_dev *dev,
  48                                         const struct pci_device_id *id)
  49 {
  50         struct uio_info *info;
  51         int bar;
  52
  53         info = kzalloc(sizeof(struct uio_info), GFP_KERNEL);
  54         if (!info)
  55                 return -ENOMEM;
  56
  57         if (pci_enable_device(dev))
  58                 goto out_free;
  59
  60         if (pci_request_regions(dev, "netx"))
  61                 goto out_disable;
  62
  63         switch (id->device) {
  64         case PCI_DEVICE_ID_HILSCHER_NETX:
  65                 bar = 0;
  66                 info->name = "netx";
  67                 break;
  68         default:
  69                 bar = 2;
  70                 info->name = "netx_plx";
  71         }
  72
  73         /* BAR0 or 2 points to the card's dual port memory */
  74         info->mem[0].addr = pci_resource_start(dev, bar);
  75         if (!info->mem[0].addr)
  76                 goto out_release;
  77         info->mem[0].internal_addr = ioremap(pci_resource_start(dev, bar),
  78                                                 pci_resource_len(dev, bar));
  79
  80         if (!info->mem[0].internal_addr)
  81                         goto out_release;
  82
  83         info->mem[0].size = pci_resource_len(dev, bar);
  84         info->mem[0].memtype = UIO_MEM_PHYS;
  85         info->irq = dev->irq;
  86         info->irq_flags = IRQF_SHARED;
  87         info->handler = netx_handler;
  88         info->version = "0.0.1";
  89
  90         /* Make sure all interrupts are disabled */
  91         iowrite32(0, info->mem[0].internal_addr + DPM_HOST_INT_EN0);
  92
  93         if (uio_register_device(&dev->dev, info))
  94                 goto out_unmap;
  95
  96         pci_set_drvdata(dev, info);
  97         dev_info(&dev->dev, "Found %s card, registered UIO device.\n",
  98                                 info->name);
  99
 100         return 0;
 101
 102 out_unmap:
 103         iounmap(info->mem[0].internal_addr);
 104 out_release:
 105         pci_release_regions(dev);
 106 out_disable:
 107         pci_disable_device(dev);
 108 out_free:
 109         kfree(info);
 110         return -ENODEV;
 111 }
 112
 113 static void netx_pci_remove(struct pci_dev *dev)
 114 {
 115         struct uio_info *info = pci_get_drvdata(dev);
 116
 117         /* Disable all interrupts */
 118         iowrite32(0, info->mem[0].internal_addr + DPM_HOST_INT_EN0);
 119         uio_unregister_device(info);
 120         pci_release_regions(dev);
 121         pci_disable_device(dev);
 122         pci_set_drvdata(dev, NULL);
 123         iounmap(info->mem[0].internal_addr);
 124
 125         kfree(info);
 126 }
 127
 128 static struct pci_device_id netx_pci_ids[] = {
 129         {
 130                 .vendor =       PCI_VENDOR_ID_HILSCHER,
 131                 .device =       PCI_DEVICE_ID_HILSCHER_NETX,
 132                 .subvendor =    0,
 133                 .subdevice =    0,
 134         },
 135         {
 136                 .vendor =       PCI_VENDOR_ID_PLX,
 137                 .device =       PCI_DEVICE_ID_PLX_9030,
 138                 .subvendor =    PCI_VENDOR_ID_PLX,
 139                 .subdevice =    PCI_SUBDEVICE_ID_NXSB_PCA,
 140         },
 141         {
 142                 .vendor =       PCI_VENDOR_ID_PLX,
 143                 .device =       PCI_DEVICE_ID_PLX_9030,
 144                 .subvendor =    PCI_VENDOR_ID_PLX,
 145                 .subdevice =    PCI_SUBDEVICE_ID_NXPCA,
 146         },
 147         { 0, }
 148 };
 149
 150 static struct pci_driver netx_pci_driver = {
 151         .name = "netx",
 152         .id_table = netx_pci_ids,
 153         .probe = netx_pci_probe,
 154         .remove = netx_pci_remove,
 155 };
 156
 157 static int __init netx_init_module(void)
 158 {
 159         return pci_register_driver(&netx_pci_driver);
 160 }
 161
 162 static void __exit netx_exit_module(void)
 163 {
 164         pci_unregister_driver(&netx_pci_driver);
 165 }
 166
 167 module_init(netx_init_module);
 168 module_exit(netx_exit_module);
 169
 170 MODULE_DEVICE_TABLE(pci, netx_pci_ids);
 171 MODULE_LICENSE("GPL v2");
 172 MODULE_AUTHOR("Hans J. Koch, Manuel Traut");