Pileus Git - ~andy/linux/blob - drivers/staging/comedi/drivers/addi_apci_3120.c

   1 #include <linux/pci.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 #include "addi-data/hwdrv_apci3120.c"
  10
  11 static const struct addi_board apci3120_boardtypes[] = {
  12         {
  13                 .pc_DriverName          = "apci3120",
  14                 .i_VendorId             = PCI_VENDOR_ID_ADDIDATA_OLD,
  15                 .i_DeviceId             = 0x818D,
  16                 .i_NbrAiChannel         = 16,
  17                 .i_NbrAiChannelDiff     = 8,
  18                 .i_AiChannelList        = 16,
  19                 .i_NbrAoChannel         = 8,
  20                 .i_AiMaxdata            = 0xffff,
  21                 .i_AoMaxdata            = 0x3fff,
  22                 .i_NbrDiChannel         = 4,
  23                 .i_NbrDoChannel         = 4,
  24                 .i_DoMaxdata            = 0x0f,
  25                 .interrupt              = v_APCI3120_Interrupt,
  26         }, {
  27                 .pc_DriverName          = "apci3001",
  28                 .i_VendorId             = PCI_VENDOR_ID_ADDIDATA_OLD,
  29                 .i_DeviceId             = 0x828D,
  30                 .i_NbrAiChannel         = 16,
  31                 .i_NbrAiChannelDiff     = 8,
  32                 .i_AiChannelList        = 16,
  33                 .i_AiMaxdata            = 0xfff,
  34                 .i_NbrDiChannel         = 4,
  35                 .i_NbrDoChannel         = 4,
  36                 .i_DoMaxdata            = 0x0f,
  37                 .interrupt              = v_APCI3120_Interrupt,
  38         },
  39 };
  40
  41 static irqreturn_t v_ADDI_Interrupt(int irq, void *d)
  42 {
  43         struct comedi_device *dev = d;
  44         const struct addi_board *this_board = comedi_board(dev);
  45
  46         this_board->interrupt(irq, d);
  47         return IRQ_RETVAL(1);
  48 }
  49
  50 static const void *apci3120_find_boardinfo(struct comedi_device *dev,
  51                                            struct pci_dev *pcidev)
  52 {
  53         const struct addi_board *this_board;
  54         int i;
  55
  56         for (i = 0; i < ARRAY_SIZE(apci3120_boardtypes); i++) {
  57                 this_board = &apci3120_boardtypes[i];
  58                 if (this_board->i_VendorId == pcidev->vendor &&
  59                     this_board->i_DeviceId == pcidev->device)
  60                         return this_board;
  61         }
  62         return NULL;
  63 }
  64
  65 static int apci3120_auto_attach(struct comedi_device *dev,
  66                                           unsigned long context_unused)
  67 {
  68         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
  69         const struct addi_board *this_board;
  70         struct addi_private *devpriv;
  71         struct comedi_subdevice *s;
  72         int ret, pages, i;
  73
  74         this_board = apci3120_find_boardinfo(dev, pcidev);
  75         if (!this_board)
  76                 return -ENODEV;
  77         dev->board_ptr = this_board;
  78         dev->board_name = this_board->pc_DriverName;
  79
  80         devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
  81         if (!devpriv)
  82                 return -ENOMEM;
  83         dev->private = devpriv;
  84
  85         ret = comedi_pci_enable(pcidev, dev->board_name);
  86         if (ret)
  87                 return ret;
  88         pci_set_master(pcidev);
  89
  90         dev->iobase = pci_resource_start(pcidev, 1);
  91         devpriv->iobase = dev->iobase;
  92         devpriv->i_IobaseAmcc = pci_resource_start(pcidev, 0);
  93         devpriv->i_IobaseAddon = pci_resource_start(pcidev, 2);
  94         devpriv->i_IobaseReserved = pci_resource_start(pcidev, 3);
  95
  96         if (pcidev->irq > 0) {
  97                 ret = request_irq(pcidev->irq, v_ADDI_Interrupt, IRQF_SHARED,
  98                                   dev->board_name, dev);
  99                 if (ret == 0)
 100                         dev->irq = pcidev->irq;
 101         }
 102
 103         devpriv->us_UseDma = ADDI_ENABLE;
 104
 105         /* Allocate DMA buffers */
 106         devpriv->b_DmaDoubleBuffer = 0;
 107         for (i = 0; i < 2; i++) {
 108                 for (pages = 4; pages >= 0; pages--) {
 109                         devpriv->ul_DmaBufferVirtual[i] =
 110                                 (void *) __get_free_pages(GFP_KERNEL, pages);
 111
 112                         if (devpriv->ul_DmaBufferVirtual[i])
 113                                 break;
 114                 }
 115                 if (devpriv->ul_DmaBufferVirtual[i]) {
 116                         devpriv->ui_DmaBufferPages[i] = pages;
 117                         devpriv->ui_DmaBufferSize[i] = PAGE_SIZE * pages;
 118                         devpriv->ui_DmaBufferSamples[i] =
 119                                 devpriv->ui_DmaBufferSize[i] >> 1;
 120                         devpriv->ul_DmaBufferHw[i] =
 121                                 virt_to_bus((void *)devpriv->
 122                                 ul_DmaBufferVirtual[i]);
 123                 }
 124         }
 125         if (!devpriv->ul_DmaBufferVirtual[0])
 126                 devpriv->us_UseDma = ADDI_DISABLE;
 127
 128         if (devpriv->ul_DmaBufferVirtual[1])
 129                 devpriv->b_DmaDoubleBuffer = 1;
 130
 131         ret = comedi_alloc_subdevices(dev, 5);
 132         if (ret)
 133                 return ret;
 134
 135         /*  Allocate and Initialise AI Subdevice Structures */
 136         s = &dev->subdevices[0];
 137         dev->read_subdev = s;
 138         s->type = COMEDI_SUBD_AI;
 139         s->subdev_flags =
 140                 SDF_READABLE | SDF_COMMON | SDF_GROUND
 141                 | SDF_DIFF;
 142         if (this_board->i_NbrAiChannel) {
 143                 s->n_chan = this_board->i_NbrAiChannel;
 144                 devpriv->b_SingelDiff = 0;
 145         } else {
 146                 s->n_chan = this_board->i_NbrAiChannelDiff;
 147                 devpriv->b_SingelDiff = 1;
 148         }
 149         s->maxdata = this_board->i_AiMaxdata;
 150         s->len_chanlist = this_board->i_AiChannelList;
 151         s->range_table = &range_apci3120_ai;
 152
 153         /* Set the initialisation flag */
 154         devpriv->b_AiInitialisation = 1;
 155
 156         s->insn_config = i_APCI3120_InsnConfigAnalogInput;
 157         s->insn_read = i_APCI3120_InsnReadAnalogInput;
 158         s->do_cmdtest = i_APCI3120_CommandTestAnalogInput;
 159         s->do_cmd = i_APCI3120_CommandAnalogInput;
 160         s->cancel = i_APCI3120_StopCyclicAcquisition;
 161
 162         /*  Allocate and Initialise AO Subdevice Structures */
 163         s = &dev->subdevices[1];
 164         if (this_board->i_NbrAoChannel) {
 165                 s->type = COMEDI_SUBD_AO;
 166                 s->subdev_flags = SDF_WRITEABLE | SDF_GROUND | SDF_COMMON;
 167                 s->n_chan = this_board->i_NbrAoChannel;
 168                 s->maxdata = this_board->i_AoMaxdata;
 169                 s->len_chanlist = this_board->i_NbrAoChannel;
 170                 s->range_table = &range_apci3120_ao;
 171                 s->insn_write = i_APCI3120_InsnWriteAnalogOutput;
 172         } else {
 173                 s->type = COMEDI_SUBD_UNUSED;
 174         }
 175
 176         /*  Allocate and Initialise DI Subdevice Structures */
 177         s = &dev->subdevices[2];
 178         s->type = COMEDI_SUBD_DI;
 179         s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_COMMON;
 180         s->n_chan = this_board->i_NbrDiChannel;
 181         s->maxdata = 1;
 182         s->len_chanlist = this_board->i_NbrDiChannel;
 183         s->range_table = &range_digital;
 184         s->io_bits = 0; /* all bits input */
 185         s->insn_bits = apci3120_di_insn_bits;
 186
 187         /*  Allocate and Initialise DO Subdevice Structures */
 188         s = &dev->subdevices[3];
 189         s->type = COMEDI_SUBD_DO;
 190         s->subdev_flags =
 191                 SDF_READABLE | SDF_WRITEABLE | SDF_GROUND | SDF_COMMON;
 192         s->n_chan = this_board->i_NbrDoChannel;
 193         s->maxdata = this_board->i_DoMaxdata;
 194         s->len_chanlist = this_board->i_NbrDoChannel;
 195         s->range_table = &range_digital;
 196         s->io_bits = 0xf;       /* all bits output */
 197         s->insn_bits = apci3120_do_insn_bits;
 198
 199         /*  Allocate and Initialise Timer Subdevice Structures */
 200         s = &dev->subdevices[4];
 201         s->type = COMEDI_SUBD_TIMER;
 202         s->subdev_flags = SDF_WRITEABLE | SDF_GROUND | SDF_COMMON;
 203         s->n_chan = 1;
 204         s->maxdata = 0;
 205         s->len_chanlist = 1;
 206         s->range_table = &range_digital;
 207
 208         s->insn_write = i_APCI3120_InsnWriteTimer;
 209         s->insn_read = i_APCI3120_InsnReadTimer;
 210         s->insn_config = i_APCI3120_InsnConfigTimer;
 211
 212         i_APCI3120_Reset(dev);
 213         return 0;
 214 }
 215
 216 static void apci3120_detach(struct comedi_device *dev)
 217 {
 218         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 219         struct addi_private *devpriv = dev->private;
 220
 221         if (devpriv) {
 222                 if (dev->iobase)
 223                         i_APCI3120_Reset(dev);
 224                 if (dev->irq)
 225                         free_irq(dev->irq, dev);
 226                 if (devpriv->ul_DmaBufferVirtual[0]) {
 227                         free_pages((unsigned long)devpriv->
 228                                 ul_DmaBufferVirtual[0],
 229                                 devpriv->ui_DmaBufferPages[0]);
 230                 }
 231                 if (devpriv->ul_DmaBufferVirtual[1]) {
 232                         free_pages((unsigned long)devpriv->
 233                                 ul_DmaBufferVirtual[1],
 234                                 devpriv->ui_DmaBufferPages[1]);
 235                 }
 236         }
 237         if (pcidev) {
 238                 if (dev->iobase)
 239                         comedi_pci_disable(pcidev);
 240         }
 241 }
 242
 243 static struct comedi_driver apci3120_driver = {
 244         .driver_name    = "addi_apci_3120",
 245         .module         = THIS_MODULE,
 246         .auto_attach    = apci3120_auto_attach,
 247         .detach         = apci3120_detach,
 248 };
 249
 250 static int apci3120_pci_probe(struct pci_dev *dev,
 251                                         const struct pci_device_id *ent)
 252 {
 253         return comedi_pci_auto_config(dev, &apci3120_driver);
 254 }
 255
 256 static DEFINE_PCI_DEVICE_TABLE(apci3120_pci_table) = {
 257         { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA_OLD, 0x818d) },
 258         { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA_OLD, 0x828d) },
 259         { 0 }
 260 };
 261 MODULE_DEVICE_TABLE(pci, apci3120_pci_table);
 262
 263 static struct pci_driver apci3120_pci_driver = {
 264         .name           = "addi_apci_3120",
 265         .id_table       = apci3120_pci_table,
 266         .probe          = apci3120_pci_probe,
 267         .remove         = comedi_pci_auto_unconfig,
 268 };
 269 module_comedi_pci_driver(apci3120_driver, apci3120_pci_driver);
 270
 271 MODULE_AUTHOR("Comedi http://www.comedi.org");
 272 MODULE_DESCRIPTION("Comedi low-level driver");
 273 MODULE_LICENSE("GPL");