1/*
2 * Support for the VMIVME-7805 board access to the Universe II bridge.
3 *
4 * Author: Arthur Benilov <arthur.benilov@iba-group.com>
5 * Copyright 2010 Ion Beam Application, Inc.
6 *
7 * This program is free software; you can redistribute  it and/or modify it
8 * under  the terms of  the GNU General  Public License as published by the
9 * Free Software Foundation;  either version 2 of the  License, or (at your
10 * option) any later version.
11 */
12
13#include <linux/module.h>
14#include <linux/types.h>
15#include <linux/errno.h>
16#include <linux/pci.h>
17#include <linux/poll.h>
18#include <linux/io.h>
19
20#include "vme_vmivme7805.h"
21
22static int vmic_probe(struct pci_dev *, const struct pci_device_id *);
23static void vmic_remove(struct pci_dev *);
24
25/** Base address to access FPGA register */
26static void __iomem *vmic_base;
27
28static const char driver_name[] = "vmivme_7805";
29
30static const struct pci_device_id vmic_ids[] = {
31	{ PCI_DEVICE(PCI_VENDOR_ID_VMIC, PCI_DEVICE_ID_VTIMR) },
32	{ },
33};
34
35static struct pci_driver vmic_driver = {
36	.name = driver_name,
37	.id_table = vmic_ids,
38	.probe = vmic_probe,
39	.remove = vmic_remove,
40};
41
42static int vmic_probe(struct pci_dev *pdev, const struct pci_device_id *id)
43{
44	int retval;
45	u32 data;
46
47	/* Enable the device */
48	retval = pci_enable_device(pdev);
49	if (retval) {
50		dev_err(&pdev->dev, "Unable to enable device\n");
51		goto err;
52	}
53
54	/* Map Registers */
55	retval = pci_request_regions(pdev, driver_name);
56	if (retval) {
57		dev_err(&pdev->dev, "Unable to reserve resources\n");
58		goto err_resource;
59	}
60
61	/* Map registers in BAR 0 */
62	vmic_base = ioremap_nocache(pci_resource_start(pdev, 0), 16);
63	if (!vmic_base) {
64		dev_err(&pdev->dev, "Unable to remap CRG region\n");
65		retval = -EIO;
66		goto err_remap;
67	}
68
69	/* Clear the FPGA VME IF contents */
70	iowrite32(0, vmic_base + VME_CONTROL);
71
72	/* Clear any initial BERR  */
73	data = ioread32(vmic_base + VME_CONTROL) & 0x00000FFF;
74	data |= BM_VME_CONTROL_BERRST;
75	iowrite32(data, vmic_base + VME_CONTROL);
76
77	/* Enable the vme interface and byte swapping */
78	data = ioread32(vmic_base + VME_CONTROL) & 0x00000FFF;
79	data = data | BM_VME_CONTROL_MASTER_ENDIAN |
80			BM_VME_CONTROL_SLAVE_ENDIAN |
81			BM_VME_CONTROL_ABLE |
82			BM_VME_CONTROL_BERRI |
83			BM_VME_CONTROL_BPENA |
84			BM_VME_CONTROL_VBENA;
85	iowrite32(data, vmic_base + VME_CONTROL);
86
87	return 0;
88
89err_remap:
90	pci_release_regions(pdev);
91err_resource:
92	pci_disable_device(pdev);
93err:
94	return retval;
95}
96
97static void vmic_remove(struct pci_dev *pdev)
98{
99	iounmap(vmic_base);
100	pci_release_regions(pdev);
101	pci_disable_device(pdev);
102
103}
104
105module_pci_driver(vmic_driver);
106
107MODULE_DESCRIPTION("VMIVME-7805 board support driver");
108MODULE_AUTHOR("Arthur Benilov <arthur.benilov@iba-group.com>");
109MODULE_LICENSE("GPL");
110
111