[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / comedi / drivers / dt2815.c

/*
   comedi/drivers/dt2815.c
   Hardware driver for Data Translation DT2815

   COMEDI - Linux Control and Measurement Device Interface
   Copyright (C) 1999 Anders Blomdell <anders.blomdell@control.lth.se>

   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: dt2815
Description: Data Translation DT2815
Author: ds
Status: mostly complete, untested
Devices: [Data Translation] DT2815 (dt2815)

I'm not sure anyone has ever tested this board.  If you have information
contrary, please update.

Configuration options:
  [0] - I/O port base base address
  [1] - IRQ (unused)
  [2] - Voltage unipolar/bipolar configuration
	0 == unipolar 5V  (0V -- +5V)
	1 == bipolar 5V  (-5V -- +5V)
  [3] - Current offset configuration
	0 == disabled  (0mA -- +32mAV)
	1 == enabled  (+4mA -- +20mAV)
  [4] - Firmware program configuration
	0 == program 1 (see manual table 5-4)
	1 == program 2 (see manual table 5-4)
	2 == program 3 (see manual table 5-4)
	3 == program 4 (see manual table 5-4)
  [5] - Analog output 0 range configuration
	0 == voltage
	1 == current
  [6] - Analog output 1 range configuration (same options)
  [7] - Analog output 2 range configuration (same options)
  [8] - Analog output 3 range configuration (same options)
  [9] - Analog output 4 range configuration (same options)
  [10] - Analog output 5 range configuration (same options)
  [11] - Analog output 6 range configuration (same options)
  [12] - Analog output 7 range configuration (same options)
*/

#include "../comedidev.h"

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

static const struct comedi_lrange
	range_dt2815_ao_32_current = {1, {RANGE_mA(0, 32)} };

static const struct comedi_lrange
	range_dt2815_ao_20_current = {1, {RANGE_mA(4, 20)} };

#define DT2815_SIZE 2

#define DT2815_DATA 0
#define DT2815_STATUS 1

static int dt2815_attach(struct comedi_device *dev,
			 struct comedi_devconfig *it);
static int dt2815_detach(struct comedi_device *dev);
static struct comedi_driver driver_dt2815 = {
	.driver_name = "dt2815",
	.module = THIS_MODULE,
	.attach = dt2815_attach,
	.detach = dt2815_detach,
};

static int __init driver_dt2815_init_module(void)
{
	return comedi_driver_register(&driver_dt2815);
}

static void __exit driver_dt2815_cleanup_module(void)
{
	comedi_driver_unregister(&driver_dt2815);
}

module_init(driver_dt2815_init_module);
module_exit(driver_dt2815_cleanup_module);

static void dt2815_free_resources(struct comedi_device *dev);

struct dt2815_private {

	const struct comedi_lrange *range_type_list[8];
	unsigned int ao_readback[8];
};

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

static int dt2815_wait_for_status(struct comedi_device *dev, int status)
{
	int i;

	for (i = 0; i < 100; i++) {
		if (inb(dev->iobase + DT2815_STATUS) == status)
			break;
	}
	return status;
}

static int dt2815_ao_insn_read(struct comedi_device *dev,
			       struct comedi_subdevice *s,
			       struct comedi_insn *insn, unsigned int *data)
{
	int i;
	int chan = CR_CHAN(insn->chanspec);

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

	return i;
}

static int dt2815_ao_insn(struct comedi_device *dev, struct comedi_subdevice *s,
			  struct comedi_insn *insn, unsigned int *data)
{
	int i;
	int chan = CR_CHAN(insn->chanspec);
	unsigned int status;
	unsigned int lo, hi;

	for (i = 0; i < insn->n; i++) {
		lo = ((data[i] & 0x0f) << 4) | (chan << 1) | 0x01;
		hi = (data[i] & 0xff0) >> 4;

		status = dt2815_wait_for_status(dev, 0x00);
		if (status != 0) {
			printk(KERN_WARNING "dt2815: failed to write low byte "
			       "on %d reason %x\n", chan, status);
			return -EBUSY;
		}

		outb(lo, dev->iobase + DT2815_DATA);

		status = dt2815_wait_for_status(dev, 0x10);
		if (status != 0x10) {
			printk(KERN_WARNING "dt2815: failed to write high byte "
			       "on %d reason %x\n", chan, status);
			return -EBUSY;
		}
		devpriv->ao_readback[chan] = data[i];
	}
	return i;
}

/*
  options[0]   Board base address
  options[1]   IRQ (not applicable)
  options[2]   Voltage unipolar/bipolar configuration
		0 == unipolar 5V  (0V -- +5V)
		1 == bipolar 5V  (-5V -- +5V)
  options[3]   Current offset configuration
		0 == disabled  (0mA -- +32mAV)
		1 == enabled  (+4mA -- +20mAV)
  options[4]   Firmware program configuration
		0 == program 1 (see manual table 5-4)
		1 == program 2 (see manual table 5-4)
		2 == program 3 (see manual table 5-4)
		3 == program 4 (see manual table 5-4)
  options[5]   Analog output 0 range configuration
		0 == voltage
		1 == current
  options[6]   Analog output 1 range configuration
  ...
  options[12]   Analog output 7 range configuration
		0 == voltage
		1 == current
 */

static int dt2815_attach(struct comedi_device *dev, struct comedi_devconfig *it)
{
	struct comedi_subdevice *s;
	int i;
	const struct comedi_lrange *current_range_type, *voltage_range_type;
	unsigned long iobase;

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

	dev->iobase = iobase;
	dev->board_name = "dt2815";

	if (alloc_subdevices(dev, 1) < 0)
		return -ENOMEM;
	if (alloc_private(dev, sizeof(struct dt2815_private)) < 0)
		return -ENOMEM;

	s = dev->subdevices;
	/* ao subdevice */
	s->type = COMEDI_SUBD_AO;
	s->subdev_flags = SDF_WRITABLE;
	s->maxdata = 0xfff;
	s->n_chan = 8;
	s->insn_write = dt2815_ao_insn;
	s->insn_read = dt2815_ao_insn_read;
	s->range_table_list = devpriv->range_type_list;

	current_range_type = (it->options[3])
	    ? &range_dt2815_ao_20_current : &range_dt2815_ao_32_current;
	voltage_range_type = (it->options[2])
	    ? &range_bipolar5 : &range_unipolar5;
	for (i = 0; i < 8; i++) {
		devpriv->range_type_list[i] = (it->options[5 + i])
		    ? current_range_type : voltage_range_type;
	}

	/* Init the 2815 */
	outb(0x00, dev->iobase + DT2815_STATUS);
	for (i = 0; i < 100; i++) {
		/* This is incredibly slow (approx 20 ms) */
		unsigned int status;

		udelay(1000);
		status = inb(dev->iobase + DT2815_STATUS);
		if (status == 4) {
			unsigned int program;
			program = (it->options[4] & 0x3) << 3 | 0x7;
			outb(program, dev->iobase + DT2815_DATA);
			printk(KERN_INFO ", program: 0x%x (@t=%d)\n",
			       program, i);
			break;
		} else if (status != 0x00) {
			printk(KERN_WARNING "dt2815: unexpected status 0x%x "
			       "(@t=%d)\n", status, i);
			if (status & 0x60)
				outb(0x00, dev->iobase + DT2815_STATUS);
		}
	}

	return 0;
}

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

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

	dt2815_free_resources(dev);

	return 0;
}

