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 irqreturn_t v_ADDI_Interrupt(int irq, void *d)
  25 {
  26         v_APCI1710_Interrupt(irq, d);
  27         return IRQ_RETVAL(1);
  28 }
  29
  30 static int apci1710_auto_attach(struct comedi_device *dev,
  31                                           unsigned long context_unused)
  32 {
  33         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
  34         struct addi_private *devpriv;
  35         struct comedi_subdevice *s;
  36         int ret;
  37
  38         dev->board_name = dev->driver->driver_name;
  39
  40         devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
  41         if (!devpriv)
  42                 return -ENOMEM;
  43         dev->private = devpriv;
  44
  45         ret = comedi_pci_enable(dev);
  46         if (ret)
  47                 return ret;
  48         devpriv->s_BoardInfos.ui_Address = pci_resource_start(pcidev, 2);
  49
  50         if (pcidev->irq > 0) {
  51                 ret = request_irq(pcidev->irq, v_ADDI_Interrupt, IRQF_SHARED,
  52                                   dev->board_name, dev);
  53                 if (ret == 0)
  54                         dev->irq = pcidev->irq;
  55         }
  56
  57         i_ADDI_AttachPCI1710(dev);
  58
  59         i_APCI1710_Reset(dev);
  60         return 0;
  61 }
  62
  63 static void apci1710_detach(struct comedi_device *dev)
  64 {
  65         if (dev->iobase)
  66                 i_APCI1710_Reset(dev);
  67         if (dev->irq)
  68                 free_irq(dev->irq, dev);
  69         comedi_pci_disable(dev);
  70 }
  71
  72 static struct comedi_driver apci1710_driver = {
  73         .driver_name    = "addi_apci_1710",
  74         .module         = THIS_MODULE,
  75         .auto_attach    = apci1710_auto_attach,
  76         .detach         = apci1710_detach,
  77 };
  78
  79 static int apci1710_pci_probe(struct pci_dev *dev,
  80                               const struct pci_device_id *id)
  81 {
  82         return comedi_pci_auto_config(dev, &apci1710_driver, id->driver_data);
  83 }
  84
  85 static DEFINE_PCI_DEVICE_TABLE(apci1710_pci_table) = {
  86         { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA_OLD, APCI1710_BOARD_DEVICE_ID) },
  87         { 0 }
  88 };
  89 MODULE_DEVICE_TABLE(pci, apci1710_pci_table);
  90
  91 static struct pci_driver apci1710_pci_driver = {
  92         .name           = "addi_apci_1710",
  93         .id_table       = apci1710_pci_table,
  94         .probe          = apci1710_pci_probe,
  95         .remove         = comedi_pci_auto_unconfig,
  96 };
  97 module_comedi_pci_driver(apci1710_driver, apci1710_pci_driver);
  98
  99 MODULE_AUTHOR("Comedi http://www.comedi.org");
 100 MODULE_DESCRIPTION("Comedi low-level driver");
 101 MODULE_LICENSE("GPL");