drivers/staging/comedi/drivers/addi_apci_1710.c

   1 #include <linux/pci.h>
   2
   3 #include <asm/i387.h>
   4
   5 #include "../comedidev.h"
   6 #include "comedi_fc.h"
   7 #include "amcc_s5933.h"
   8
   9 #include "addi-data/addi_common.h"
  10
  11 static void fpu_begin(void)
  12 {
  13         kernel_fpu_begin();
  14 }
  15
  16 static void fpu_end(void)
  17 {
  18         kernel_fpu_end();
  19 }
  20
  21 #include "addi-data/addi_eeprom.c"
  22 #include "addi-data/hwdrv_APCI1710.c"
  23
  24 static const struct addi_board apci1710_boardtypes[] = {
  25         {
  26                 .pc_DriverName          = "apci1710",
  27                 .i_VendorId             = PCI_VENDOR_ID_ADDIDATA_OLD,
  28                 .i_DeviceId             = APCI1710_BOARD_DEVICE_ID,
  29                 .interrupt              = v_APCI1710_Interrupt,
  30         },
  31 };
  32
  33 static irqreturn_t v_ADDI_Interrupt(int irq, void *d)
  34 {
  35         struct comedi_device *dev = d;
  36         const struct addi_board *this_board = comedi_board(dev);
  37
  38         this_board->interrupt(irq, d);
  39         return IRQ_RETVAL(1);
  40 }
  41
  42 static const void *apci1710_find_boardinfo(struct comedi_device *dev,
  43                                            struct pci_dev *pcidev)
  44 {
  45         const struct addi_board *this_board;
  46         int i;
  47
  48         for (i = 0; i < ARRAY_SIZE(apci1710_boardtypes); i++) {
  49                 this_board = &apci1710_boardtypes[i];
  50                 if (this_board->i_VendorId == pcidev->vendor &&
  51                     this_board->i_DeviceId == pcidev->device)
  52                         return this_board;
  53         }
  54         return NULL;
  55 }
  56
  57 static int apci1710_auto_attach(struct comedi_device *dev,
  58                                           unsigned long context_unused)
  59 {
  60         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
  61         const struct addi_board *this_board;
  62         struct addi_private *devpriv;
  63         struct comedi_subdevice *s;
  64         int ret;
  65
  66         this_board = apci1710_find_boardinfo(dev, pcidev);
  67         if (!this_board)
  68                 return -ENODEV;
  69         dev->board_ptr = this_board;
  70         dev->board_name = this_board->pc_DriverName;
  71
  72         devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
  73         if (!devpriv)
  74                 return -ENOMEM;
  75         dev->private = devpriv;
  76
  77         ret = comedi_pci_enable(pcidev, dev->board_name);
  78         if (ret)
  79                 return ret;
  80
  81         if (this_board->i_IorangeBase1)
  82                 dev->iobase = pci_resource_start(pcidev, 1);
  83         else
  84                 dev->iobase = pci_resource_start(pcidev, 0);
  85
  86         devpriv->iobase = dev->iobase;
  87         devpriv->i_IobaseAmcc = pci_resource_start(pcidev, 0);
  88         devpriv->i_IobaseAddon = pci_resource_start(pcidev, 2);
  89         devpriv->i_IobaseReserved = pci_resource_start(pcidev, 3);
  90
  91         if (pcidev->irq > 0) {
  92                 ret = request_irq(pcidev->irq, v_ADDI_Interrupt, IRQF_SHARED,
  93                                   dev->board_name, dev);
  94                 if (ret == 0)
  95                         dev->irq = pcidev->irq;
  96         }
  97
  98         i_ADDI_AttachPCI1710(dev);
  99
 100         devpriv->s_BoardInfos.ui_Address = pci_resource_start(pcidev, 2);
 101
 102         i_APCI1710_Reset(dev);
 103         return 0;
 104 }
 105
 106 static void apci1710_detach(struct comedi_device *dev)
 107 {
 108         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 109
 110         if (dev->iobase)
 111                 i_APCI1710_Reset(dev);
 112         if (dev->irq)
 113                 free_irq(dev->irq, dev);
 114         if (pcidev) {
 115                 if (dev->iobase)
 116                         comedi_pci_disable(pcidev);
 117         }
 118 }
 119
 120 static struct comedi_driver apci1710_driver = {
 121         .driver_name    = "addi_apci_1710",
 122         .module         = THIS_MODULE,
 123         .auto_attach    = apci1710_auto_attach,
 124         .detach         = apci1710_detach,
 125 };
 126
 127 static int apci1710_pci_probe(struct pci_dev *dev,
 128                                         const struct pci_device_id *ent)
 129 {
 130         return comedi_pci_auto_config(dev, &apci1710_driver);
 131 }
 132
 133 static DEFINE_PCI_DEVICE_TABLE(apci1710_pci_table) = {
 134         { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA_OLD, APCI1710_BOARD_DEVICE_ID) },
 135         { 0 }
 136 };
 137 MODULE_DEVICE_TABLE(pci, apci1710_pci_table);
 138
 139 static struct pci_driver apci1710_pci_driver = {
 140         .name           = "addi_apci_1710",
 141         .id_table       = apci1710_pci_table,
 142         .probe          = apci1710_pci_probe,
 143         .remove         = comedi_pci_auto_unconfig,
 144 };
 145 module_comedi_pci_driver(apci1710_driver, apci1710_pci_driver);
 146
 147 MODULE_AUTHOR("Comedi http://www.comedi.org");
 148 MODULE_DESCRIPTION("Comedi low-level driver");
 149 MODULE_LICENSE("GPL");