Staging: comedi: add pcl724 driver

/*

    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;

}