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