[deliverable/linux.git] / drivers / staging / comedi / drivers / pcm3730.c

/*
 * comedi/drivers/pcm3730.c
 * Driver for PCM3730 and clones
 * Blaine Lee
 * from pcl725 by David S.
 */
/*
Driver: pcm3730
Description: PCM3730
Author: Blaine Lee
Devices: [Advantech] PCM-3730 (pcm3730)
Status: unknown

Configuration options:
  [0] - I/O port base
*/

#include "../comedidev.h"

#include <linux/ioport.h>

#define PCM3730_SIZE 4		// consecutive io port addresses

#define PCM3730_DOA 0		// offsets for each port
#define PCM3730_DOB 2
#define PCM3730_DOC 3
#define PCM3730_DIA 0
#define PCM3730_DIB 2
#define PCM3730_DIC 3

static int pcm3730_attach(struct comedi_device * dev, comedi_devconfig * it);
static int pcm3730_detach(struct comedi_device * dev);
static struct comedi_driver driver_pcm3730 = {
      driver_name:"pcm3730",
      module:THIS_MODULE,
      attach:pcm3730_attach,
      detach:pcm3730_detach,
};

COMEDI_INITCLEANUP(driver_pcm3730);

static int pcm3730_do_insn_bits(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, dev->iobase + (unsigned long)(s->private));
	}
	data[1] = s->state;

	return 2;
}

static int pcm3730_di_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
	struct comedi_insn * insn, unsigned int * data)
{
	if (insn->n != 2)
		return -EINVAL;
	data[1] = inb(dev->iobase + (unsigned long)(s->private));
	return 2;
}

static int pcm3730_attach(struct comedi_device * dev, comedi_devconfig * it)
{
	struct comedi_subdevice *s;
	unsigned long iobase;

	iobase = it->options[0];
	printk("comedi%d: pcm3730: 0x%04lx ", dev->minor, iobase);
	if (!request_region(iobase, PCM3730_SIZE, "pcm3730")) {
		printk("I/O port conflict\n");
		return -EIO;
	}
	dev->iobase = iobase;
	dev->board_name = "pcm3730";
	dev->iobase = dev->iobase;
	dev->irq = 0;

	if (alloc_subdevices(dev, 6) < 0)
		return -ENOMEM;

	s = dev->subdevices + 0;
	s->type = COMEDI_SUBD_DO;
	s->subdev_flags = SDF_WRITABLE;
	s->maxdata = 1;
	s->n_chan = 8;
	s->insn_bits = pcm3730_do_insn_bits;
	s->range_table = &range_digital;
	s->private = (void *)PCM3730_DOA;

	s = dev->subdevices + 1;
	s->type = COMEDI_SUBD_DO;
	s->subdev_flags = SDF_WRITABLE;
	s->maxdata = 1;
	s->n_chan = 8;
	s->insn_bits = pcm3730_do_insn_bits;
	s->range_table = &range_digital;
	s->private = (void *)PCM3730_DOB;

	s = dev->subdevices + 2;
	s->type = COMEDI_SUBD_DO;
	s->subdev_flags = SDF_WRITABLE;
	s->maxdata = 1;
	s->n_chan = 8;
	s->insn_bits = pcm3730_do_insn_bits;
	s->range_table = &range_digital;
	s->private = (void *)PCM3730_DOC;

	s = dev->subdevices + 3;
	s->type = COMEDI_SUBD_DI;
	s->subdev_flags = SDF_READABLE;
	s->maxdata = 1;
	s->n_chan = 8;
	s->insn_bits = pcm3730_di_insn_bits;
	s->range_table = &range_digital;
	s->private = (void *)PCM3730_DIA;

	s = dev->subdevices + 4;
	s->type = COMEDI_SUBD_DI;
	s->subdev_flags = SDF_READABLE;
	s->maxdata = 1;
	s->n_chan = 8;
	s->insn_bits = pcm3730_di_insn_bits;
	s->range_table = &range_digital;
	s->private = (void *)PCM3730_DIB;

	s = dev->subdevices + 5;
	s->type = COMEDI_SUBD_DI;
	s->subdev_flags = SDF_READABLE;
	s->maxdata = 1;
	s->n_chan = 8;
	s->insn_bits = pcm3730_di_insn_bits;
	s->range_table = &range_digital;
	s->private = (void *)PCM3730_DIC;

	printk("\n");

	return 0;
}

static int pcm3730_detach(struct comedi_device * dev)
{
	printk("comedi%d: pcm3730: remove\n", dev->minor);

	if (dev->iobase)
		release_region(dev->iobase, PCM3730_SIZE);

	return 0;
}
Commit	Line	Data
be06e5d5 BL	1	/*
	2	* comedi/drivers/pcm3730.c
	3	* Driver for PCM3730 and clones
	4	* Blaine Lee
	5	* from pcl725 by David S.
	6	*/
	7	/*
	8	Driver: pcm3730
	9	Description: PCM3730
	10	Author: Blaine Lee
	11	Devices: [Advantech] PCM-3730 (pcm3730)
	12	Status: unknown
	13
	14	Configuration options:
	15	[0] - I/O port base
	16	*/
	17
	18	#include "../comedidev.h"
	19
	20	#include <linux/ioport.h>
	21
	22	#define PCM3730_SIZE 4 // consecutive io port addresses
	23
	24	#define PCM3730_DOA 0 // offsets for each port
	25	#define PCM3730_DOB 2
	26	#define PCM3730_DOC 3
	27	#define PCM3730_DIA 0
	28	#define PCM3730_DIB 2
	29	#define PCM3730_DIC 3
	30
