Staging: comedi: add aio_iiro_16 driver

/*

    comedi/drivers/aio_iiro_16.c

    Driver for Acces I/O Products PC-104 AIO-IIRO-16 Digital I/O board

    Copyright (C) 2006 C&C Technologies, Inc.

    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: aio_iiro_16

Description: Acces I/O Products PC-104 IIRO16 Relay And Isolated Input Board

Author: Zachary Ware <zach.ware@cctechnol.com>

Devices:

 [Acces I/O] PC-104 AIO12-8

Status: experimental

Configuration Options:

  [0] - I/O port base address

*/

#include "../comedidev.h"

#include <linux/ioport.h>

#define AIO_IIRO_16_SIZE	0x08

#define AIO_IIRO_16_RELAY_0_7	0x00

#define AIO_IIRO_16_INPUT_0_7	0x01

#define AIO_IIRO_16_IRQ		0x02

#define AIO_IIRO_16_RELAY_8_15	0x04

#define AIO_IIRO_16_INPUT_8_15	0x05

typedef struct aio_iiro_16_board_struct {

	const char *name;

	int do_;

	int di;

} aio_iiro_16_board;

static const aio_iiro_16_board aio_iiro_16_boards[] = {

	{

	      name:	"aio_iiro_16",

	      di:	16,

      do_:	16},

};

#define	thisboard	((const aio_iiro_16_board *) dev->board_ptr)

typedef struct {

	int data;

	struct pci_dev *pci_dev;

	lsampl_t ao_readback[2];

} aio_iiro_16_private;

#define	devpriv	((aio_iiro_16_private *) dev->private)

static int aio_iiro_16_attach(comedi_device * dev, comedi_devconfig * it);

static int aio_iiro_16_detach(comedi_device * dev);

static comedi_driver driver_aio_iiro_16 = {

      driver_name:"aio_iiro_16",

      module:THIS_MODULE,

      attach:aio_iiro_16_attach,

      detach:aio_iiro_16_detach,

      board_name:&aio_iiro_16_boards[0].name,

      offset:sizeof(aio_iiro_16_board),

      num_names:sizeof(aio_iiro_16_boards) / sizeof(aio_iiro_16_board),

};

static int aio_iiro_16_dio_insn_bits_read(comedi_device * dev,

	comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);

static int aio_iiro_16_dio_insn_bits_write(comedi_device * dev,

	comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);

static int aio_iiro_16_attach(comedi_device * dev, comedi_devconfig * it)

{

	int iobase;

	comedi_subdevice *s;

	printk("comedi%d: aio_iiro_16: ", dev->minor);

	dev->board_name = thisboard->name;

	iobase = it->options[0];

	if (!request_region(iobase, AIO_IIRO_16_SIZE, dev->board_name)) {

		printk("I/O port conflict");

		return -EIO;

	}

	dev->iobase = iobase;

	if (alloc_private(dev, sizeof(aio_iiro_16_private)) < 0)

		return -ENOMEM;

	if (alloc_subdevices(dev, 2) < 0)

		return -ENOMEM;

	s = dev->subdevices + 0;

	s->type = COMEDI_SUBD_DIO;

	s->subdev_flags = SDF_WRITABLE;

	s->n_chan = 16;

	s->maxdata = 1;

	s->range_table = &range_digital;

	s->insn_bits = aio_iiro_16_dio_insn_bits_write;

	s = dev->subdevices + 1;

	s->type = COMEDI_SUBD_DIO;

	s->subdev_flags = SDF_READABLE;

	s->n_chan = 16;

	s->maxdata = 1;

	s->range_table = &range_digital;

	s->insn_bits = aio_iiro_16_dio_insn_bits_read;

	printk("attached\n");

	return 1;

}

static int aio_iiro_16_detach(comedi_device * dev)

{

	printk("comedi%d: aio_iiro_16: remove\n", dev->minor);

	if (dev->iobase)

		release_region(dev->iobase, AIO_IIRO_16_SIZE);

	return 0;

}

static int aio_iiro_16_dio_insn_bits_write(comedi_device * dev,

	comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)

{

	if (insn->n != 2)

		return -EINVAL;

	if (data[0]) {

		s->state &= ~data[0];

		s->state |= data[0] & data[1];

		outb(s->state & 0xff, dev->iobase + AIO_IIRO_16_RELAY_0_7);

		outb((s->state >> 8) & 0xff,

			dev->iobase + AIO_IIRO_16_RELAY_8_15);

	}

	data[1] = s->state;

	return 2;

}

static int aio_iiro_16_dio_insn_bits_read(comedi_device * dev,

	comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)

{

	if (insn->n != 2)

		return -EINVAL;

	data[1] = 0;

	data[1] |= inb(dev->iobase + AIO_IIRO_16_INPUT_0_7);

	data[1] |= inb(dev->iobase + AIO_IIRO_16_INPUT_8_15) << 8;

	return 2;

}

COMEDI_INITCLEANUP(driver_aio_iiro_16);