uio_cif.c 3.2 KB

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