Staging: comedi: add pcl724 driver

For Advantech cards:
	PCL-724, PCL-722, PCL-731 ADLink ACL-7122, ACL-7124, PET-48DIO

From: Michal Dobes <dobes@tesnet.cz>
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/pcl724.c b/drivers/staging/comedi/drivers/pcl724.c
new file mode 100644 (file)
index 0000000..047bebb
--- /dev/null
+++ b/drivers/staging/comedi/drivers/pcl724.c
@@ -0,0 +1,220 @@
+/*
+    comedi/drivers/pcl724.c
+
+    Michal Dobes <dobes@tesnet.cz>
+
+    hardware driver for Advantech cards:
+     card:   PCL-724, PCL-722, PCL-731
+     driver: pcl724,  pcl722,  pcl731
+    and ADLink cards:
+     card:   ACL-7122, ACL-7124, PET-48DIO
+     driver: acl7122,  acl7124,  pet48dio
+
+    Options for PCL-724, PCL-731, ACL-7124 and PET-48DIO:
+     [0] - IO Base
+
+    Options for PCL-722 and ACL-7122:
+     [0] - IO Base
+     [1] - IRQ (0=disable IRQ) IRQ isn't supported at this time!
+     [2] -number of DIO:
+              0, 144: 144 DIO configuration
+             1,  96:  96 DIO configuration
+*/
+/*
+Driver: pcl724
+Description: Advantech PCL-724, PCL-722, PCL-731 ADLink ACL-7122, ACL-7124,
+  PET-48DIO
+Author: Michal Dobes <dobes@tesnet.cz>
+Devices: [Advantech] PCL-724 (pcl724), PCL-722 (pcl722), PCL-731 (pcl731),
+  [ADLink] ACL-7122 (acl7122), ACL-7124 (acl7124), PET-48DIO (pet48dio)
+Status: untested
+
+This is driver for digital I/O boards PCL-722/724/731 with 144/24/48 DIO
+and for digital I/O boards ACL-7122/7124/PET-48DIO with 144/24/48 DIO.
+It need 8255.o for operations and only immediate mode is supported.
+See the source for configuration details.
+*/
+/*
+ * check_driver overrides:
+ *   comedi_insn
+ */
+
+#include "../comedidev.h"
+
+#include <linux/ioport.h>
+#include <linux/delay.h>
+
+#include "8255.h"
+
+#define PCL722_SIZE    32
+#define PCL722_96_SIZE 16
+#define PCL724_SIZE     4
+#define PCL731_SIZE     8
+#define PET48_SIZE      2
+
+#define SIZE_8255      4
+
+// #define PCL724_IRQ   1  /* no IRQ support now */
+
+static int pcl724_attach(comedi_device * dev, comedi_devconfig * it);
+static int pcl724_detach(comedi_device * dev);
+
+typedef struct {
+       const char *name;       // board name
+       int dio;                // num of DIO
+       int numofports;         // num of 8255 subdevices
+       unsigned int IRQbits;   // allowed interrupts
+       unsigned int io_range;  // len of IO space
+       char can_have96;
+       char is_pet48;
+} boardtype;
+
+static const boardtype boardtypes[] = {
+       {"pcl724", 24, 1, 0x00fc, PCL724_SIZE, 0, 0,},
+       {"pcl722", 144, 6, 0x00fc, PCL722_SIZE, 1, 0,},
+       {"pcl731", 48, 2, 0x9cfc, PCL731_SIZE, 0, 0,},
+       {"acl7122", 144, 6, 0x9ee8, PCL722_SIZE, 1, 0,},
+       {"acl7124", 24, 1, 0x00fc, PCL724_SIZE, 0, 0,},
+       {"pet48dio", 48, 2, 0x9eb8, PET48_SIZE, 0, 1,},
+};
+
+#define n_boardtypes (sizeof(boardtypes)/sizeof(boardtype))
+#define this_board ((const boardtype *)dev->board_ptr)
+
+static comedi_driver driver_pcl724 = {
+      driver_name:"pcl724",
+      module:THIS_MODULE,
+      attach:pcl724_attach,
+      detach:pcl724_detach,
+      board_name:&boardtypes[0].name,
+      num_names:n_boardtypes,
+      offset:sizeof(boardtype),
+};
+
+COMEDI_INITCLEANUP(driver_pcl724);
+
+static int subdev_8255_cb(int dir, int port, int data, unsigned long arg)
+{
+       unsigned long iobase = arg;
+
+       if (dir) {
+               outb(data, iobase + port);
+               return 0;
+       } else {
+               return inb(iobase + port);
+       }
+}
+
+static int subdev_8255mapped_cb(int dir, int port, int data,
+       unsigned long iobase)
+{
+       int movport = SIZE_8255 * (iobase >> 12);
+
+       iobase &= 0x0fff;
+
+       if (dir) {
+               outb(port + movport, iobase);
+               outb(data, iobase + 1);
+               return 0;
+       } else {
+               outb(port + movport, iobase);
+               return inb(iobase + 1);
+       }
+}
+
+static int pcl724_attach(comedi_device * dev, comedi_devconfig * it)
+{
+       unsigned long iobase;
+       unsigned int iorange;
+       int ret, i, n_subdevices;
+#ifdef PCL724_IRQ
+       unsigned int irq;
+#endif
+
+       iobase = it->options[0];
+       iorange = this_board->io_range;
+       if ((this_board->can_have96) && ((it->options[1] == 1)
+                       || (it->options[1] == 96)))
+               iorange = PCL722_96_SIZE;       // PCL-724 in 96 DIO configuration
+       printk("comedi%d: pcl724: board=%s, 0x%03lx ", dev->minor,
+               this_board->name, iobase);
+       if (!request_region(iobase, iorange, "pcl724")) {
+               printk("I/O port conflict\n");
+               return -EIO;
+       }
+
+       dev->iobase = iobase;
+
+       dev->board_name = this_board->name;
+
+#ifdef PCL724_IRQ
+       irq = 0;
+       if (this_board->IRQbits != 0) { /* board support IRQ */
+               irq = it->options[1];
+               if (irq) {      /* we want to use IRQ */
+                       if (((1 << irq) & this_board->IRQbits) == 0) {
+                               rt_printk
+                                       (", IRQ %u is out of allowed range, DISABLING IT",
+                                       irq);
+                               irq = 0;        /* Bad IRQ */
+                       } else {
+                               if (comedi_request_irq(irq, interrupt_pcl724, 0,
+                                               "pcl724", dev)) {
+                                       rt_printk
+                                               (", unable to allocate IRQ %u, DISABLING IT",
+                                               irq);
+                                       irq = 0;        /* Can't use IRQ */
+                               } else {
+                                       rt_printk(", irq=%u", irq);
+                               }
+                       }
+               }
+       }
+
+       dev->irq = irq;
+#endif
+
+       printk("\n");
+
+       n_subdevices = this_board->numofports;
+       if ((this_board->can_have96) && ((it->options[1] == 1)
+                       || (it->options[1] == 96)))
+               n_subdevices = 4;       // PCL-724 in 96 DIO configuration
+
+       if ((ret = alloc_subdevices(dev, n_subdevices)) < 0)
+               return ret;
+
+       for (i = 0; i < dev->n_subdevices; i++) {
+               if (this_board->is_pet48) {
+                       subdev_8255_init(dev, dev->subdevices + i,
+                               subdev_8255mapped_cb,
+                               (unsigned long)(dev->iobase + i * 0x1000));
+               } else
+                       subdev_8255_init(dev, dev->subdevices + i,
+                               subdev_8255_cb,
+                               (unsigned long)(dev->iobase + SIZE_8255 * i));
+       };
+
+       return 0;
+}
+
+static int pcl724_detach(comedi_device * dev)
+{
+       int i;
+
+//      printk("comedi%d: pcl724: remove\n",dev->minor);
+
+       for (i = 0; i < dev->n_subdevices; i++) {
+               subdev_8255_cleanup(dev, dev->subdevices + i);
+       }
+
+#ifdef PCL724_IRQ
+       if (dev->irq) {
+               comedi_free_irq(dev->irq, dev);
+       }
+#endif
+
+       release_region(dev->iobase, this_board->io_range);
+
+       return 0;
+}