Staging: comedi: add dt2814 driver

Driver for DataTranslation DT2814

From: David Schleef <ds@schleef.org>
Cc: Ian Abbott <abbotti@mev.co.uk>
Cc: Frank Mori Hess <fmhess@users.sourceforge.net>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>

diff --git a/drivers/staging/comedi/drivers/dt2814.c b/drivers/staging/comedi/drivers/dt2814.c
new file mode 100644 (file)
index 0000000..bf43287
--- /dev/null
+++ b/drivers/staging/comedi/drivers/dt2814.c
@@ -0,0 +1,381 @@
+/*
+    comedi/drivers/dt2814.c
+    Hardware driver for Data Translation DT2814
+
+    COMEDI - Linux Control and Measurement Device Interface
+    Copyright (C) 1998 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: dt2814
+Description: Data Translation DT2814
+Author: ds
+Status: complete
+Devices: [Data Translation] DT2814 (dt2814)
+
+Configuration options:
+  [0] - I/O port base address
+  [1] - IRQ
+
+This card has 16 analog inputs multiplexed onto a 12 bit ADC.  There
+is a minimally useful onboard clock.  The base frequency for the
+clock is selected by jumpers, and the clock divider can be selected
+via programmed I/O.  Unfortunately, the clock divider can only be
+a power of 10, from 1 to 10^7, of which only 3 or 4 are useful.  In
+addition, the clock does not seem to be very accurate.
+*/
+
+#include "../comedidev.h"
+
+#include <linux/ioport.h>
+#include <linux/delay.h>
+
+#define DT2814_SIZE 2
+
+#define DT2814_CSR 0
+#define DT2814_DATA 1
+
+/*
+ * flags
+ */
+
+#define DT2814_FINISH 0x80
+#define DT2814_ERR 0x40
+#define DT2814_BUSY 0x20
+#define DT2814_ENB 0x10
+#define DT2814_CHANMASK 0x0f
+
+static int dt2814_attach(comedi_device * dev, comedi_devconfig * it);
+static int dt2814_detach(comedi_device * dev);
+static comedi_driver driver_dt2814 = {
+      driver_name:"dt2814",
+      module:THIS_MODULE,
+      attach:dt2814_attach,
+      detach:dt2814_detach,
+};
+
+COMEDI_INITCLEANUP(driver_dt2814);
+
+static irqreturn_t dt2814_interrupt(int irq, void *dev PT_REGS_ARG);
+
+typedef struct {
+       int ntrig;
+       int curadchan;
+} dt2814_private;
+#define devpriv ((dt2814_private *)dev->private)
+
+#define DT2814_TIMEOUT 10
+#define DT2814_MAX_SPEED 100000        /* Arbitrary 10 khz limit */
+
+static int dt2814_ai_insn_read(comedi_device * dev, comedi_subdevice * s,
+       comedi_insn * insn, lsampl_t * data)
+{
+       int n, i, hi, lo;
+       int chan;
+       int status = 0;
+
+       for (n = 0; n < insn->n; n++) {
+               chan = CR_CHAN(insn->chanspec);
+
+               outb(chan, dev->iobase + DT2814_CSR);
+               for (i = 0; i < DT2814_TIMEOUT; i++) {
+                       status = inb(dev->iobase + DT2814_CSR);
+                       printk("dt2814: status: %02x\n", status);
+                       comedi_udelay(10);
+                       if (status & DT2814_FINISH)
+                               break;
+               }
+               if (i >= DT2814_TIMEOUT) {
+                       printk("dt2814: status: %02x\n", status);
+                       return -ETIMEDOUT;
+               }
+
+               hi = inb(dev->iobase + DT2814_DATA);
+               lo = inb(dev->iobase + DT2814_DATA);
+
+               data[n] = (hi << 4) | (lo >> 4);
+       }
+
+       return n;
+}
+
+static int dt2814_ns_to_timer(unsigned int *ns, unsigned int flags)
+{
+       int i;
+       unsigned int f;
+
+       /* XXX ignores flags */
+
+       f = 10000;              /* ns */
+       for (i = 0; i < 8; i++) {
+               if ((2 * (*ns)) < (f * 11))
+                       break;
+               f *= 10;
+       }
+
+       *ns = f;
+
+       return i;
+}
+
+static int dt2814_ai_cmdtest(comedi_device * dev, comedi_subdevice * s,
+       comedi_cmd * cmd)
+{
+       int err = 0;
+       int tmp;
+
+       /* step 1: make sure trigger sources are trivially valid */
+
+       tmp = cmd->start_src;
+       cmd->start_src &= TRIG_NOW;
+       if (!cmd->start_src || tmp != cmd->start_src)
+               err++;
+
+       tmp = cmd->scan_begin_src;
+       cmd->scan_begin_src &= TRIG_TIMER;
+       if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
+               err++;
+
+       tmp = cmd->convert_src;
+       cmd->convert_src &= TRIG_NOW;
+       if (!cmd->convert_src || tmp != cmd->convert_src)
+               err++;
+
+       tmp = cmd->scan_end_src;
+       cmd->scan_end_src &= TRIG_COUNT;
+       if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
+               err++;
+
+       tmp = cmd->stop_src;
+       cmd->stop_src &= TRIG_COUNT | TRIG_NONE;
+       if (!cmd->stop_src || tmp != cmd->stop_src)
+               err++;
+
+       if (err)
+               return 1;
+
+       /* step 2: make sure trigger sources are unique and mutually compatible */
+
+       /* note that mutual compatiblity is not an issue here */
+       if (cmd->stop_src != TRIG_TIMER && cmd->stop_src != TRIG_EXT)
+               err++;
+
+       if (err)
+               return 2;
+
+       /* step 3: make sure arguments are trivially compatible */
+
+       if (cmd->start_arg != 0) {
+               cmd->start_arg = 0;
+               err++;
+       }
+       if (cmd->scan_begin_arg > 1000000000) {
+               cmd->scan_begin_arg = 1000000000;
+               err++;
+       }
+       if (cmd->scan_begin_arg < DT2814_MAX_SPEED) {
+               cmd->scan_begin_arg = DT2814_MAX_SPEED;
+               err++;
+       }
+       if (cmd->scan_end_arg != cmd->chanlist_len) {
+               cmd->scan_end_arg = cmd->chanlist_len;
+               err++;
+       }
+       if (cmd->stop_src == TRIG_COUNT) {
+               if (cmd->stop_arg < 2) {
+                       cmd->stop_arg = 2;
+                       err++;
+               }
+       } else {
+               /* TRIG_NONE */
+               if (cmd->stop_arg != 0) {
+                       cmd->stop_arg = 0;
+                       err++;
+               }
+       }
+
+       if (err)
+               return 3;
+
+       /* step 4: fix up any arguments */
+
+       tmp = cmd->scan_begin_arg;
+       dt2814_ns_to_timer(&cmd->scan_begin_arg, cmd->flags & TRIG_ROUND_MASK);
+       if (tmp != cmd->scan_begin_arg)
+               err++;
+
+       if (err)
+               return 4;
+
+       return 0;
+}
+
+static int dt2814_ai_cmd(comedi_device * dev, comedi_subdevice * s)
+{
+       comedi_cmd *cmd = &s->async->cmd;
+       int chan;
+       int trigvar;
+
+       trigvar =
+               dt2814_ns_to_timer(&cmd->scan_begin_arg,
+               cmd->flags & TRIG_ROUND_MASK);
+
+       chan = CR_CHAN(cmd->chanlist[0]);
+
+       devpriv->ntrig = cmd->stop_arg;
+       outb(chan | DT2814_ENB | (trigvar << 5), dev->iobase + DT2814_CSR);
+
+       return 0;
+
+}
+
+static int dt2814_attach(comedi_device * dev, comedi_devconfig * it)
+{
+       int i, irq;
+       int ret;
+       comedi_subdevice *s;
+       unsigned long iobase;
+
+       iobase = it->options[0];
+       printk("comedi%d: dt2814: 0x%04lx ", dev->minor, iobase);
+       if (!request_region(iobase, DT2814_SIZE, "dt2814")) {
+               printk("I/O port conflict\n");
+               return -EIO;
+       }
+       dev->iobase = iobase;
+       dev->board_name = "dt2814";
+
+       outb(0, dev->iobase + DT2814_CSR);
+       comedi_udelay(100);
+       if (inb(dev->iobase + DT2814_CSR) & DT2814_ERR) {
+               printk("reset error (fatal)\n");
+               return -EIO;
+       }
+       i = inb(dev->iobase + DT2814_DATA);
+       i = inb(dev->iobase + DT2814_DATA);
+
+       irq = it->options[1];
+#if 0
+       if (irq < 0) {
+               save_flags(flags);
+               sti();
+               irqs = probe_irq_on();
+
+               outb(0, dev->iobase + DT2814_CSR);
+
+               comedi_udelay(100);
+
+               irq = probe_irq_off(irqs);
+               restore_flags(flags);
+               if (inb(dev->iobase + DT2814_CSR) & DT2814_ERR) {
+                       printk("error probing irq (bad) \n");
+               }
+
+               i = inb(dev->iobase + DT2814_DATA);
+               i = inb(dev->iobase + DT2814_DATA);
+       }
+#endif
+       dev->irq = 0;
+       if (irq > 0) {
+               if (comedi_request_irq(irq, dt2814_interrupt, 0, "dt2814", dev)) {
+                       printk("(irq %d unavailable)\n", irq);
+               } else {
+                       printk("( irq = %d )\n", irq);
+                       dev->irq = irq;
+               }
+       } else if (irq == 0) {
+               printk("(no irq)\n");
+       } else {
+#if 0
+               printk("(probe returned multiple irqs--bad)\n");
+#else
+               printk("(irq probe not implemented)\n");
+#endif
+       }
+
+       if ((ret = alloc_subdevices(dev, 1)) < 0)
+               return ret;
+       if ((ret = alloc_private(dev, sizeof(dt2814_private))) < 0)
+               return ret;
+
+       s = dev->subdevices + 0;
+       dev->read_subdev = s;
+       s->type = COMEDI_SUBD_AI;
+       s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_CMD_READ;
+       s->n_chan = 16;         /* XXX */
+       s->len_chanlist = 1;
+       s->insn_read = dt2814_ai_insn_read;
+       s->do_cmd = dt2814_ai_cmd;
+       s->do_cmdtest = dt2814_ai_cmdtest;
+       s->maxdata = 0xfff;
+       s->range_table = &range_unknown;        /* XXX */
+
+       return 0;
+}
+
+static int dt2814_detach(comedi_device * dev)
+{
+       printk("comedi%d: dt2814: remove\n", dev->minor);
+
+       if (dev->irq) {
+               comedi_free_irq(dev->irq, dev);
+       }
+       if (dev->iobase) {
+               release_region(dev->iobase, DT2814_SIZE);
+       }
+
+       return 0;
+}
+
+static irqreturn_t dt2814_interrupt(int irq, void *d PT_REGS_ARG)
+{
+       int lo, hi;
+       comedi_device *dev = d;
+       comedi_subdevice *s;
+       int data;
+
+       if (!dev->attached) {
+               comedi_error(dev, "spurious interrupt");
+               return IRQ_HANDLED;
+       }
+
+       s = dev->subdevices + 0;
+
+       hi = inb(dev->iobase + DT2814_DATA);
+       lo = inb(dev->iobase + DT2814_DATA);
+
+       data = (hi << 4) | (lo >> 4);
+
+       if (!(--devpriv->ntrig)) {
+               int i;
+
+               outb(0, dev->iobase + DT2814_CSR);
+               /* note: turning off timed mode triggers another
+                  sample. */
+
+               for (i = 0; i < DT2814_TIMEOUT; i++) {
+                       if (inb(dev->iobase + DT2814_CSR) & DT2814_FINISH)
+                               break;
+               }
+               inb(dev->iobase + DT2814_DATA);
+               inb(dev->iobase + DT2814_DATA);
+
+               s->async->events |= COMEDI_CB_EOA;
+       }
+       comedi_event(dev, s);
+       return IRQ_HANDLED;
+}