MODULE_AUTHOR("Comedi http://www.comedi.org");
MODULE_DESCRIPTION("Comedi low-level driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
d6a929b7 DS	1	/*
	2	comedi/drivers/dt2815.c
	3	Hardware driver for Data Translation DT2815
	4
	5	COMEDI - Linux Control and Measurement Device Interface
	6	Copyright (C) 1999 Anders Blomdell <anders.blomdell@control.lth.se>
	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	Driver: dt2815
	25	Description: Data Translation DT2815
	26	Author: ds
	27	Status: mostly complete, untested
	28	Devices: [Data Translation] DT2815 (dt2815)
	29
	30	I'm not sure anyone has ever tested this board. If you have information
	31	contrary, please update.
	32
	33	Configuration options:
	34	[0] - I/O port base base address
	35	[1] - IRQ (unused)
	36	[2] - Voltage unipolar/bipolar configuration
0acc516a BA	37	0 == unipolar 5V (0V -- +5V)
0acc516a BA	38	1 == bipolar 5V (-5V -- +5V)
d6a929b7	39	[3] - Current offset configuration
0acc516a BA	40	0 == disabled (0mA -- +32mAV)
0acc516a BA	41	1 == enabled (+4mA -- +20mAV)
d6a929b7	42	[4] - Firmware program configuration
0acc516a BA	43	0 == program 1 (see manual table 5-4)
	44	1 == program 2 (see manual table 5-4)
	45	2 == program 3 (see manual table 5-4)
	46	3 == program 4 (see manual table 5-4)
d6a929b7	47	[5] - Analog output 0 range configuration
0acc516a BA	48	0 == voltage
0acc516a BA	49	1 == current
d6a929b7 DS	50	[6] - Analog output 1 range configuration (same options)
	51	[7] - Analog output 2 range configuration (same options)
	52	[8] - Analog output 3 range configuration (same options)
	53	[9] - Analog output 4 range configuration (same options)
	54	[10] - Analog output 5 range configuration (same options)
	55	[11] - Analog output 6 range configuration (same options)
	56	[12] - Analog output 7 range configuration (same options)
	57	*/
	58
	59	#include "../comedidev.h"
	60
	61	#include <linux/ioport.h>
	62	#include <linux/delay.h>
	63
0acc516a BA	64	static const struct comedi_lrange
0acc516a BA	65	range_dt2815_ao_32_current = {1, {RANGE_mA(0, 32)} };
0a85b6f0	66
0acc516a BA	67	static const struct comedi_lrange
0acc516a BA	68	range_dt2815_ao_20_current = {1, {RANGE_mA(4, 20)} };
d6a929b7 DS	69
	70	#define DT2815_SIZE 2
	71
	72	#define DT2815_DATA 0
	73	#define DT2815_STATUS 1
	74
0a85b6f0 MT	75	static int dt2815_attach(struct comedi_device *dev,
0a85b6f0 MT	76	struct comedi_devconfig *it);
da91b269	77	static int dt2815_detach(struct comedi_device *dev);
139dfbdf	78	static struct comedi_driver driver_dt2815 = {
68c3dbff BP	79	.driver_name = "dt2815",
	80	.module = THIS_MODULE,
	81	.attach = dt2815_attach,
	82	.detach = dt2815_detach,
d6a929b7 DS	83	};
d6a929b7 DS	84
7114a280 AT	85	static int __init driver_dt2815_init_module(void)
	86	{
	87	return comedi_driver_register(&driver_dt2815);
	88	}
	89
	90	static void __exit driver_dt2815_cleanup_module(void)
	91	{
	92	comedi_driver_unregister(&driver_dt2815);
	93	}
	94
	95	module_init(driver_dt2815_init_module);
	96	module_exit(driver_dt2815_cleanup_module);
d6a929b7	97
da91b269	98	static void dt2815_free_resources(struct comedi_device *dev);
d6a929b7	99
0b011a6f BP	100	struct dt2815_private {
0b011a6f BP	101
9ced1de6	102	const struct comedi_lrange *range_type_list[8];
790c5541	103	unsigned int ao_readback[8];
0b011a6f BP	104	};
0b011a6f BP	105
0b011a6f	106	#define devpriv ((struct dt2815_private *)dev->private)
d6a929b7	107
da91b269	108	static int dt2815_wait_for_status(struct comedi_device *dev, int status)
d6a929b7 DS	109	{
	110	int i;
	111
	112	for (i = 0; i < 100; i++) {
	113	if (inb(dev->iobase + DT2815_STATUS) == status)
	114	break;
	115	}
	116	return status;
	117	}
	118
0a85b6f0 MT	119	static int dt2815_ao_insn_read(struct comedi_device *dev,
	120	struct comedi_subdevice *s,
	121	struct comedi_insn insn, unsigned int data)
d6a929b7 DS	122	{
	123	int i;
	124	int chan = CR_CHAN(insn->chanspec);
	125
0acc516a	126	for (i = 0; i < insn->n; i++)
d6a929b7	127	data[i] = devpriv->ao_readback[chan];
d6a929b7 DS	128
	129	return i;
	130	}
	131
da91b269	132	static int dt2815_ao_insn(struct comedi_device dev, struct comedi_subdevice s,
0a85b6f0	133	struct comedi_insn insn, unsigned int data)
d6a929b7 DS	134	{
	135	int i;
	136	int chan = CR_CHAN(insn->chanspec);
	137	unsigned int status;
	138	unsigned int lo, hi;
	139
	140	for (i = 0; i < insn->n; i++) {
	141	lo = ((data[i] & 0x0f) << 4) \| (chan << 1) \| 0x01;
	142	hi = (data[i] & 0xff0) >> 4;
	143
	144	status = dt2815_wait_for_status(dev, 0x00);
	145	if (status != 0) {
0acc516a BA	146	printk(KERN_WARNING "dt2815: failed to write low byte "
0acc516a BA	147	"on %d reason %x\n", chan, status);
d6a929b7 DS	148	return -EBUSY;
	149	}
	150
	151	outb(lo, dev->iobase + DT2815_DATA);
	152
	153	status = dt2815_wait_for_status(dev, 0x10);
	154	if (status != 0x10) {
0acc516a BA	155	printk(KERN_WARNING "dt2815: failed to write high byte "
0acc516a BA	156	"on %d reason %x\n", chan, status);
d6a929b7 DS	157	return -EBUSY;
	158	}
	159	devpriv->ao_readback[chan] = data[i];
	160	}
	161	return i;
	162	}
	163
	164	/*
	165	options[0] Board base address
	166	options[1] IRQ (not applicable)
	167	options[2] Voltage unipolar/bipolar configuration
0acc516a BA	168	0 == unipolar 5V (0V -- +5V)
0acc516a BA	169	1 == bipolar 5V (-5V -- +5V)
d6a929b7	170	options[3] Current offset configuration
0acc516a BA	171	0 == disabled (0mA -- +32mAV)
0acc516a BA	172	1 == enabled (+4mA -- +20mAV)
d6a929b7	173	options[4] Firmware program configuration
0acc516a BA	174	0 == program 1 (see manual table 5-4)
	175	1 == program 2 (see manual table 5-4)
	176	2 == program 3 (see manual table 5-4)
	177	3 == program 4 (see manual table 5-4)
d6a929b7	178	options[5] Analog output 0 range configuration
0acc516a BA	179	0 == voltage
0acc516a BA	180	1 == current
d6a929b7 DS	181	options[6] Analog output 1 range configuration
	182	...
	183	options[12] Analog output 7 range configuration
0acc516a BA	184	0 == voltage
0acc516a BA	185	1 == current
d6a929b7 DS	186	*/
d6a929b7 DS	187
da91b269	188	static int dt2815_attach(struct comedi_device dev, struct comedi_devconfig it)
d6a929b7	189	{
34c43922	190	struct comedi_subdevice *s;
d6a929b7	191	int i;
9ced1de6	192	const struct comedi_lrange current_range_type, voltage_range_type;
d6a929b7 DS	193	unsigned long iobase;
	194
	195	iobase = it->options[0];
0acc516a	196	printk(KERN_INFO "comedi%d: dt2815: 0x%04lx ", dev->minor, iobase);
d6a929b7	197	if (!request_region(iobase, DT2815_SIZE, "dt2815")) {
0acc516a	198	printk(KERN_WARNING "I/O port conflict\n");
d6a929b7 DS	199	return -EIO;
	200	}
	201
	202	dev->iobase = iobase;
	203	dev->board_name = "dt2815";
	204
	205	if (alloc_subdevices(dev, 1) < 0)
	206	return -ENOMEM;
0b011a6f	207	if (alloc_private(dev, sizeof(struct dt2815_private)) < 0)
d6a929b7 DS	208	return -ENOMEM;
	209
	210	s = dev->subdevices;
	211	/* ao subdevice */
	212	s->type = COMEDI_SUBD_AO;
	213	s->subdev_flags = SDF_WRITABLE;
	214	s->maxdata = 0xfff;
	215	s->n_chan = 8;
	216	s->insn_write = dt2815_ao_insn;
	217	s->insn_read = dt2815_ao_insn_read;
	218	s->range_table_list = devpriv->range_type_list;
	219
	220	current_range_type = (it->options[3])
0a85b6f0	221	? &range_dt2815_ao_20_current : &range_dt2815_ao_32_current;
d6a929b7	222	voltage_range_type = (it->options[2])
0a85b6f0	223	? &range_bipolar5 : &range_unipolar5;
d6a929b7 DS	224	for (i = 0; i < 8; i++) {
d6a929b7 DS	225	devpriv->range_type_list[i] = (it->options[5 + i])
0a85b6f0	226	? current_range_type : voltage_range_type;
d6a929b7 DS	227	}
	228
	229	/* Init the 2815 */
	230	outb(0x00, dev->iobase + DT2815_STATUS);
	231	for (i = 0; i < 100; i++) {
	232	/* This is incredibly slow (approx 20 ms) */
	233	unsigned int status;
	234
5f74ea14	235	udelay(1000);
d6a929b7 DS	236	status = inb(dev->iobase + DT2815_STATUS);
	237	if (status == 4) {
	238	unsigned int program;
	239	program = (it->options[4] & 0x3) << 3 \| 0x7;
	240	outb(program, dev->iobase + DT2815_DATA);
0acc516a BA	241	printk(KERN_INFO ", program: 0x%x (@t=%d)\n",
0acc516a BA	242	program, i);
d6a929b7 DS	243	break;
d6a929b7 DS	244	} else if (status != 0x00) {
0acc516a BA	245	printk(KERN_WARNING "dt2815: unexpected status 0x%x "
	246	"(@t=%d)\n", status, i);
	247	if (status & 0x60)
d6a929b7	248	outb(0x00, dev->iobase + DT2815_STATUS);
d6a929b7 DS	249	}
	250	}
	251
d6a929b7 DS	252	return 0;
	253	}
	254
da91b269	255	static void dt2815_free_resources(struct comedi_device *dev)
d6a929b7 DS	256	{
	257	if (dev->iobase)
	258	release_region(dev->iobase, DT2815_SIZE);
	259	}
	260
da91b269	261	static int dt2815_detach(struct comedi_device *dev)
d6a929b7	262	{
0acc516a	263	printk(KERN_INFO "comedi%d: dt2815: remove\n", dev->minor);
d6a929b7 DS	264
	265	dt2815_free_resources(dev);
	266
	267	return 0;
	268	}
90f703d3 AT	269
	270	MODULE_AUTHOR("Comedi http://www.comedi.org");
	271	MODULE_DESCRIPTION("Comedi low-level driver");
	272	MODULE_LICENSE("GPL");