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

/*
    comedi/drivers/fl512.c
    Anders Gnistrup <ex18@kalman.iau.dtu.dk>
*/

/*
Driver: fl512
Description: unknown
Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
Devices: [unknown] FL512 (fl512)
Status: unknown

Digital I/O is not supported.

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

#define DEBUG 0

#include "../comedidev.h"

#include <linux/delay.h>
#include <linux/ioport.h>

#define FL512_SIZE 16		/* the size of the used memory */
struct fl512_private {

	short ao_readback[2];
};

static const struct comedi_lrange range_fl512 = { 4, {
						      BIP_RANGE(0.5),
						      BIP_RANGE(1),
						      BIP_RANGE(5),
						      BIP_RANGE(10),
						      UNI_RANGE(1),
						      UNI_RANGE(5),
						      UNI_RANGE(10),
						      }
};

/*
 * fl512_ai_insn : this is the analog input function
 */
static int fl512_ai_insn(struct comedi_device *dev,
			 struct comedi_subdevice *s, struct comedi_insn *insn,
			 unsigned int *data)
{
	int n;
	unsigned int lo_byte, hi_byte;
	char chan = CR_CHAN(insn->chanspec);
	unsigned long iobase = dev->iobase;

	for (n = 0; n < insn->n; n++) {	/* sample n times on selected channel */
		/* XXX probably can move next step out of for() loop -- will
		 * make AI a little bit faster. */
		outb(chan, iobase + 2);	/* select chan */
		outb(0, iobase + 3);	/* start conversion */
		/* XXX should test "done" flag instead of delay */
		udelay(30);	/* sleep 30 usec */
		lo_byte = inb(iobase + 2);	/* low 8 byte */
		hi_byte = inb(iobase + 3) & 0xf; /* high 4 bit and mask */
		data[n] = lo_byte + (hi_byte << 8);
	}
	return n;
}

/*
 * fl512_ao_insn : used to write to a DA port n times
 */
static int fl512_ao_insn(struct comedi_device *dev,
			 struct comedi_subdevice *s, struct comedi_insn *insn,
			 unsigned int *data)
{
	struct fl512_private *devpriv = dev->private;
	int n;
	int chan = CR_CHAN(insn->chanspec);	/* get chan to write */
	unsigned long iobase = dev->iobase;	/* get base address  */

	for (n = 0; n < insn->n; n++) {	/* write n data set */
		/* write low byte   */
		outb(data[n] & 0x0ff, iobase + 4 + 2 * chan);
		/* write high byte  */
		outb((data[n] & 0xf00) >> 8, iobase + 4 + 2 * chan);
		inb(iobase + 4 + 2 * chan);	/* trig */

		devpriv->ao_readback[chan] = data[n];
	}
	return n;
}

/*
 * fl512_ao_insn_readback : used to read previous values written to
 * DA port
 */
static int fl512_ao_insn_readback(struct comedi_device *dev,
				  struct comedi_subdevice *s,
				  struct comedi_insn *insn, unsigned int *data)
{
	struct fl512_private *devpriv = dev->private;
	int n;
	int chan = CR_CHAN(insn->chanspec);

	for (n = 0; n < insn->n; n++)
		data[n] = devpriv->ao_readback[chan];

	return n;
}

static int fl512_attach(struct comedi_device *dev, struct comedi_devconfig *it)
{
	struct fl512_private *devpriv;
	unsigned long iobase;
	int ret;

	/* pointer to the subdevice: Analog in, Analog out,
	   (not made ->and Digital IO) */
	struct comedi_subdevice *s;

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

	devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
	if (!devpriv)
		return -ENOMEM;
	dev->private = devpriv;

#if DEBUG
	printk(KERN_DEBUG "malloc ok\n");
#endif

	ret = comedi_alloc_subdevices(dev, 2);
	if (ret)
		return ret;

	/*
	 * this if the definitions of the supdevices, 2 have been defined
	 */
	/* Analog indput */
	s = &dev->subdevices[0];
	/* define subdevice as Analog In */
	s->type = COMEDI_SUBD_AI;
	/* you can read it from userspace */
	s->subdev_flags = SDF_READABLE | SDF_GROUND;
	/* Number of Analog input channels */
	s->n_chan = 16;
	/* accept only 12 bits of data */
	s->maxdata = 0x0fff;
	/* device use one of the ranges */
	s->range_table = &range_fl512;
	/* function to call when read AD */
	s->insn_read = fl512_ai_insn;
	printk(KERN_INFO "comedi: fl512: subdevice 0 initialized\n");

	/* Analog output */
	s = &dev->subdevices[1];
	/* define subdevice as Analog OUT */
	s->type = COMEDI_SUBD_AO;
	/* you can write it from userspace */
	s->subdev_flags = SDF_WRITABLE;
	/* Number of Analog output channels */
	s->n_chan = 2;
	/* accept only 12 bits of data */
	s->maxdata = 0x0fff;
	/* device use one of the ranges */
	s->range_table = &range_fl512;
	/* function to call when write DA */
	s->insn_write = fl512_ao_insn;
	/* function to call when reading DA */
	s->insn_read = fl512_ao_insn_readback;
	printk(KERN_INFO "comedi: fl512: subdevice 1 initialized\n");

	return 1;
}

