release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/staging/vme/boards/vme_vmivme7805.c

   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
  22 static int __init vmic_init(void);
  23 static int vmic_probe(struct pci_dev *, const struct pci_device_id *);
  24 static void vmic_remove(struct pci_dev *);
  25 static void __exit vmic_exit(void);
  26
  27 /** Base address to access FPGA register */
  28 static void *vmic_base;
  29
  30 static char driver_name[] = "vmivme_7805";
  31
  32 static struct pci_device_id vmic_ids[] = {
  33         { PCI_DEVICE(PCI_VENDOR_ID_VMIC, PCI_DEVICE_ID_VTIMR) },
  34         { },
  35 };
  36
  37 static struct pci_driver vmic_driver = {
  38         .name = driver_name,
  39         .id_table = vmic_ids,
  40         .probe = vmic_probe,
  41         .remove = vmic_remove,
  42 };
  43
  44 static int __init vmic_init(void)
  45 {
  46         return pci_register_driver(&vmic_driver);
  47 }
  48
  49 static int vmic_probe(struct pci_dev *pdev, const struct pci_device_id *id)
  50 {
  51         int retval;
  52         u32 data;
  53
  54         /* Enable the device */
  55         retval = pci_enable_device(pdev);
  56         if (retval) {
  57                 dev_err(&pdev->dev, "Unable to enable device\n");
  58                 goto err;
  59         }
  60
  61         /* Map Registers */
  62         retval = pci_request_regions(pdev, driver_name);
  63         if (retval) {
  64                 dev_err(&pdev->dev, "Unable to reserve resources\n");
  65                 goto err_resource;
  66         }
  67
  68         /* Map registers in BAR 0 */
  69         vmic_base = ioremap_nocache(pci_resource_start(pdev, 0), 16);
  70         if (!vmic_base) {
  71                 dev_err(&pdev->dev, "Unable to remap CRG region\n");
  72                 retval = -EIO;
  73                 goto err_remap;
  74         }
  75
  76         /* Clear the FPGA VME IF contents */
  77         iowrite32(0, vmic_base + VME_CONTROL);
  78
  79         /* Clear any initial BERR  */
  80         data = ioread32(vmic_base + VME_CONTROL) & 0x00000FFF;
  81         data |= BM_VME_CONTROL_BERRST;
  82         iowrite32(data, vmic_base + VME_CONTROL);
  83
  84         /* Enable the vme interface and byte swapping */
  85         data = ioread32(vmic_base + VME_CONTROL) & 0x00000FFF;
  86         data = data | BM_VME_CONTROL_MASTER_ENDIAN |
  87                         BM_VME_CONTROL_SLAVE_ENDIAN |
  88                         BM_VME_CONTROL_ABLE |
  89                         BM_VME_CONTROL_BERRI |
  90                         BM_VME_CONTROL_BPENA |
  91                         BM_VME_CONTROL_VBENA;
  92         iowrite32(data, vmic_base + VME_CONTROL);
  93
  94         return 0;
  95
  96 err_remap:
  97         pci_release_regions(pdev);
  98 err_resource:
  99         pci_disable_device(pdev);
 100 err:
 101         return retval;
 102 }
 103
 104 static void vmic_remove(struct pci_dev *pdev)
 105 {
 106         iounmap(vmic_base);
 107         pci_release_regions(pdev);
 108         pci_disable_device(pdev);
 109
 110 }
 111
 112 static void __exit vmic_exit(void)
 113 {
 114         pci_unregister_driver(&vmic_driver);
 115 }
 116
 117 MODULE_DESCRIPTION("VMIVME-7805 board support driver");
 118 MODULE_AUTHOR("Arthur Benilov <arthur.benilov@iba-group.com>");
 119 MODULE_LICENSE("GPL");
 120
 121 module_init(vmic_init);
 122 module_exit(vmic_exit);