[mirror_ubuntu-kernels.git] / drivers / staging / comedi / drivers / aio_iiro_16.c

/*

    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

struct aio_iiro_16_board {
	const char *name;
	int do_;
	int di;
};

static const struct aio_iiro_16_board aio_iiro_16_boards[] = {
	{
	      name:	"aio_iiro_16",
	      di:	16,
      do_:	16},
};

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

struct aio_iiro_16_private {
	int data;
	struct pci_dev *pci_dev;
	unsigned int ao_readback[2];
};

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

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

static int aio_iiro_16_detach(struct comedi_device *dev);

static struct 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(struct aio_iiro_16_board),
      num_names:sizeof(aio_iiro_16_boards) / sizeof(struct aio_iiro_16_board),
};

static int aio_iiro_16_dio_insn_bits_read(struct comedi_device *dev,
	struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data);

static int aio_iiro_16_dio_insn_bits_write(struct comedi_device *dev,
	struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data);

static int aio_iiro_16_attach(struct comedi_device *dev, struct comedi_devconfig *it)
{
	int iobase;
	struct 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(struct 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(struct 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(struct comedi_device *dev,
	struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *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(struct comedi_device *dev,
	struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *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);
Commit	Line	Data
56af390d ZW	1	/*
	2
	3	comedi/drivers/aio_iiro_16.c
	4
	5	Driver for Acces I/O Products PC-104 AIO-IIRO-16 Digital I/O board
	6	Copyright (C) 2006 C&C Technologies, Inc.
	7
	8	This program is free software; you can redistribute it and/or modify
	9	it under the terms of the GNU General Public License as published by
	10	the Free Software Foundation; either version 2 of the License, or
	11	(at your option) any later version.
	12
	13	This program is distributed in the hope that it will be useful,
	14	but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	GNU General Public License for more details.
	17
	18	You should have received a copy of the GNU General Public License
	19	along with this program; if not, write to the Free Software
	20	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	21	*/
	22
	23	/*
	24
	25	Driver: aio_iiro_16
	26	Description: Acces I/O Products PC-104 IIRO16 Relay And Isolated Input Board
	27	Author: Zachary Ware <zach.ware@cctechnol.com>
	28	Devices:
	29	[Acces I/O] PC-104 AIO12-8
	30	Status: experimental
	31
	32	Configuration Options:
	33	[0] - I/O port base address
	34
	35	*/
	36
	37	#include "../comedidev.h"
	38	#include <linux/ioport.h>
	39
	40	#define AIO_IIRO_16_SIZE 0x08
	41	#define AIO_IIRO_16_RELAY_0_7 0x00
	42	#define AIO_IIRO_16_INPUT_0_7 0x01
	43	#define AIO_IIRO_16_IRQ 0x02
	44	#define AIO_IIRO_16_RELAY_8_15 0x04
	45	#define AIO_IIRO_16_INPUT_8_15 0x05
	46
28fa7754	47	struct aio_iiro_16_board {
56af390d ZW	48	const char *name;
	49	int do_;
	50	int di;
28fa7754	51	};
56af390d	52
28fa7754	53	static const struct aio_iiro_16_board aio_iiro_16_boards[] = {
56af390d ZW	54	{
	55	name: "aio_iiro_16",
	56	di: 16,
	57	do_: 16},
	58	};
	59
