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

/*
    comedi/drivers/poc.c
    Mini-drivers for POC (Piece of Crap) boards
    Copyright (C) 2000 Frank Mori Hess <fmhess@users.sourceforge.net>
    Copyright (C) 2001 David A. Schleef <ds@schleef.org>

    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: poc
Description: Generic driver for very simple devices
Author: ds
Devices: [Keithley Metrabyte] DAC-02 (dac02), [Advantech] PCL-733 (pcl733),
  PCL-734 (pcl734)
Updated: Sat, 16 Mar 2002 17:34:48 -0800
Status: unknown

This driver is indended to support very simple ISA-based devices,
including:
  dac02 - Keithley DAC-02 analog output board
  pcl733 - Advantech PCL-733
  pcl734 - Advantech PCL-734

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

#include "../comedidev.h"

#include <linux/ioport.h>

static int poc_attach(struct comedi_device * dev, comedi_devconfig * it);
static int poc_detach(struct comedi_device * dev);
static int readback_insn(struct comedi_device * dev, struct comedi_subdevice * s,
	struct comedi_insn * insn, unsigned int * data);

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

struct boarddef_struct {
	const char *name;
	unsigned int iosize;
	int (*setup) (struct comedi_device *);
	int type;
	int n_chan;
	int n_bits;
	int (*winsn) (struct comedi_device *, struct comedi_subdevice *, struct comedi_insn *,
		unsigned int *);
	int (*rinsn) (struct comedi_device *, struct comedi_subdevice *, struct comedi_insn *,
		unsigned int *);
	int (*insnbits) (struct comedi_device *, struct comedi_subdevice *, struct comedi_insn *,
		unsigned int *);
	const struct comedi_lrange *range;
};
static const struct boarddef_struct boards[] = {
	{
	      name:	"dac02",
	      iosize:	8,
			//setup:                dac02_setup,
	      type:	COMEDI_SUBD_AO,
	      n_chan:	2,
	      n_bits:	12,
	      winsn:	dac02_ao_winsn,
	      rinsn:	readback_insn,
	      range:	&range_unknown,
		},
	{
	      name:	"pcl733",
	      iosize:	4,
	      type:	COMEDI_SUBD_DI,
	      n_chan:	32,
	      n_bits:	1,
	      insnbits:pcl733_insn_bits,
	      range:	&range_digital,
		},
	{
	      name:	"pcl734",
	      iosize:	4,
	      type:	COMEDI_SUBD_DO,
	      n_chan:	32,
	      n_bits:	1,
	      insnbits:pcl734_insn_bits,
	      range:	&range_digital,
		},
};

#define n_boards (sizeof(boards)/sizeof(boards[0]))
#define this_board ((const struct boarddef_struct *)dev->board_ptr)

static struct comedi_driver driver_poc = {
      driver_name:"poc",
      module:THIS_MODULE,
      attach:poc_attach,
      detach:poc_detach,
      board_name:&boards[0].name,
      num_names:n_boards,
      offset:sizeof(boards[0]),
};

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

	iobase = it->options[0];
	printk("comedi%d: poc: using %s iobase 0x%lx\n", dev->minor,
		this_board->name, iobase);

	dev->board_name = this_board->name;

	if (iobase == 0) {
		printk("io base address required\n");
		return -EINVAL;
	}

	iosize = this_board->iosize;
	/* check if io addresses are available */
	if (!request_region(iobase, iosize, "dac02")) {
		printk("I/O port conflict: failed to allocate ports 0x%lx to 0x%lx\n", iobase, iobase + iosize - 1);
		return -EIO;
	}
	dev->iobase = iobase;

	if (alloc_subdevices(dev, 1) < 0)
		return -ENOMEM;
	if (alloc_private(dev, sizeof(unsigned int) * this_board->n_chan) < 0)
		return -ENOMEM;

	/* analog output subdevice */
	s = dev->subdevices + 0;
	s->type = this_board->type;
	s->n_chan = this_board->n_chan;
	s->maxdata = (1 << this_board->n_bits) - 1;
	s->range_table = this_board->range;
	s->insn_write = this_board->winsn;
	s->insn_read = this_board->rinsn;
	s->insn_bits = this_board->insnbits;
	if (s->type == COMEDI_SUBD_AO || s->type == COMEDI_SUBD_DO) {
		s->subdev_flags = SDF_WRITABLE;
	}

	return 0;
}

