drivers/staging/comedi/drivers/addi_apci_1710.c

   1 #include <asm/i387.h>
   2
   3 #include "../comedidev.h"
   4 #include "comedi_fc.h"
   5 #include "amcc_s5933.h"
   6
   7 #include "addi-data/addi_common.h"
   8
   9 static void fpu_begin(void)
  10 {
  11         kernel_fpu_begin();
  12 }
  13
  14 static void fpu_end(void)
  15 {
  16         kernel_fpu_end();
  17 }
  18
  19 #include "addi-data/addi_eeprom.c"
  20 #include "addi-data/hwdrv_APCI1710.c"
  21
  22 #ifndef COMEDI_SUBD_TTLIO
  23 #define COMEDI_SUBD_TTLIO   11  /* Digital Input Output But TTL */
  24 #endif
  25
  26 static const struct addi_board apci1710_boardtypes[] = {
  27         {
  28                 .pc_DriverName          = "apci1710",
  29                 .i_VendorId             = PCI_VENDOR_ID_ADDIDATA_OLD,
  30                 .i_DeviceId             = APCI1710_BOARD_DEVICE_ID,
  31                 .i_IorangeBase0         = 128,
  32                 .i_IorangeBase1         = 8,
  33                 .i_IorangeBase2         = 256,
  34                 .interrupt              = v_APCI1710_Interrupt,
  35         },
  36 };
  37
  38 static irqreturn_t v_ADDI_Interrupt(int irq, void *d)
  39 {
  40         struct comedi_device *dev = d;
  41         const struct addi_board *this_board = comedi_board(dev);
  42
  43         this_board->interrupt(irq, d);
  44         return IRQ_RETVAL(1);
  45 }
  46
  47 static const void *apci1710_find_boardinfo(struct comedi_device *dev,
  48                                            struct pci_dev *pcidev)
  49 {
  50         const struct addi_board *this_board;
  51         int i;
  52
  53         for (i = 0; i < ARRAY_SIZE(apci1710_boardtypes); i++) {
  54                 this_board = &apci1710_boardtypes[i];
  55                 if (this_board->i_VendorId == pcidev->vendor &&
  56                     this_board->i_DeviceId == pcidev->device)
  57                         return this_board;
  58         }
  59         return NULL;
  60 }
  61
  62 static int apci1710_attach_pci(struct comedi_device *dev,
  63                                struct pci_dev *pcidev)
  64 {
  65         const struct addi_board *this_board;
  66         struct addi_private *devpriv;
  67         struct comedi_subdevice *s;
  68         int ret;
  69
  70         this_board = apci1710_find_boardinfo(dev, pcidev);
  71         if (!this_board)
  72                 return -ENODEV;
  73         dev->board_ptr = this_board;
  74         dev->board_name = this_board->pc_DriverName;
  75
  76         devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
  77         if (!devpriv)
  78                 return -ENOMEM;
  79         dev->private = devpriv;
  80
  81         ret = comedi_pci_enable(pcidev, dev->board_name);
  82         if (ret)
  83                 return ret;
  84
  85         if (this_board->i_IorangeBase1)
  86                 dev->iobase = pci_resource_start(pcidev, 1);
  87         else
  88                 dev->iobase = pci_resource_start(pcidev, 0);
  89
  90         devpriv->iobase = dev->iobase;
  91         devpriv->i_IobaseAmcc = pci_resource_start(pcidev, 0);
  92         devpriv->i_IobaseAddon = pci_resource_start(pcidev, 2);
  93         devpriv->i_IobaseReserved = pci_resource_start(pcidev, 3);
  94
  95         /* Initialize parameters that can be overridden in EEPROM */
  96         devpriv->s_EeParameters.i_NbrAiChannel = this_board->i_NbrAiChannel;
  97         devpriv->s_EeParameters.i_NbrAoChannel = this_board->i_NbrAoChannel;
  98         devpriv->s_EeParameters.i_AiMaxdata = this_board->i_AiMaxdata;
  99         devpriv->s_EeParameters.i_AoMaxdata = this_board->i_AoMaxdata;
 100         devpriv->s_EeParameters.i_NbrDiChannel = this_board->i_NbrDiChannel;
 101         devpriv->s_EeParameters.i_NbrDoChannel = this_board->i_NbrDoChannel;
 102         devpriv->s_EeParameters.i_DoMaxdata = this_board->i_DoMaxdata;
 103         devpriv->s_EeParameters.i_Dma = this_board->i_Dma;
 104         devpriv->s_EeParameters.i_Timer = this_board->i_Timer;
 105         devpriv->s_EeParameters.ui_MinAcquisitiontimeNs =
 106                 this_board->ui_MinAcquisitiontimeNs;
 107         devpriv->s_EeParameters.ui_MinDelaytimeNs =
 108                 this_board->ui_MinDelaytimeNs;
 109
 110         /* ## */
 111
 112         if (pcidev->irq > 0) {
 113                 ret = request_irq(pcidev->irq, v_ADDI_Interrupt, IRQF_SHARED,
 114                                   dev->board_name, dev);
 115                 if (ret == 0)
 116                         dev->irq = pcidev->irq;
 117         }
 118
 119         i_ADDI_AttachPCI1710(dev);
 120
 121         devpriv->s_BoardInfos.ui_Address = pci_resource_start(pcidev, 2);
 122
 123         i_APCI1710_Reset(dev);
 124         return 0;
 125 }
 126
 127 static void apci1710_detach(struct comedi_device *dev)
 128 {
 129         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 130
 131         if (dev->iobase)
 132                 i_APCI1710_Reset(dev);
 133         if (dev->irq)
 134                 free_irq(dev->irq, dev);
 135         if (pcidev) {
 136                 if (dev->iobase)
 137                         comedi_pci_disable(pcidev);
 138         }
 139 }
 140
 141 static struct comedi_driver apci1710_driver = {
 142         .driver_name    = "addi_apci_1710",
 143         .module         = THIS_MODULE,
 144         .attach_pci     = apci1710_attach_pci,
 145         .detach         = apci1710_detach,
 146 };
 147
 148 static int __devinit apci1710_pci_probe(struct pci_dev *dev,
 149                                         const struct pci_device_id *ent)
 150 {
 151         return comedi_pci_auto_config(dev, &apci1710_driver);
 152 }
 153
 154 static void __devexit apci1710_pci_remove(struct pci_dev *dev)
 155 {
 156         comedi_pci_auto_unconfig(dev);
 157 }
 158
 159 static DEFINE_PCI_DEVICE_TABLE(apci1710_pci_table) = {
 160         { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA_OLD, APCI1710_BOARD_DEVICE_ID) },
 161         { 0 }
 162 };
 163 MODULE_DEVICE_TABLE(pci, apci1710_pci_table);
 164
 165 static struct pci_driver apci1710_pci_driver = {
 166         .name           = "addi_apci_1710",
 167         .id_table       = apci1710_pci_table,
 168         .probe          = apci1710_pci_probe,
 169         .remove         = __devexit_p(apci1710_pci_remove),
 170 };
 171 module_comedi_pci_driver(apci1710_driver, apci1710_pci_driver);