cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

uio_cif.c (3256B)

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