static void fl512_detach(struct comedi_device *dev)
{
	if (dev->iobase)
		release_region(dev->iobase, FL512_SIZE);
}

static struct comedi_driver fl512_driver = {
	.driver_name	= "fl512",
	.module		= THIS_MODULE,
	.attach		= fl512_attach,
	.detach		= fl512_detach,
};
module_comedi_driver(fl512_driver);

MODULE_AUTHOR("Comedi http://www.comedi.org");
MODULE_DESCRIPTION("Comedi low-level driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
9e27db79 AG	1	/*
	2	comedi/drivers/fl512.c
	3	Anders Gnistrup <ex18@kalman.iau.dtu.dk>
	4	*/
	5
	6	/*
	7	Driver: fl512
	8	Description: unknown
	9	Author: Anders Gnistrup <ex18@kalman.iau.dtu.dk>
	10	Devices: [unknown] FL512 (fl512)
	11	Status: unknown
	12
	13	Digital I/O is not supported.
	14
	15	Configuration options:
	16	[0] - I/O port base address
	17	*/
	18
	19	#define DEBUG 0
	20
	21	#include "../comedidev.h"
	22
	23	#include <linux/delay.h>
	24	#include <linux/ioport.h>
	25
	26	#define FL512_SIZE 16 /* the size of the used memory */
fa11f7a9 BP	27	struct fl512_private {
fa11f7a9 BP	28
790c5541	29	short ao_readback[2];
fa11f7a9 BP	30	};
fa11f7a9 BP	31
9ced1de6	32	static const struct comedi_lrange range_fl512 = { 4, {
0a85b6f0 MT	33	BIP_RANGE(0.5),
	34	BIP_RANGE(1),
	35	BIP_RANGE(5),
	36	BIP_RANGE(10),
	37	UNI_RANGE(1),
	38	UNI_RANGE(5),
	39	UNI_RANGE(10),
	40	}
9e27db79 AG	41	};
9e27db79 AG	42
9e27db79 AG	43	/*
	44	* fl512_ai_insn : this is the analog input function
	45	*/
da91b269	46	static int fl512_ai_insn(struct comedi_device *dev,
0a85b6f0 MT	47	struct comedi_subdevice s, struct comedi_insn insn,
0a85b6f0 MT	48	unsigned int *data)
9e27db79 AG	49	{
	50	int n;
	51	unsigned int lo_byte, hi_byte;
	52	char chan = CR_CHAN(insn->chanspec);
	53	unsigned long iobase = dev->iobase;
	54
	55	for (n = 0; n < insn->n; n++) { /* sample n times on selected channel */
27aa7320 BA	56	/* XXX probably can move next step out of for() loop -- will
27aa7320 BA	57	* make AI a little bit faster. */
9e27db79 AG	58	outb(chan, iobase + 2); /* select chan */
	59	outb(0, iobase + 3); /* start conversion */
	60	/* XXX should test "done" flag instead of delay */
5f74ea14	61	udelay(30); /* sleep 30 usec */
9e27db79	62	lo_byte = inb(iobase + 2); /* low 8 byte */
27aa7320	63	hi_byte = inb(iobase + 3) & 0xf; /* high 4 bit and mask */
9e27db79 AG	64	data[n] = lo_byte + (hi_byte << 8);
	65	}
	66	return n;
	67	}
	68
	69	/*
	70	* fl512_ao_insn : used to write to a DA port n times
	71	*/
da91b269	72	static int fl512_ao_insn(struct comedi_device *dev,
0a85b6f0 MT	73	struct comedi_subdevice s, struct comedi_insn insn,
0a85b6f0 MT	74	unsigned int *data)
9e27db79	75	{
9a1a6cf8	76	struct fl512_private *devpriv = dev->private;
9e27db79 AG	77	int n;
	78	int chan = CR_CHAN(insn->chanspec); /* get chan to write */
	79	unsigned long iobase = dev->iobase; /* get base address */
	80
	81	for (n = 0; n < insn->n; n++) { /* write n data set */
27aa7320 BA	82	/* write low byte */
	83	outb(data[n] & 0x0ff, iobase + 4 + 2 * chan);
	84	/* write high byte */
	85	outb((data[n] & 0xf00) >> 8, iobase + 4 + 2 * chan);
9e27db79 AG	86	inb(iobase + 4 + 2 * chan); /* trig */
	87
	88	devpriv->ao_readback[chan] = data[n];
	89	}
	90	return n;
	91	}
	92
	93	/*
	94	* fl512_ao_insn_readback : used to read previous values written to
	95	* DA port
	96	*/
da91b269	97	static int fl512_ao_insn_readback(struct comedi_device *dev,
0a85b6f0 MT	98	struct comedi_subdevice *s,
0a85b6f0 MT	99	struct comedi_insn insn, unsigned int data)
9e27db79	100	{
9a1a6cf8	101	struct fl512_private *devpriv = dev->private;
9e27db79 AG	102	int n;
	103	int chan = CR_CHAN(insn->chanspec);
	104
27aa7320	105	for (n = 0; n < insn->n; n++)
9e27db79	106	data[n] = devpriv->ao_readback[chan];
9e27db79 AG	107
	108	return n;
	109	}
	110
da91b269	111	static int fl512_attach(struct comedi_device dev, struct comedi_devconfig it)
9e27db79	112	{
9a1a6cf8	113	struct fl512_private *devpriv;
9e27db79	114	unsigned long iobase;
8b6c5694	115	int ret;
27aa7320 BA	116
	117	/* pointer to the subdevice: Analog in, Analog out,
	118	(not made ->and Digital IO) */
	119	struct comedi_subdevice *s;
9e27db79 AG	120
9e27db79 AG	121	iobase = it->options[0];
27aa7320	122	printk(KERN_INFO "comedi:%d fl512: 0x%04lx", dev->minor, iobase);
9e27db79	123	if (!request_region(iobase, FL512_SIZE, "fl512")) {
27aa7320	124	printk(KERN_WARNING " I/O port conflict\n");
9e27db79 AG	125	return -EIO;
	126	}
	127	dev->iobase = iobase;
	128	dev->board_name = "fl512";
9a1a6cf8	129
c34fa261 HS	130	devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
	131	if (!devpriv)
	132	return -ENOMEM;
	133	dev->private = devpriv;
9e27db79 AG	134
9e27db79 AG	135	#if DEBUG
27aa7320	136	printk(KERN_DEBUG "malloc ok\n");
9e27db79 AG	137	#endif
9e27db79 AG	138
8b6c5694 HS	139	ret = comedi_alloc_subdevices(dev, 2);
	140	if (ret)
	141	return ret;
9e27db79 AG	142
	143	/*
	144	* this if the definitions of the supdevices, 2 have been defined
	145	*/
	146	/* Analog indput */
6fc01d32	147	s = &dev->subdevices[0];
27aa7320 BA	148	/* define subdevice as Analog In */
	149	s->type = COMEDI_SUBD_AI;
	150	/* you can read it from userspace */
	151	s->subdev_flags = SDF_READABLE \| SDF_GROUND;
	152	/* Number of Analog input channels */
	153	s->n_chan = 16;
	154	/* accept only 12 bits of data */
	155	s->maxdata = 0x0fff;
	156	/* device use one of the ranges */
	157	s->range_table = &range_fl512;
	158	/* function to call when read AD */
	159	s->insn_read = fl512_ai_insn;
	160	printk(KERN_INFO "comedi: fl512: subdevice 0 initialized\n");
9e27db79 AG	161
9e27db79 AG	162	/* Analog output */
6fc01d32	163	s = &dev->subdevices[1];
27aa7320 BA	164	/* define subdevice as Analog OUT */
	165	s->type = COMEDI_SUBD_AO;
	166	/* you can write it from userspace */
	167	s->subdev_flags = SDF_WRITABLE;
	168	/* Number of Analog output channels */
	169	s->n_chan = 2;
	170	/* accept only 12 bits of data */
	171	s->maxdata = 0x0fff;
	172	/* device use one of the ranges */
	173	s->range_table = &range_fl512;
	174	/* function to call when write DA */
	175	s->insn_write = fl512_ao_insn;
	176	/* function to call when reading DA */
	177	s->insn_read = fl512_ao_insn_readback;
	178	printk(KERN_INFO "comedi: fl512: subdevice 1 initialized\n");
9e27db79 AG	179
	180	return 1;
	181	}
	182
484ecc95	183	static void fl512_detach(struct comedi_device *dev)
9e27db79 AG	184	{
	185	if (dev->iobase)
	186	release_region(dev->iobase, FL512_SIZE);
9e27db79	187	}
90f703d3	188
294f930d	189	static struct comedi_driver fl512_driver = {
a39eb906 HS	190	.driver_name = "fl512",
	191	.module = THIS_MODULE,
	192	.attach = fl512_attach,
	193	.detach = fl512_detach,
	194	};
294f930d	195	module_comedi_driver(fl512_driver);
a39eb906	196
90f703d3 AT	197	MODULE_AUTHOR("Comedi http://www.comedi.org");
	198	MODULE_DESCRIPTION("Comedi low-level driver");
	199	MODULE_LICENSE("GPL");