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