static int poc_detach(struct comedi_device * dev)
{
	/* only free stuff if it has been allocated by _attach */
	if (dev->iobase)
		release_region(dev->iobase, this_board->iosize);

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

	return 0;
}

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

	chan = CR_CHAN(insn->chanspec);
	data[0] = ((unsigned int *) dev->private)[chan];

	return 1;
}

/* DAC-02 registers */
#define DAC02_LSB(a)	(2 * a)
#define DAC02_MSB(a)	(2 * a + 1)

static int dac02_ao_winsn(struct comedi_device * dev, struct comedi_subdevice * s,
	struct comedi_insn * insn, unsigned int * data)
{
	int temp;
	int chan;
	int output;

	chan = CR_CHAN(insn->chanspec);
	((unsigned int *) dev->private)[chan] = data[0];
	output = data[0];
#ifdef wrong
	// convert to complementary binary if range is bipolar
	if ((CR_RANGE(insn->chanspec) & 0x2) == 0)
		output = ~output;
#endif
	temp = (output << 4) & 0xf0;
	outb(temp, dev->iobase + DAC02_LSB(chan));
	temp = (output >> 4) & 0xff;
	outb(temp, dev->iobase + DAC02_MSB(chan));

	return 1;
}

static int pcl733_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 + 0);
	data[1] |= (inb(dev->iobase + 1) << 8);
	data[1] |= (inb(dev->iobase + 2) << 16);
	data[1] |= (inb(dev->iobase + 3) << 24);

	return 2;
}

static int pcl734_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]);
		if ((data[0] >> 0) & 0xff)
			outb((s->state >> 0) & 0xff, dev->iobase + 0);
		if ((data[0] >> 8) & 0xff)
			outb((s->state >> 8) & 0xff, dev->iobase + 1);
		if ((data[0] >> 16) & 0xff)
			outb((s->state >> 16) & 0xff, dev->iobase + 2);
		if ((data[0] >> 24) & 0xff)
			outb((s->state >> 24) & 0xff, dev->iobase + 3);
	}
	data[1] = s->state;

	return 2;
}

COMEDI_INITCLEANUP(driver_poc);
Commit	Line	Data
ac52af96 DS	1	/*
	2	comedi/drivers/poc.c
	3	Mini-drivers for POC (Piece of Crap) boards
	4	Copyright (C) 2000 Frank Mori Hess <fmhess@users.sourceforge.net>
	5	Copyright (C) 2001 David A. Schleef <ds@schleef.org>
	6
	7	This program is free software; you can redistribute it and/or modify
	8	it under the terms of the GNU General Public License as published by
	9	the Free Software Foundation; either version 2 of the License, or
	10	(at your option) any later version.
	11
	12	This program is distributed in the hope that it will be useful,
	13	but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	GNU General Public License for more details.
	16
	17	You should have received a copy of the GNU General Public License
	18	along with this program; if not, write to the Free Software
	19	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	20	*/
	21	/*
	22	Driver: poc
	23	Description: Generic driver for very simple devices
	24	Author: ds
	25	Devices: [Keithley Metrabyte] DAC-02 (dac02), [Advantech] PCL-733 (pcl733),
	26	PCL-734 (pcl734)
	27	Updated: Sat, 16 Mar 2002 17:34:48 -0800
	28	Status: unknown
	29
	30	This driver is indended to support very simple ISA-based devices,
	31	including:
	32	dac02 - Keithley DAC-02 analog output board
	33	pcl733 - Advantech PCL-733
	34	pcl734 - Advantech PCL-734
	35
	36	Configuration options:
	37	[0] - I/O port base
	38	*/
	39
	40	#include "../comedidev.h"
	41
	42	#include <linux/ioport.h>
	43
