]> git.karo-electronics.de Git - linux-beck.git/commitdiff
Staging: comedi: add adl_pci6208 driver
authornsyeow <nsyeow@pd.jaring.my>
Thu, 12 Feb 2009 23:28:32 +0000 (15:28 -0800)
committerGreg Kroah-Hartman <gregkh@suse.de>
Fri, 3 Apr 2009 21:53:41 +0000 (14:53 -0700)
For ADLink PCI-6208A devices

From: nsyeow <nsyeow@pd.jaring.my>
Cc: David Schleef <ds@schleef.org>
Cc: Frank Mori Hess <fmhess@users.sourceforge.net>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
drivers/staging/comedi/drivers/adl_pci6208.c [new file with mode: 0644]

diff --git a/drivers/staging/comedi/drivers/adl_pci6208.c b/drivers/staging/comedi/drivers/adl_pci6208.c
new file mode 100644 (file)
index 0000000..0740ae6
--- /dev/null
@@ -0,0 +1,390 @@
+/*
+    comedi/drivers/adl_pci6208.c
+
+    Hardware driver for ADLink 6208 series cards:
+       card         | voltage output    | current output
+       -------------+-------------------+---------------
+       PCI-6208V    |  8 channels       | -
+       PCI-6216V    | 16 channels       | -
+       PCI-6208A    |  8 channels       | 8 channels
+
+    COMEDI - Linux Control and Measurement Device Interface
+    Copyright (C) 2000 David A. Schleef <ds@schleef.org>
+
+    This program is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 2 of the License, or
+    (at your option) any later version.
+
+    This program is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program; if not, write to the Free Software
+    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+*/
+/*
+Driver: adl_pci6208
+Description: ADLink PCI-6208A
+Devices: [ADLink] PCI-6208A (adl_pci6208)
+Author: nsyeow <nsyeow@pd.jaring.my>
+Updated: Fri, 30 Jan 2004 14:44:27 +0800
+Status: untested
+
+Configuration Options:
+  none
+
+References:
+       - ni_660x.c
+       - adl_pci9111.c         copied the entire pci setup section
+       - adl_pci9118.c
+*/
+/*
+ * These headers should be followed by a blank line, and any comments
+ * you wish to say about the driver.  The comment area is the place
+ * to put any known bugs, limitations, unsupported features, supported
+ * command triggers, whether or not commands are supported on particular
+ * subdevices, etc.
+ *
+ * Somewhere in the comment should be information about configuration
+ * options that are used with comedi_config.
+ */
+#include "../comedidev.h"
+#include "comedi_pci.h"
+
+#define PCI6208_DRIVER_NAME    "adl_pci6208"
+
+/* Board descriptions */
+typedef struct {
+       const char *name;
+       unsigned short dev_id;  /* `lspci` will show you this */
+       int ao_chans;
+       //int ao_bits;
+} pci6208_board;
+static const pci6208_board pci6208_boards[] = {
+       /*{
+          name :  "pci6208v",
+          dev_id       :  0x6208,      //not sure
+          ao_chans:  8
+          //,  ao_bits :  16
+          },
+          {
+          name :  "pci6216v",
+          dev_id       :  0x6208,      //not sure
+          ao_chans:  16
+          //,  ao_bits :  16
+          }, */
+       {
+             name:     "pci6208a",
+             dev_id:   0x6208,
+             ao_chans:8
+                       //,     ao_bits :  16
+               }
+};
+
+/* This is used by modprobe to translate PCI IDs to drivers.  Should
+ * only be used for PCI and ISA-PnP devices */
+static DEFINE_PCI_DEVICE_TABLE(pci6208_pci_table) = {
+       //{ PCI_VENDOR_ID_ADLINK, 0x6208, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
+       //{ PCI_VENDOR_ID_ADLINK, 0x6208, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
+       {PCI_VENDOR_ID_ADLINK, 0x6208, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
+       {0}
+};
+
+MODULE_DEVICE_TABLE(pci, pci6208_pci_table);
+
+/* Will be initialized in pci6208_find device(). */
+#define thisboard ((const pci6208_board *)dev->board_ptr)
+
+typedef struct {
+       int data;
+       struct pci_dev *pci_dev;        /* for a PCI device */
+       lsampl_t ao_readback[2];        /* Used for AO readback */
+} pci6208_private;
+
+#define devpriv ((pci6208_private *)dev->private)
+
+static int pci6208_attach(comedi_device * dev, comedi_devconfig * it);
+static int pci6208_detach(comedi_device * dev);
+
+#define pci6208_board_nbr \
+       (sizeof(pci6208_boards) / sizeof(pci6208_board))
+
+static comedi_driver driver_pci6208 = {
+      driver_name:PCI6208_DRIVER_NAME,
+      module:THIS_MODULE,
+      attach:pci6208_attach,
+      detach:pci6208_detach,
+};
+
+COMEDI_PCI_INITCLEANUP(driver_pci6208, pci6208_pci_table);
+
+static int pci6208_find_device(comedi_device * dev, int bus, int slot);
+static int
+pci6208_pci_setup(struct pci_dev *pci_dev, unsigned long *io_base_ptr,
+       int dev_minor);
+
+/*read/write functions*/
+static int pci6208_ao_winsn(comedi_device * dev, comedi_subdevice * s,
+       comedi_insn * insn, lsampl_t * data);
+static int pci6208_ao_rinsn(comedi_device * dev, comedi_subdevice * s,
+       comedi_insn * insn, lsampl_t * data);
+//static int pci6208_dio_insn_bits(comedi_device *dev,comedi_subdevice *s,
+//      comedi_insn *insn,lsampl_t *data);
+//static int pci6208_dio_insn_config(comedi_device *dev,comedi_subdevice *s,
+//      comedi_insn *insn,lsampl_t *data);
+
+/*
+ * Attach is called by the Comedi core to configure the driver
+ * for a particular board.  If you specified a board_name array
+ * in the driver structure, dev->board_ptr contains that
+ * address.
+ */
+static int pci6208_attach(comedi_device * dev, comedi_devconfig * it)
+{
+       comedi_subdevice *s;
+       int retval;
+       unsigned long io_base;
+
+       printk("comedi%d: pci6208: ", dev->minor);
+
+       retval = alloc_private(dev, sizeof(pci6208_private));
+       if (retval < 0)
+               return retval;
+
+       retval = pci6208_find_device(dev, it->options[0], it->options[1]);
+       if (retval < 0)
+               return retval;
+
+       retval = pci6208_pci_setup(devpriv->pci_dev, &io_base, dev->minor);
+       if (retval < 0)
+               return retval;
+
+       dev->iobase = io_base;
+       dev->board_name = thisboard->name;
+
+/*
+ * Allocate the subdevice structures.  alloc_subdevice() is a
+ * convenient macro defined in comedidev.h.
+ */
+       if (alloc_subdevices(dev, 2) < 0)
+               return -ENOMEM;
+
+       s = dev->subdevices + 0;
+       /* analog output subdevice */
+       s->type = COMEDI_SUBD_AO;
+       s->subdev_flags = SDF_WRITABLE; //anything else to add here??
+       s->n_chan = thisboard->ao_chans;
+       s->maxdata = 0xffff;    //16-bit DAC
+       s->range_table = &range_bipolar10;      //this needs to be checked.
+       s->insn_write = pci6208_ao_winsn;
+       s->insn_read = pci6208_ao_rinsn;
+
+       //s=dev->subdevices+1;
+       /* digital i/o subdevice */
+       //s->type=COMEDI_SUBD_DIO;
+       //s->subdev_flags=SDF_READABLE|SDF_WRITABLE;
+       //s->n_chan=16;
+       //s->maxdata=1;
+       //s->range_table=&range_digital;
+       //s->insn_bits = pci6208_dio_insn_bits;
+       //s->insn_config = pci6208_dio_insn_config;
+
+       printk("attached\n");
+
+       return 1;
+}
+
+/*
+ * _detach is called to deconfigure a device.  It should deallocate
+ * resources.
+ * This function is also called when _attach() fails, so it should be
+ * careful not to release resources that were not necessarily
+ * allocated by _attach().  dev->private and dev->subdevices are
+ * deallocated automatically by the core.
+ */
+static int pci6208_detach(comedi_device * dev)
+{
+       printk("comedi%d: pci6208: remove\n", dev->minor);
+
+       if (devpriv && devpriv->pci_dev) {
+               if (dev->iobase) {
+                       comedi_pci_disable(devpriv->pci_dev);
+               }
+               pci_dev_put(devpriv->pci_dev);
+       }
+
+       return 0;
+}
+
+static int pci6208_ao_winsn(comedi_device * dev, comedi_subdevice * s,
+       comedi_insn * insn, lsampl_t * data)
+{
+       int i = 0, Data_Read;
+       unsigned short chan = CR_CHAN(insn->chanspec);
+       unsigned long invert = 1 << (16 - 1);
+       unsigned long out_value;
+       /* Writing a list of values to an AO channel is probably not
+        * very useful, but that's how the interface is defined. */
+       for (i = 0; i < insn->n; i++) {
+               out_value = data[i] ^ invert;
+               /* a typical programming sequence */
+               do {
+                       Data_Read = (inw(dev->iobase) & 1);
+               } while (Data_Read);
+               outw(out_value, dev->iobase + (0x02 * chan));
+               devpriv->ao_readback[chan] = out_value;
+       }
+
+       /* return the number of samples read/written */
+       return i;
+}
+
+/* AO subdevices should have a read insn as well as a write insn.
+ * Usually this means copying a value stored in devpriv. */
+static int pci6208_ao_rinsn(comedi_device * dev, comedi_subdevice * s,
+       comedi_insn * insn, lsampl_t * data)
+{
+       int i;
+       int chan = CR_CHAN(insn->chanspec);
+
+       for (i = 0; i < insn->n; i++)
+               data[i] = devpriv->ao_readback[chan];
+
+       return i;
+}
+
+/* DIO devices are slightly special.  Although it is possible to
+ * implement the insn_read/insn_write interface, it is much more
+ * useful to applications if you implement the insn_bits interface.
+ * This allows packed reading/writing of the DIO channels.  The
+ * comedi core can convert between insn_bits and insn_read/write */
+//static int pci6208_dio_insn_bits(comedi_device *dev,comedi_subdevice *s,
+//      comedi_insn *insn,lsampl_t *data)
+//{
+//      if(insn->n!=2)return -EINVAL;
+
+       /* The insn data is a mask in data[0] and the new data
+        * in data[1], each channel cooresponding to a bit. */
+//      if(data[0]){
+//              s->state &= ~data[0];
+//              s->state |= data[0]&data[1];
+               /* Write out the new digital output lines */
+               //outw(s->state,dev->iobase + SKEL_DIO);
+//      }
+
+       /* on return, data[1] contains the value of the digital
+        * input and output lines. */
+       //data[1]=inw(dev->iobase + SKEL_DIO);
+       /* or we could just return the software copy of the output values if
+        * it was a purely digital output subdevice */
+       //data[1]=s->state;
+
+//      return 2;
+//}
+
+//static int pci6208_dio_insn_config(comedi_device *dev,comedi_subdevice *s,
+//      comedi_insn *insn,lsampl_t *data)
+//{
+//      int chan=CR_CHAN(insn->chanspec);
+
+       /* The input or output configuration of each digital line is
+        * configured by a special insn_config instruction.  chanspec
+        * contains the channel to be changed, and data[0] contains the
+        * value COMEDI_INPUT or COMEDI_OUTPUT. */
+
+//      if(data[0]==COMEDI_OUTPUT){
+//              s->io_bits |= 1<<chan;
+//      }else{
+//              s->io_bits &= ~(1<<chan);
+//      }
+       //outw(s->io_bits,dev->iobase + SKEL_DIO_CONFIG);
+
+//      return 1;
+//}
+
+static int pci6208_find_device(comedi_device * dev, int bus, int slot)
+{
+       struct pci_dev *pci_dev;
+       int i;
+
+       for (pci_dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL);
+               pci_dev != NULL;
+               pci_dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, pci_dev)) {
+               if (pci_dev->vendor == PCI_VENDOR_ID_ADLINK) {
+                       for (i = 0; i < pci6208_board_nbr; i++) {
+                               if (pci6208_boards[i].dev_id == pci_dev->device) {
+                                       // was a particular bus/slot requested?
+                                       if ((bus != 0) || (slot != 0)) {
+                                               // are we on the wrong bus/slot?
+                                               if (pci_dev->bus->number
+                                                       != bus ||
+                                                       PCI_SLOT(pci_dev->devfn)
+                                                       != slot) {
+                                                       continue;
+                                               }
+                                       }
+                                       dev->board_ptr = pci6208_boards + i;
+                                       goto found;
+                               }
+                       }
+               }
+       }
+
+       printk("comedi%d: no supported board found! (req. bus/slot : %d/%d)\n",
+               dev->minor, bus, slot);
+       return -EIO;
+
+      found:
+       printk("comedi%d: found %s (b:s:f=%d:%d:%d) , irq=%d\n",
+               dev->minor,
+               pci6208_boards[i].name,
+               pci_dev->bus->number,
+               PCI_SLOT(pci_dev->devfn),
+               PCI_FUNC(pci_dev->devfn), pci_dev->irq);
+
+       // TODO: Warn about non-tested boards.
+       //switch(board->device_id)
+       //{
+       //};
+
+       devpriv->pci_dev = pci_dev;
+
+       return 0;
+}
+
+static int
+pci6208_pci_setup(struct pci_dev *pci_dev, unsigned long *io_base_ptr,
+       int dev_minor)
+{
+       unsigned long io_base, io_range, lcr_io_base, lcr_io_range;
+
+       // Enable PCI device and request regions
+       if (comedi_pci_enable(pci_dev, PCI6208_DRIVER_NAME) < 0) {
+               printk("comedi%d: Failed to enable PCI device and request regions\n", dev_minor);
+               return -EIO;
+       }
+       // Read local configuration register base address [PCI_BASE_ADDRESS #1].
+       lcr_io_base = pci_resource_start(pci_dev, 1);
+       lcr_io_range = pci_resource_len(pci_dev, 1);
+
+       printk("comedi%d: local config registers at address 0x%4lx [0x%4lx]\n",
+               dev_minor, lcr_io_base, lcr_io_range);
+
+       // Read PCI6208 register base address [PCI_BASE_ADDRESS #2].
+       io_base = pci_resource_start(pci_dev, 2);
+       io_range = pci_resource_end(pci_dev, 2) - io_base + 1;
+
+       printk("comedi%d: 6208 registers at address 0x%4lx [0x%4lx]\n",
+               dev_minor, io_base, io_range);
+
+       *io_base_ptr = io_base;
+       //devpriv->io_range = io_range;
+       //devpriv->is_valid=0;
+       //devpriv->lcr_io_base=lcr_io_base;
+       //devpriv->lcr_io_range=lcr_io_range;
+
+       return 0;
+}