Staging: comedi: add fl212 driver

Driver for FL512 board

From: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
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>

diff --git a/drivers/staging/comedi/drivers/fl512.c b/drivers/staging/comedi/drivers/fl512.c
new file mode 100644 (file)
index 0000000..81c4730
--- /dev/null
+++ b/drivers/staging/comedi/drivers/fl512.c
@@ -0,0 +1,184 @@
+/*
+    comedi/drivers/fl512.c
+    Anders Gnistrup <ex18@kalman.iau.dtu.dk>
+*/
+
+/*
+Driver: fl512
+Description: unknown
+Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
+Devices: [unknown] FL512 (fl512)
+Status: unknown
+
+Digital I/O is not supported.
+
+Configuration options:
+  [0] - I/O port base address
+*/
+
+#define DEBUG 0
+
+#include "../comedidev.h"
+
+#include <linux/delay.h>
+#include <linux/ioport.h>
+
+#define FL512_SIZE 16          /* the size of the used memory */
+typedef struct {
+       sampl_t ao_readback[2];
+} fl512_private;
+#define devpriv ((fl512_private *) dev->private)
+
+static const comedi_lrange range_fl512 = { 4, {
+                       BIP_RANGE(0.5),
+                       BIP_RANGE(1),
+                       BIP_RANGE(5),
+                       BIP_RANGE(10),
+                       UNI_RANGE(1),
+                       UNI_RANGE(5),
+                       UNI_RANGE(10),
+       }
+};
+
+static int fl512_attach(comedi_device * dev, comedi_devconfig * it);
+static int fl512_detach(comedi_device * dev);
+
+static comedi_driver driver_fl512 = {
+      driver_name:"fl512",
+      module:THIS_MODULE,
+      attach:fl512_attach,
+      detach:fl512_detach,
+};
+
+COMEDI_INITCLEANUP(driver_fl512);
+
+static int fl512_ai_insn(comedi_device * dev,
+       comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
+static int fl512_ao_insn(comedi_device * dev,
+       comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
+static int fl512_ao_insn_readback(comedi_device * dev,
+       comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
+
+/*
+ * fl512_ai_insn : this is the analog input function
+ */
+static int fl512_ai_insn(comedi_device * dev,
+       comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
+{
+       int n;
+       unsigned int lo_byte, hi_byte;
+       char chan = CR_CHAN(insn->chanspec);
+       unsigned long iobase = dev->iobase;
+
+       for (n = 0; n < insn->n; n++) { /* sample n times on selected channel */
+               /* XXX probably can move next step out of for() loop -- will make
+                * AI a little bit faster. */
+               outb(chan, iobase + 2); /* select chan */
+               outb(0, iobase + 3);    /* start conversion */
+               /* XXX should test "done" flag instead of delay */
+               comedi_udelay(30);      /* sleep 30 usec */
+               lo_byte = inb(iobase + 2);      /* low 8 byte */
+               hi_byte = inb(iobase + 3) & 0xf;        /* high 4 bit and mask */
+               data[n] = lo_byte + (hi_byte << 8);
+       }
+       return n;
+}
+
+/*
+ * fl512_ao_insn : used to write to a DA port n times
+ */
+static int fl512_ao_insn(comedi_device * dev,
+       comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
+{
+       int n;
+       int chan = CR_CHAN(insn->chanspec);     /* get chan to write */
+       unsigned long iobase = dev->iobase;     /* get base address  */
+
+       for (n = 0; n < insn->n; n++) { /* write n data set */
+               outb(data[n] & 0x0ff, iobase + 4 + 2 * chan);   /* write low byte   */
+               outb((data[n] & 0xf00) >> 8, iobase + 4 + 2 * chan);    /* write high byte  */
+               inb(iobase + 4 + 2 * chan);     /* trig */
+
+               devpriv->ao_readback[chan] = data[n];
+       }
+       return n;
+}
+
+/*
+ * fl512_ao_insn_readback : used to read previous values written to
+ * DA port
+ */
+static int fl512_ao_insn_readback(comedi_device * dev,
+       comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
+{
+       int n;
+       int chan = CR_CHAN(insn->chanspec);
+
+       for (n = 0; n < insn->n; n++) {
+               data[n] = devpriv->ao_readback[chan];
+       }
+
+       return n;
+}
+
+/*
+ * start attach
+ */
+static int fl512_attach(comedi_device * dev, comedi_devconfig * it)
+{
+       unsigned long iobase;
+       comedi_subdevice *s;    /* pointer to the subdevice:
+                                  Analog in, Analog out, ( not made ->and Digital IO) */
+
+       iobase = it->options[0];
+       printk("comedi:%d fl512: 0x%04lx", dev->minor, iobase);
+       if (!request_region(iobase, FL512_SIZE, "fl512")) {
+               printk(" I/O port conflict\n");
+               return -EIO;
+       }
+       dev->iobase = iobase;
+       dev->board_name = "fl512";
+       if (alloc_private(dev, sizeof(fl512_private)) < 0)
+               return -ENOMEM;
+
+#if DEBUG
+       printk("malloc ok\n");
+#endif
+
+       if (alloc_subdevices(dev, 2) < 0)
+               return -ENOMEM;
+
+       /*
+        * this if the definitions of the supdevices, 2 have been defined
+        */
+       /* Analog indput */
+       s = dev->subdevices + 0;
+       s->type = COMEDI_SUBD_AI;       /* define subdevice as Analog In   */
+       s->subdev_flags = SDF_READABLE | SDF_GROUND;    /* you can read it from userspace  */
+       s->n_chan = 16;         /* Number of Analog input channels */
+       s->maxdata = 0x0fff;    /* accept only 12 bits of data     */
+       s->range_table = &range_fl512;  /* device use one of the ranges    */
+       s->insn_read = fl512_ai_insn;   /* function to call when read AD   */
+       printk("comedi: fl512: subdevice 0 initialized\n");
+
+       /* Analog output */
+       s = dev->subdevices + 1;
+       s->type = COMEDI_SUBD_AO;       /* define subdevice as Analog OUT   */
+       s->subdev_flags = SDF_WRITABLE; /* you can write it from userspace  */
+       s->n_chan = 2;          /* Number of Analog output channels */
+       s->maxdata = 0x0fff;    /* accept only 12 bits of data      */
+       s->range_table = &range_fl512;  /* device use one of the ranges     */
+       s->insn_write = fl512_ao_insn;  /* function to call when write DA   */
+       s->insn_read = fl512_ao_insn_readback;  /* function to call when reading DA   */
+       printk("comedi: fl512: subdevice 1 initialized\n");
+
+       return 1;
+}
+
+static int fl512_detach(comedi_device * dev)
+{
+       if (dev->iobase)
+               release_region(dev->iobase, FL512_SIZE);
+       printk("comedi%d: fl512: dummy i detach\n", dev->minor);
+       return 0;
+}