[mirror_ubuntu-zesty-kernel.git] / drivers / uio / uio_cif.c

/*
 * UIO Hilscher CIF card driver
 *
 * (C) 2007 Hans J. Koch <hjk@linutronix.de>
 * Original code (C) 2005 Benedikt Spranger <b.spranger@linutronix.de>
 *
 * Licensed under GPL version 2 only.
 *
 */

#include <linux/device.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/uio_driver.h>

#include <asm/io.h>

#ifndef PCI_DEVICE_ID_PLX_9030
#define PCI_DEVICE_ID_PLX_9030	0x9030
#endif

#define PLX9030_INTCSR		0x4C
#define INTSCR_INT1_ENABLE	0x01
#define INTSCR_INT1_STATUS	0x04
#define INT1_ENABLED_AND_ACTIVE	(INTSCR_INT1_ENABLE | INTSCR_INT1_STATUS)

#define PCI_SUBVENDOR_ID_PEP	0x1518
#define CIF_SUBDEVICE_PROFIBUS	0x430
#define CIF_SUBDEVICE_DEVICENET	0x432


static irqreturn_t hilscher_handler(int irq, struct uio_info *dev_info)
{
	void __iomem *plx_intscr = dev_info->mem[0].internal_addr
					+ PLX9030_INTCSR;

	if ((ioread8(plx_intscr) & INT1_ENABLED_AND_ACTIVE)
	    != INT1_ENABLED_AND_ACTIVE)
		return IRQ_NONE;

	/* Disable interrupt */
	iowrite8(ioread8(plx_intscr) & ~INTSCR_INT1_ENABLE, plx_intscr);
	return IRQ_HANDLED;
}

static int __devinit hilscher_pci_probe(struct pci_dev *dev,
					const struct pci_device_id *id)
{
	struct uio_info *info;

	info = kzalloc(sizeof(struct uio_info), GFP_KERNEL);
	if (!info)
		return -ENOMEM;

	if (pci_enable_device(dev))
		goto out_free;

	if (pci_request_regions(dev, "hilscher"))
		goto out_disable;

	info->mem[0].addr = pci_resource_start(dev, 0);
	if (!info->mem[0].addr)
		goto out_release;
	info->mem[0].internal_addr = ioremap(pci_resource_start(dev, 0),
					     pci_resource_len(dev, 0));
	if (!info->mem[0].internal_addr)
		goto out_release;

	info->mem[0].size = pci_resource_len(dev, 0);
	info->mem[0].memtype = UIO_MEM_PHYS;
	info->mem[1].addr = pci_resource_start(dev, 2);
	info->mem[1].size = pci_resource_len(dev, 2);
	info->mem[1].memtype = UIO_MEM_PHYS;
	switch (id->subdevice) {
		case CIF_SUBDEVICE_PROFIBUS:
			info->name = "CIF_Profibus";
			break;
		case CIF_SUBDEVICE_DEVICENET:
			info->name = "CIF_Devicenet";
			break;
		default:
			info->name = "CIF_???";
	}
	info->version = "0.0.1";
	info->irq = dev->irq;
	info->irq_flags = IRQF_DISABLED | IRQF_SHARED;
	info->handler = hilscher_handler;

	if (uio_register_device(&dev->dev, info))
		goto out_unmap;

	pci_set_drvdata(dev, info);

	return 0;
out_unmap:
	iounmap(info->mem[0].internal_addr);
out_release:
	pci_release_regions(dev);
out_disable:
	pci_disable_device(dev);
out_free:
	kfree (info);
	return -ENODEV;
}

static void hilscher_pci_remove(struct pci_dev *dev)
{
	struct uio_info *info = pci_get_drvdata(dev);

	uio_unregister_device(info);
	pci_release_regions(dev);
	pci_disable_device(dev);
	pci_set_drvdata(dev, NULL);
	iounmap(info->mem[0].internal_addr);

	kfree (info);
}

static struct pci_device_id hilscher_pci_ids[] = {
	{
		.vendor =	PCI_VENDOR_ID_PLX,
		.device =	PCI_DEVICE_ID_PLX_9030,
		.subvendor =	PCI_SUBVENDOR_ID_PEP,
		.subdevice =	CIF_SUBDEVICE_PROFIBUS,
	},
	{
		.vendor =	PCI_VENDOR_ID_PLX,
		.device =	PCI_DEVICE_ID_PLX_9030,
		.subvendor =	PCI_SUBVENDOR_ID_PEP,
		.subdevice =	CIF_SUBDEVICE_DEVICENET,
	},
	{ 0, }
};

static struct pci_driver hilscher_pci_driver = {
	.name = "hilscher",
	.id_table = hilscher_pci_ids,
	.probe = hilscher_pci_probe,
	.remove = hilscher_pci_remove,
};

static int __init hilscher_init_module(void)
{
	return pci_register_driver(&hilscher_pci_driver);
}

static void __exit hilscher_exit_module(void)
{
	pci_unregister_driver(&hilscher_pci_driver);
}

module_init(hilscher_init_module);
module_exit(hilscher_exit_module);

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