71b5f4f1 BP	31	static int pcm3730_attach(struct comedi_device * dev, comedi_devconfig * it);
71b5f4f1 BP	32	static int pcm3730_detach(struct comedi_device * dev);
139dfbdf	33	static struct comedi_driver driver_pcm3730 = {
be06e5d5 BL	34	driver_name:"pcm3730",
	35	module:THIS_MODULE,
	36	attach:pcm3730_attach,
	37	detach:pcm3730_detach,
	38	};
	39
	40	COMEDI_INITCLEANUP(driver_pcm3730);
	41
34c43922	42	static int pcm3730_do_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	43	struct comedi_insn * insn, unsigned int * data)
be06e5d5 BL	44	{
	45	if (insn->n != 2)
	46	return -EINVAL;
	47	if (data[0]) {
	48	s->state &= ~data[0];
	49	s->state \|= (data[0] & data[1]);
	50	outb(s->state, dev->iobase + (unsigned long)(s->private));
	51	}
	52	data[1] = s->state;
	53
	54	return 2;
	55	}
	56
34c43922	57	static int pcm3730_di_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	58	struct comedi_insn * insn, unsigned int * data)
be06e5d5 BL	59	{
	60	if (insn->n != 2)
	61	return -EINVAL;
	62	data[1] = inb(dev->iobase + (unsigned long)(s->private));
	63	return 2;
	64	}
	65
71b5f4f1	66	static int pcm3730_attach(struct comedi_device * dev, comedi_devconfig * it)
be06e5d5	67	{
34c43922	68	struct comedi_subdevice *s;
be06e5d5 BL	69	unsigned long iobase;
	70
	71	iobase = it->options[0];
	72	printk("comedi%d: pcm3730: 0x%04lx ", dev->minor, iobase);
	73	if (!request_region(iobase, PCM3730_SIZE, "pcm3730")) {
	74	printk("I/O port conflict\n");
	75	return -EIO;
	76	}
	77	dev->iobase = iobase;
	78	dev->board_name = "pcm3730";
	79	dev->iobase = dev->iobase;
	80	dev->irq = 0;
	81
	82	if (alloc_subdevices(dev, 6) < 0)
	83	return -ENOMEM;
	84
	85	s = dev->subdevices + 0;
	86	s->type = COMEDI_SUBD_DO;
	87	s->subdev_flags = SDF_WRITABLE;
	88	s->maxdata = 1;
	89	s->n_chan = 8;
	90	s->insn_bits = pcm3730_do_insn_bits;
	91	s->range_table = &range_digital;
	92	s->private = (void *)PCM3730_DOA;
	93
	94	s = dev->subdevices + 1;
	95	s->type = COMEDI_SUBD_DO;
	96	s->subdev_flags = SDF_WRITABLE;
	97	s->maxdata = 1;
	98	s->n_chan = 8;
	99	s->insn_bits = pcm3730_do_insn_bits;
	100	s->range_table = &range_digital;
	101	s->private = (void *)PCM3730_DOB;
	102
	103	s = dev->subdevices + 2;
	104	s->type = COMEDI_SUBD_DO;
	105	s->subdev_flags = SDF_WRITABLE;
	106	s->maxdata = 1;
	107	s->n_chan = 8;
	108	s->insn_bits = pcm3730_do_insn_bits;
	109	s->range_table = &range_digital;
	110	s->private = (void *)PCM3730_DOC;
	111
	112	s = dev->subdevices + 3;
	113	s->type = COMEDI_SUBD_DI;
	114	s->subdev_flags = SDF_READABLE;
	115	s->maxdata = 1;
	116	s->n_chan = 8;
	117	s->insn_bits = pcm3730_di_insn_bits;
	118	s->range_table = &range_digital;
	119	s->private = (void *)PCM3730_DIA;
	120
	121	s = dev->subdevices + 4;
	122	s->type = COMEDI_SUBD_DI;
	123	s->subdev_flags = SDF_READABLE;
	124	s->maxdata = 1;
	125	s->n_chan = 8;
	126	s->insn_bits = pcm3730_di_insn_bits;
	127	s->range_table = &range_digital;
	128	s->private = (void *)PCM3730_DIB;
	129
	130	s = dev->subdevices + 5;
	131	s->type = COMEDI_SUBD_DI;
	132	s->subdev_flags = SDF_READABLE;
133	s->maxdata = 1;
134	s->n_chan = 8;
135	s->insn_bits = pcm3730_di_insn_bits;
136	s->range_table = &range_digital;
137	s->private = (void *)PCM3730_DIC;
138
139	printk("\n");
140
141	return 0;
142	}
143
71b5f4f1	144	static int pcm3730_detach(struct comedi_device * dev)
be06e5d5 BL	145	{
	146	printk("comedi%d: pcm3730: remove\n", dev->minor);
	147
	148	if (dev->iobase)
	149	release_region(dev->iobase, PCM3730_SIZE);
	150
	151	return 0;
	152	}