drivers/staging/comedi/drivers/addi_apci_3120.c

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