28fa7754	60	#define thisboard ((const struct aio_iiro_16_board *) dev->board_ptr)
56af390d	61
55d99639	62	struct aio_iiro_16_private {
56af390d ZW	63	int data;
56af390d ZW	64	struct pci_dev *pci_dev;
790c5541	65	unsigned int ao_readback[2];
55d99639	66	};
56af390d	67
55d99639	68	#define devpriv ((struct aio_iiro_16_private *) dev->private)
56af390d	69
da91b269	70	static int aio_iiro_16_attach(struct comedi_device dev, struct comedi_devconfig it);
56af390d	71
da91b269	72	static int aio_iiro_16_detach(struct comedi_device *dev);
56af390d	73
139dfbdf	74	static struct comedi_driver driver_aio_iiro_16 = {
56af390d ZW	75	driver_name:"aio_iiro_16",
	76	module:THIS_MODULE,
	77	attach:aio_iiro_16_attach,
	78	detach:aio_iiro_16_detach,
	79	board_name:&aio_iiro_16_boards[0].name,
28fa7754 BP	80	offset:sizeof(struct aio_iiro_16_board),
28fa7754 BP	81	num_names:sizeof(aio_iiro_16_boards) / sizeof(struct aio_iiro_16_board),
56af390d ZW	82	};
56af390d ZW	83
da91b269 BP	84	static int aio_iiro_16_dio_insn_bits_read(struct comedi_device *dev,
da91b269 BP	85	struct comedi_subdevice s, struct comedi_insn insn, unsigned int *data);
56af390d	86
da91b269 BP	87	static int aio_iiro_16_dio_insn_bits_write(struct comedi_device *dev,
da91b269 BP	88	struct comedi_subdevice s, struct comedi_insn insn, unsigned int *data);
56af390d	89
da91b269	90	static int aio_iiro_16_attach(struct comedi_device dev, struct comedi_devconfig it)
56af390d ZW	91	{
56af390d ZW	92	int iobase;
34c43922	93	struct comedi_subdevice *s;
56af390d ZW	94
	95	printk("comedi%d: aio_iiro_16: ", dev->minor);
	96
	97	dev->board_name = thisboard->name;
	98
	99	iobase = it->options[0];
	100
	101	if (!request_region(iobase, AIO_IIRO_16_SIZE, dev->board_name)) {
	102	printk("I/O port conflict");
	103	return -EIO;
	104	}
	105
	106	dev->iobase = iobase;
	107
55d99639	108	if (alloc_private(dev, sizeof(struct aio_iiro_16_private)) < 0)
56af390d ZW	109	return -ENOMEM;
	110
	111	if (alloc_subdevices(dev, 2) < 0)
	112	return -ENOMEM;
	113
	114	s = dev->subdevices + 0;
	115	s->type = COMEDI_SUBD_DIO;
	116	s->subdev_flags = SDF_WRITABLE;
	117	s->n_chan = 16;
	118	s->maxdata = 1;
	119	s->range_table = &range_digital;
	120	s->insn_bits = aio_iiro_16_dio_insn_bits_write;
	121
	122	s = dev->subdevices + 1;
	123	s->type = COMEDI_SUBD_DIO;
	124	s->subdev_flags = SDF_READABLE;
	125	s->n_chan = 16;
	126	s->maxdata = 1;
	127	s->range_table = &range_digital;
	128	s->insn_bits = aio_iiro_16_dio_insn_bits_read;
	129
	130	printk("attached\n");
	131
	132	return 1;
	133	}
	134
da91b269	135	static int aio_iiro_16_detach(struct comedi_device *dev)
56af390d ZW	136	{
	137	printk("comedi%d: aio_iiro_16: remove\n", dev->minor);
	138
	139	if (dev->iobase)
	140	release_region(dev->iobase, AIO_IIRO_16_SIZE);
	141
	142	return 0;
	143	}
	144
da91b269 BP	145	static int aio_iiro_16_dio_insn_bits_write(struct comedi_device *dev,
da91b269 BP	146	struct comedi_subdevice s, struct comedi_insn insn, unsigned int *data)
56af390d ZW	147	{
	148	if (insn->n != 2)
	149	return -EINVAL;
	150
	151	if (data[0]) {
	152	s->state &= ~data[0];
	153	s->state \|= data[0] & data[1];
	154	outb(s->state & 0xff, dev->iobase + AIO_IIRO_16_RELAY_0_7);
	155	outb((s->state >> 8) & 0xff,
	156	dev->iobase + AIO_IIRO_16_RELAY_8_15);
	157	}
	158
	159	data[1] = s->state;
	160
	161	return 2;
	162	}
	163
da91b269 BP	164	static int aio_iiro_16_dio_insn_bits_read(struct comedi_device *dev,
da91b269 BP	165	struct comedi_subdevice s, struct comedi_insn insn, unsigned int *data)
56af390d ZW	166	{
	167	if (insn->n != 2)
	168	return -EINVAL;
	169
	170	data[1] = 0;
	171	data[1] \|= inb(dev->iobase + AIO_IIRO_16_INPUT_0_7);
	172	data[1] \|= inb(dev->iobase + AIO_IIRO_16_INPUT_8_15) << 8;
	173
	174	return 2;
	175	}
	176
	177	COMEDI_INITCLEANUP(driver_aio_iiro_16);