LXR linux/drivers/uio/uio

   1/*
   2 * UIO Hilscher CIF card driver
   3 *
   4 * (C) 2007 Hans J. Koch <hjk@hansjkoch.de>
   5 * Original code (C) 2005 Benedikt Spranger <b.spranger@linutronix.de>
   6 *
   7 * Licensed under GPL version 2 only.
   8 *
   9 */
  10
  11#include <linux/device.h>
  12#include <linux/module.h>
  13#include <linux/pci.h>
  14#include <linux/slab.h>
  15#include <linux/uio_driver.h>
  16
  17#include <asm/io.h>
  18
  19#define PLX9030_INTCSR          0x4C
  20#define INTSCR_INT1_ENABLE      0x01
  21#define INTSCR_INT1_STATUS      0x04
  22#define INT1_ENABLED_AND_ACTIVE (INTSCR_INT1_ENABLE | INTSCR_INT1_STATUS)
  23
  24#define PCI_SUBVENDOR_ID_PEP    0x1518
  25#define CIF_SUBDEVICE_PROFIBUS  0x430
  26#define CIF_SUBDEVICE_DEVICENET 0x432
  27
  28
  29static irqreturn_t hilscher_handler(int irq, struct uio_info *dev_info)
  30{
  31        void __iomem *plx_intscr = dev_info->mem[0].internal_addr
  32                                        + PLX9030_INTCSR;
  33
  34        if ((ioread8(plx_intscr) & INT1_ENABLED_AND_ACTIVE)
  35            != INT1_ENABLED_AND_ACTIVE)
  36                return IRQ_NONE;
  37
  38        /* Disable interrupt */
  39        iowrite8(ioread8(plx_intscr) & ~INTSCR_INT1_ENABLE, plx_intscr);
  40        return IRQ_HANDLED;
  41}
  42
  43static int hilscher_pci_probe(struct pci_dev *dev,
  44                                        const struct pci_device_id *id)
  45{
  46        struct uio_info *info;
  47
  48        info = kzalloc(sizeof(struct uio_info), GFP_KERNEL);
  49        if (!info)
  50                return -ENOMEM;
  51
  52        if (pci_enable_device(dev))
  53                goto out_free;
  54
  55        if (pci_request_regions(dev, "hilscher"))
  56                goto out_disable;
  57
  58        info->mem[0].addr = pci_resource_start(dev, 0);
  59        if (!info->mem[0].addr)
  60                goto out_release;
  61        info->mem[0].internal_addr = pci_ioremap_bar(dev, 0);
  62        if (!info->mem[0].internal_addr)
  63                goto out_release;
  64
  65        info->mem[0].size = pci_resource_len(dev, 0);
  66        info->mem[0].memtype = UIO_MEM_PHYS;
  67        info->mem[1].addr = pci_resource_start(dev, 2);
  68        info->mem[1].size = pci_resource_len(dev, 2);
  69        info->mem[1].memtype = UIO_MEM_PHYS;
  70        switch (id->subdevice) {
  71                case CIF_SUBDEVICE_PROFIBUS:
  72                        info->name = "CIF_Profibus";
  73                        break;
  74                case CIF_SUBDEVICE_DEVICENET:
  75                        info->name = "CIF_Devicenet";
  76                        break;
  77                default:
  78                        info->name = "CIF_???";
  79        }
  80        info->version = "0.0.1";
  81        info->irq = dev->irq;
  82        info->irq_flags = IRQF_SHARED;
  83        info->handler = hilscher_handler;
  84
  85        if (uio_register_device(&dev->dev, info))
  86                goto out_unmap;
  87
  88        pci_set_drvdata(dev, info);
  89
  90        return 0;
  91out_unmap:
  92        iounmap(info->mem[0].internal_addr);
  93out_release:
  94        pci_release_regions(dev);
  95out_disable:
  96        pci_disable_device(dev);
  97out_free:
  98        kfree (info);
  99        return -ENODEV;
 100}
 101
 102static void hilscher_pci_remove(struct pci_dev *dev)
 103{
 104        struct uio_info *info = pci_get_drvdata(dev);
 105
 106        uio_unregister_device(info);
 107        pci_release_regions(dev);
 108        pci_disable_device(dev);
 109        iounmap(info->mem[0].internal_addr);
 110
 111        kfree (info);
 112}
 113
 114static struct pci_device_id hilscher_pci_ids[] = {
 115        {
 116                .vendor =       PCI_VENDOR_ID_PLX,
 117                .device =       PCI_DEVICE_ID_PLX_9030,
 118                .subvendor =    PCI_SUBVENDOR_ID_PEP,
 119                .subdevice =    CIF_SUBDEVICE_PROFIBUS,
 120        },
 121        {
 122                .vendor =       PCI_VENDOR_ID_PLX,
 123                .device =       PCI_DEVICE_ID_PLX_9030,
 124                .subvendor =    PCI_SUBVENDOR_ID_PEP,
 125                .subdevice =    CIF_SUBDEVICE_DEVICENET,
 126        },
 127        { 0, }
 128};
 129
 130static struct pci_driver hilscher_pci_driver = {
 131        .name = "hilscher",
 132        .id_table = hilscher_pci_ids,
 133        .probe = hilscher_pci_probe,
 134        .remove = hilscher_pci_remove,
 135};
 136
 137module_pci_driver(hilscher_pci_driver);
 138MODULE_DEVICE_TABLE(pci, hilscher_pci_ids);
 139MODULE_LICENSE("GPL v2");
 140MODULE_AUTHOR("Hans J. Koch, Benedikt Spranger");
 141