71b5f4f1 BP	44	static int poc_attach(struct comedi_device * dev, comedi_devconfig * it);
71b5f4f1 BP	45	static int poc_detach(struct comedi_device * dev);
34c43922	46	static int readback_insn(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	47	struct comedi_insn * insn, unsigned int * data);
ac52af96	48
34c43922	49	static int dac02_ao_winsn(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	50	struct comedi_insn * insn, unsigned int * data);
34c43922	51	static int pcl733_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	52	struct comedi_insn * insn, unsigned int * data);
34c43922	53	static int pcl734_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	54	struct comedi_insn * insn, unsigned int * data);
ac52af96 DS	55
	56	struct boarddef_struct {
	57	const char *name;
	58	unsigned int iosize;
71b5f4f1	59	int (setup) (struct comedi_device );
ac52af96 DS	60	int type;
	61	int n_chan;
	62	int n_bits;
90035c08	63	int (winsn) (struct comedi_device , struct comedi_subdevice , struct comedi_insn ,
790c5541	64	unsigned int *);
90035c08	65	int (rinsn) (struct comedi_device , struct comedi_subdevice , struct comedi_insn ,
790c5541	66	unsigned int *);
90035c08	67	int (insnbits) (struct comedi_device , struct comedi_subdevice , struct comedi_insn ,
790c5541	68	unsigned int *);
9ced1de6	69	const struct comedi_lrange *range;
ac52af96 DS	70	};
	71	static const struct boarddef_struct boards[] = {
	72	{
	73	name: "dac02",
	74	iosize: 8,
	75	//setup: dac02_setup,
	76	type: COMEDI_SUBD_AO,
	77	n_chan: 2,
	78	n_bits: 12,
	79	winsn: dac02_ao_winsn,
	80	rinsn: readback_insn,
	81	range: &range_unknown,
	82	},
	83	{
	84	name: "pcl733",
	85	iosize: 4,
	86	type: COMEDI_SUBD_DI,
	87	n_chan: 32,
	88	n_bits: 1,
	89	insnbits:pcl733_insn_bits,
	90	range: &range_digital,
	91	},
	92	{
	93	name: "pcl734",
	94	iosize: 4,
	95	type: COMEDI_SUBD_DO,
	96	n_chan: 32,
	97	n_bits: 1,
	98	insnbits:pcl734_insn_bits,
	99	range: &range_digital,
	100	},
	101	};
	102
	103	#define n_boards (sizeof(boards)/sizeof(boards[0]))
	104	#define this_board ((const struct boarddef_struct *)dev->board_ptr)
	105
139dfbdf	106	static struct comedi_driver driver_poc = {
ac52af96 DS	107	driver_name:"poc",
	108	module:THIS_MODULE,
	109	attach:poc_attach,
	110	detach:poc_detach,
	111	board_name:&boards[0].name,
	112	num_names:n_boards,
	113	offset:sizeof(boards[0]),
	114	};
	115
71b5f4f1	116	static int poc_attach(struct comedi_device * dev, comedi_devconfig * it)
ac52af96	117	{
34c43922	118	struct comedi_subdevice *s;
ac52af96 DS	119	unsigned long iobase;
	120	unsigned int iosize;
	121
	122	iobase = it->options[0];
	123	printk("comedi%d: poc: using %s iobase 0x%lx\n", dev->minor,
	124	this_board->name, iobase);
	125
	126	dev->board_name = this_board->name;
	127
	128	if (iobase == 0) {
	129	printk("io base address required\n");
	130	return -EINVAL;
	131	}
	132
	133	iosize = this_board->iosize;
	134	/* check if io addresses are available */
	135	if (!request_region(iobase, iosize, "dac02")) {
	136	printk("I/O port conflict: failed to allocate ports 0x%lx to 0x%lx\n", iobase, iobase + iosize - 1);
	137	return -EIO;
	138	}
	139	dev->iobase = iobase;
	140
	141	if (alloc_subdevices(dev, 1) < 0)
	142	return -ENOMEM;
790c5541	143	if (alloc_private(dev, sizeof(unsigned int) * this_board->n_chan) < 0)
ac52af96 DS	144	return -ENOMEM;
	145
	146	/* analog output subdevice */
	147	s = dev->subdevices + 0;
	148	s->type = this_board->type;
	149	s->n_chan = this_board->n_chan;
	150	s->maxdata = (1 << this_board->n_bits) - 1;
	151	s->range_table = this_board->range;
	152	s->insn_write = this_board->winsn;
	153	s->insn_read = this_board->rinsn;
	154	s->insn_bits = this_board->insnbits;
	155	if (s->type == COMEDI_SUBD_AO \|\| s->type == COMEDI_SUBD_DO) {
	156	s->subdev_flags = SDF_WRITABLE;
	157	}
	158
	159	return 0;
	160	}
	161
