drivers/staging/comedi/drivers/adl_pci6208.c

   1 /*
   2     comedi/drivers/adl_pci6208.c
   3
   4     Hardware driver for ADLink 6208 series cards:
   5         card         | voltage output    | current output
   6         -------------+-------------------+---------------
   7         PCI-6208V    |  8 channels       | -
   8         PCI-6216V    | 16 channels       | -
   9         PCI-6208A    |  8 channels       | 8 channels
  10
  11     COMEDI - Linux Control and Measurement Device Interface
  12     Copyright (C) 2000 David A. Schleef <ds@schleef.org>
  13
  14     This program is free software; you can redistribute it and/or modify
  15     it under the terms of the GNU General Public License as published by
  16     the Free Software Foundation; either version 2 of the License, or
  17     (at your option) any later version.
  18
  19     This program is distributed in the hope that it will be useful,
  20     but WITHOUT ANY WARRANTY; without even the implied warranty of
  21     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22     GNU General Public License for more details.
  23
  24     You should have received a copy of the GNU General Public License
  25     along with this program; if not, write to the Free Software
  26     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  27 */
  28 /*
  29 Driver: adl_pci6208
  30 Description: ADLink PCI-6208/6216 Series Multi-channel Analog Output Cards
  31 Devices: (ADLink) PCI-6208 [adl_pci6208]
  32          (ADLink) PCI-6216 [adl_pci6216]
  33 Author: nsyeow <nsyeow@pd.jaring.my>
  34 Updated: Fri, 30 Jan 2004 14:44:27 +0800
  35 Status: untested
  36
  37 Configuration Options: not applicable, uses PCI auto config
  38
  39 References:
  40         - ni_660x.c
  41         - adl_pci9111.c         copied the entire pci setup section
  42         - adl_pci9118.c
  43 */
  44
  45 #include "../comedidev.h"
  46
  47 /*
  48  * ADLINK PCI Device ID's supported by this driver
  49  */
  50 #define PCI_DEVICE_ID_PCI6208           0x6208
  51 #define PCI_DEVICE_ID_PCI6216           0x6216
  52
  53 /*
  54  * PCI-6208/6216-GL register map
  55  */
  56 #define PCI6208_AO_CONTROL(x)           (0x00 + (2 * (x)))
  57 #define PCI6208_AO_STATUS               0x00
  58 #define PCI6208_AO_STATUS_DATA_SEND     (1 << 0)
  59 #define PCI6208_DIO                     0x40
  60 #define PCI6208_DIO_DO_MASK             (0x0f)
  61 #define PCI6208_DIO_DO_SHIFT            (0)
  62 #define PCI6208_DIO_DI_MASK             (0xf0)
  63 #define PCI6208_DIO_DI_SHIFT            (4)
  64
  65 #define PCI6208_MAX_AO_CHANNELS         16
  66
  67 struct pci6208_board {
  68         const char *name;
  69         unsigned short dev_id;
  70         int ao_chans;
  71 };
  72
  73 static const struct pci6208_board pci6208_boards[] = {
  74         {
  75                 .name           = "adl_pci6208",
  76                 .dev_id         = PCI_DEVICE_ID_PCI6208,
  77                 .ao_chans       = 8,
  78         }, {
  79                 .name           = "adl_pci6216",
  80                 .dev_id         = PCI_DEVICE_ID_PCI6216,
  81                 .ao_chans       = 16,
  82         },
  83 };
  84
  85 struct pci6208_private {
  86         unsigned int ao_readback[PCI6208_MAX_AO_CHANNELS];
  87 };
  88
  89 static int pci6208_ao_winsn(struct comedi_device *dev,
  90                             struct comedi_subdevice *s,
  91                             struct comedi_insn *insn, unsigned int *data)
  92 {
  93         struct pci6208_private *devpriv = dev->private;
  94         int chan = CR_CHAN(insn->chanspec);
  95         unsigned long invert = 1 << (16 - 1);
  96         unsigned long value = 0;
  97         unsigned short status;
  98         int i;
  99
 100         for (i = 0; i < insn->n; i++) {
 101                 value = data[i] ^ invert;
 102
 103                 do {
 104                         status = inw(dev->iobase + PCI6208_AO_STATUS);
 105                 } while (status & PCI6208_AO_STATUS_DATA_SEND);
 106
 107                 outw(value, dev->iobase + PCI6208_AO_CONTROL(chan));
 108         }
 109         devpriv->ao_readback[chan] = value;
 110
 111         return insn->n;
 112 }
 113
 114 static int pci6208_ao_rinsn(struct comedi_device *dev,
 115                             struct comedi_subdevice *s,
 116                             struct comedi_insn *insn, unsigned int *data)
 117 {
 118         struct pci6208_private *devpriv = dev->private;
 119         int chan = CR_CHAN(insn->chanspec);
 120         int i;
 121
 122         for (i = 0; i < insn->n; i++)
 123                 data[i] = devpriv->ao_readback[chan];
 124
 125         return insn->n;
 126 }
 127
 128 static int pci6208_di_insn_bits(struct comedi_device *dev,
 129                                 struct comedi_subdevice *s,
 130                                 struct comedi_insn *insn,
 131                                 unsigned int *data)
 132 {
 133         unsigned int val;
 134
 135         val = inw(dev->iobase + PCI6208_DIO);
 136         val = (val & PCI6208_DIO_DI_MASK) >> PCI6208_DIO_DI_SHIFT;
 137
 138         data[1] = val;
 139
 140         return insn->n;
 141 }
 142
 143 static int pci6208_do_insn_bits(struct comedi_device *dev,
 144                                 struct comedi_subdevice *s,
 145                                 struct comedi_insn *insn,
 146                                 unsigned int *data)
 147 {
 148         unsigned int mask = data[0];
 149         unsigned int bits = data[1];
 150
 151         if (mask) {
 152                 s->state &= ~mask;
 153                 s->state |= (bits & mask);
 154
 155                 outw(s->state, dev->iobase + PCI6208_DIO);
 156         }
 157
 158         data[1] = s->state;
 159
 160         return insn->n;
 161 }
 162
 163 static const void *pci6208_find_boardinfo(struct comedi_device *dev,
 164                                           struct pci_dev *pcidev)
 165 {
 166         const struct pci6208_board *boardinfo;
 167         int i;
 168
 169         for (i = 0; i < ARRAY_SIZE(pci6208_boards); i++) {
 170                 boardinfo = &pci6208_boards[i];
 171                 if (boardinfo->dev_id == pcidev->device)
 172                         return boardinfo;
 173         }
 174         return NULL;
 175 }
 176
 177 static int pci6208_auto_attach(struct comedi_device *dev,
 178                                          unsigned long context_unused)
 179 {
 180         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 181         const struct pci6208_board *boardinfo;
 182         struct pci6208_private *devpriv;
 183         struct comedi_subdevice *s;
 184         unsigned int val;
 185         int ret;
 186
 187         boardinfo = pci6208_find_boardinfo(dev, pcidev);
 188         if (!boardinfo)
 189                 return -ENODEV;
 190         dev->board_ptr = boardinfo;
 191         dev->board_name = boardinfo->name;
 192
 193         devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
 194         if (!devpriv)
 195                 return -ENOMEM;
 196         dev->private = devpriv;
 197
 198         ret = comedi_pci_enable(pcidev, dev->board_name);
 199         if (ret)
 200                 return ret;
 201         dev->iobase = pci_resource_start(pcidev, 2);
 202
 203         ret = comedi_alloc_subdevices(dev, 3);
 204         if (ret)
 205                 return ret;
 206
 207         s = &dev->subdevices[0];
 208         /* analog output subdevice */
 209         s->type         = COMEDI_SUBD_AO;
 210         s->subdev_flags = SDF_WRITABLE;
 211         s->n_chan       = boardinfo->ao_chans;
 212         s->maxdata      = 0xffff;
 213         s->range_table  = &range_bipolar10;
 214         s->insn_write   = pci6208_ao_winsn;
 215         s->insn_read    = pci6208_ao_rinsn;
 216
 217         s = &dev->subdevices[1];
 218         /* digital input subdevice */
 219         s->type         = COMEDI_SUBD_DI;
 220         s->subdev_flags = SDF_READABLE;
 221         s->n_chan       = 4;
 222         s->maxdata      = 1;
 223         s->range_table  = &range_digital;
 224         s->insn_bits    = pci6208_di_insn_bits;
 225
 226         s = &dev->subdevices[2];
 227         /* digital output subdevice */
 228         s->type         = COMEDI_SUBD_DO;
 229         s->subdev_flags = SDF_WRITABLE;
 230         s->n_chan       = 4;
 231         s->maxdata      = 1;
 232         s->range_table  = &range_digital;
 233         s->insn_bits    = pci6208_do_insn_bits;
 234
 235         /*
 236          * Get the read back signals from the digital outputs
 237          * and save it as the initial state for the subdevice.
 238          */
 239         val = inw(dev->iobase + PCI6208_DIO);
 240         val = (val & PCI6208_DIO_DO_MASK) >> PCI6208_DIO_DO_SHIFT;
 241         s->state        = val;
 242         s->io_bits      = 0x0f;
 243
 244         dev_info(dev->class_dev, "%s: %s, I/O base=0x%04lx\n",
 245                 dev->driver->driver_name, dev->board_name, dev->iobase);
 246
 247         return 0;
 248 }
 249
 250 static void pci6208_detach(struct comedi_device *dev)
 251 {
 252         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 253
 254         if (pcidev) {
 255                 if (dev->iobase)
 256                         comedi_pci_disable(pcidev);
 257         }
 258 }
 259
 260 static struct comedi_driver adl_pci6208_driver = {
 261         .driver_name    = "adl_pci6208",
 262         .module         = THIS_MODULE,
 263         .auto_attach    = pci6208_auto_attach,
 264         .detach         = pci6208_detach,
 265 };
 266
 267 static int adl_pci6208_pci_probe(struct pci_dev *dev,
 268                                            const struct pci_device_id *ent)
 269 {
 270         return comedi_pci_auto_config(dev, &adl_pci6208_driver);
 271 }
 272
 273 static void adl_pci6208_pci_remove(struct pci_dev *dev)
 274 {
 275         comedi_pci_auto_unconfig(dev);
 276 }
 277
 278 static DEFINE_PCI_DEVICE_TABLE(adl_pci6208_pci_table) = {
 279         { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, PCI_DEVICE_ID_PCI6208) },
 280         { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, PCI_DEVICE_ID_PCI6216) },
 281         { 0 }
 282 };
 283 MODULE_DEVICE_TABLE(pci, adl_pci6208_pci_table);
 284
 285 static struct pci_driver adl_pci6208_pci_driver = {
 286         .name           = "adl_pci6208",
 287         .id_table       = adl_pci6208_pci_table,
 288         .probe          = adl_pci6208_pci_probe,
 289         .remove         = adl_pci6208_pci_remove,
 290 };
 291 module_comedi_pci_driver(adl_pci6208_driver, adl_pci6208_pci_driver);
 292
 293 MODULE_AUTHOR("Comedi http://www.comedi.org");
 294 MODULE_DESCRIPTION("Comedi low-level driver");
 295 MODULE_LICENSE("GPL");