drivers/uio/uio_cif.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /*
0003  * UIO Hilscher CIF card driver
0004  *
0005  * (C) 2007 Hans J. Koch <hjk@hansjkoch.de>
0006  * Original code (C) 2005 Benedikt Spranger <b.spranger@linutronix.de>
0007  */
0008
0009 #include <linux/device.h>
0010 #include <linux/module.h>
0011 #include <linux/pci.h>
0012 #include <linux/slab.h>
0013 #include <linux/uio_driver.h>
0014
0015 #include <asm/io.h>
0016
0017 #define PLX9030_INTCSR      0x4C
0018 #define INTSCR_INT1_ENABLE  0x01
0019 #define INTSCR_INT1_STATUS  0x04
0020 #define INT1_ENABLED_AND_ACTIVE (INTSCR_INT1_ENABLE | INTSCR_INT1_STATUS)
0021
0022 #define PCI_SUBVENDOR_ID_PEP    0x1518
0023 #define CIF_SUBDEVICE_PROFIBUS  0x430
0024 #define CIF_SUBDEVICE_DEVICENET 0x432
0025
0026
0027 static irqreturn_t hilscher_handler(int irq, struct uio_info *dev_info)
0028 {
0029     void __iomem *plx_intscr = dev_info->mem[0].internal_addr
0030                     + PLX9030_INTCSR;
0031
0032     if ((ioread8(plx_intscr) & INT1_ENABLED_AND_ACTIVE)
0033         != INT1_ENABLED_AND_ACTIVE)
0034         return IRQ_NONE;
0035
0036     /* Disable interrupt */
0037     iowrite8(ioread8(plx_intscr) & ~INTSCR_INT1_ENABLE, plx_intscr);
0038     return IRQ_HANDLED;
0039 }
0040
0041 static int hilscher_pci_probe(struct pci_dev *dev,
0042                     const struct pci_device_id *id)
0043 {
0044     struct uio_info *info;
0045
0046     info = devm_kzalloc(&dev->dev, sizeof(struct uio_info), GFP_KERNEL);
0047     if (!info)
0048         return -ENOMEM;
0049
0050     if (pci_enable_device(dev))
0051         return -ENODEV;
0052
0053     if (pci_request_regions(dev, "hilscher"))
0054         goto out_disable;
0055
0056     info->mem[0].addr = pci_resource_start(dev, 0);
0057     if (!info->mem[0].addr)
0058         goto out_release;
0059     info->mem[0].internal_addr = pci_ioremap_bar(dev, 0);
0060     if (!info->mem[0].internal_addr)
0061         goto out_release;
0062
0063     info->mem[0].size = pci_resource_len(dev, 0);
0064     info->mem[0].memtype = UIO_MEM_PHYS;
0065     info->mem[1].addr = pci_resource_start(dev, 2);
0066     info->mem[1].size = pci_resource_len(dev, 2);
0067     info->mem[1].memtype = UIO_MEM_PHYS;
0068     switch (id->subdevice) {
0069         case CIF_SUBDEVICE_PROFIBUS:
0070             info->name = "CIF_Profibus";
0071             break;
0072         case CIF_SUBDEVICE_DEVICENET:
0073             info->name = "CIF_Devicenet";
0074             break;
0075         default:
0076             info->name = "CIF_???";
0077     }
0078     info->version = "0.0.1";
0079     info->irq = dev->irq;
0080     info->irq_flags = IRQF_SHARED;
0081     info->handler = hilscher_handler;
0082
0083     if (uio_register_device(&dev->dev, info))
0084         goto out_unmap;
0085
0086     pci_set_drvdata(dev, info);
0087
0088     return 0;
0089 out_unmap:
0090     iounmap(info->mem[0].internal_addr);
0091 out_release:
0092     pci_release_regions(dev);
0093 out_disable:
0094     pci_disable_device(dev);
0095     return -ENODEV;
0096 }
0097
0098 static void hilscher_pci_remove(struct pci_dev *dev)
0099 {
0100     struct uio_info *info = pci_get_drvdata(dev);
0101
0102     uio_unregister_device(info);
0103     pci_release_regions(dev);
0104     pci_disable_device(dev);
0105     iounmap(info->mem[0].internal_addr);
0106 }
0107
0108 static struct pci_device_id hilscher_pci_ids[] = {
0109     {
0110         .vendor =   PCI_VENDOR_ID_PLX,
0111         .device =   PCI_DEVICE_ID_PLX_9030,
0112         .subvendor =    PCI_SUBVENDOR_ID_PEP,
0113         .subdevice =    CIF_SUBDEVICE_PROFIBUS,
0114     },
0115     {
0116         .vendor =   PCI_VENDOR_ID_PLX,
0117         .device =   PCI_DEVICE_ID_PLX_9030,
0118         .subvendor =    PCI_SUBVENDOR_ID_PEP,
0119         .subdevice =    CIF_SUBDEVICE_DEVICENET,
0120     },
0121     { 0, }
0122 };
0123
0124 static struct pci_driver hilscher_pci_driver = {
0125     .name = "hilscher",
0126     .id_table = hilscher_pci_ids,
0127     .probe = hilscher_pci_probe,
0128     .remove = hilscher_pci_remove,
0129 };
0130
0131 module_pci_driver(hilscher_pci_driver);
0132 MODULE_DEVICE_TABLE(pci, hilscher_pci_ids);
0133 MODULE_LICENSE("GPL v2");
0134 MODULE_AUTHOR("Hans J. Koch, Benedikt Spranger");