71b5f4f1	162	static int poc_detach(struct comedi_device * dev)
ac52af96 DS	163	{
	164	/* only free stuff if it has been allocated by _attach */
	165	if (dev->iobase)
	166	release_region(dev->iobase, this_board->iosize);
	167
	168	printk("comedi%d: dac02: remove\n", dev->minor);
	169
	170	return 0;
	171	}
	172
34c43922	173	static int readback_insn(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	174	struct comedi_insn * insn, unsigned int * data)
ac52af96 DS	175	{
	176	int chan;
	177
	178	chan = CR_CHAN(insn->chanspec);
790c5541	179	data[0] = ((unsigned int *) dev->private)[chan];
ac52af96 DS	180
	181	return 1;
	182	}
	183
	184	/* DAC-02 registers */
	185	#define DAC02_LSB(a) (2 * a)
	186	#define DAC02_MSB(a) (2 * a + 1)
	187
34c43922	188	static int dac02_ao_winsn(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	189	struct comedi_insn * insn, unsigned int * data)
ac52af96 DS	190	{
	191	int temp;
	192	int chan;
	193	int output;
	194
	195	chan = CR_CHAN(insn->chanspec);
790c5541	196	((unsigned int *) dev->private)[chan] = data[0];
ac52af96 DS	197	output = data[0];
	198	#ifdef wrong
	199	// convert to complementary binary if range is bipolar
	200	if ((CR_RANGE(insn->chanspec) & 0x2) == 0)
	201	output = ~output;
	202	#endif
	203	temp = (output << 4) & 0xf0;
	204	outb(temp, dev->iobase + DAC02_LSB(chan));
	205	temp = (output >> 4) & 0xff;
	206	outb(temp, dev->iobase + DAC02_MSB(chan));
	207
	208	return 1;
	209	}
	210
34c43922	211	static int pcl733_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	212	struct comedi_insn * insn, unsigned int * data)
ac52af96 DS	213	{
	214	if (insn->n != 2)
	215	return -EINVAL;
	216
	217	data[1] = inb(dev->iobase + 0);
	218	data[1] \|= (inb(dev->iobase + 1) << 8);
	219	data[1] \|= (inb(dev->iobase + 2) << 16);
	220	data[1] \|= (inb(dev->iobase + 3) << 24);
	221
	222	return 2;
	223	}
	224
34c43922	225	static int pcl734_insn_bits(struct comedi_device * dev, struct comedi_subdevice * s,
90035c08	226	struct comedi_insn * insn, unsigned int * data)
ac52af96 DS	227	{
	228	if (insn->n != 2)
	229	return -EINVAL;
	230	if (data[0]) {
	231	s->state &= ~data[0];
	232	s->state \|= (data[0] & data[1]);
	233	if ((data[0] >> 0) & 0xff)
	234	outb((s->state >> 0) & 0xff, dev->iobase + 0);
	235	if ((data[0] >> 8) & 0xff)
	236	outb((s->state >> 8) & 0xff, dev->iobase + 1);
	237	if ((data[0] >> 16) & 0xff)
	238	outb((s->state >> 16) & 0xff, dev->iobase + 2);
	239	if ((data[0] >> 24) & 0xff)
	240	outb((s->state >> 24) & 0xff, dev->iobase + 3);
	241	}
	242	data[1] = s->state;
	243
	244	return 2;
	245	}
	246
	247	COMEDI_INITCLEANUP(driver_poc);