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

/*
   comedi/drivers/rti802.c
   Hardware driver for Analog Devices RTI-802 board

   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: rti802
Description: Analog Devices RTI-802
Author: Anders Blomdell <anders.blomdell@control.lth.se>
Devices: [Analog Devices] RTI-802 (rti802)
Status: works

Configuration Options:
    [0] - i/o base
    [1] - unused
    [2] - dac#0  0=two's comp, 1=straight
    [3] - dac#0  0=bipolar, 1=unipolar
    [4] - dac#1 ...
    ...
    [17] - dac#7 ...
*/

#include "../comedidev.h"

#include <linux/ioport.h>

#define RTI802_SIZE 4

#define RTI802_SELECT 0
#define RTI802_DATALOW 1
#define RTI802_DATAHIGH 2

static int rti802_attach(struct comedi_device *dev,
			 struct comedi_devconfig *it);
static int rti802_detach(struct comedi_device *dev);
static struct comedi_driver driver_rti802 = {
	.driver_name = "rti802",
	.module = THIS_MODULE,
	.attach = rti802_attach,
	.detach = rti802_detach,
};

static int __init driver_rti802_init_module(void)
{
	return comedi_driver_register(&driver_rti802);
}

static void __exit driver_rti802_cleanup_module(void)
{
	comedi_driver_unregister(&driver_rti802);
}

module_init(driver_rti802_init_module);
module_exit(driver_rti802_cleanup_module);

struct rti802_private {
	enum {
		dac_2comp, dac_straight
	} dac_coding[8];
	const struct comedi_lrange *range_type_list[8];
	unsigned int ao_readback[8];
};

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

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

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

	return i;
}

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

	for (i = 0; i < insn->n; i++) {
		d = devpriv->ao_readback[chan] = data[i];
		if (devpriv->dac_coding[chan] == dac_2comp)
			d ^= 0x800;
		outb(chan, dev->iobase + RTI802_SELECT);
		outb(d & 0xff, dev->iobase + RTI802_DATALOW);
		outb(d >> 8, dev->iobase + RTI802_DATAHIGH);
	}
	return i;
}

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

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

	dev->board_name = "rti802";

	if (alloc_subdevices(dev, 1) < 0
	    || alloc_private(dev, sizeof(struct rti802_private))) {
		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_read = rti802_ao_insn_read;
	s->insn_write = rti802_ao_insn_write;
	s->range_table_list = devpriv->range_type_list;

	for (i = 0; i < 8; i++) {
		devpriv->dac_coding[i] = (it->options[3 + 2 * i])
		    ? (dac_straight)
		    : (dac_2comp);
		devpriv->range_type_list[i] = (it->options[2 + 2 * i])
		    ? &range_unipolar10 : &range_bipolar10;
	}

	return 0;
}

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

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

	return 0;
}

MODULE_AUTHOR("Comedi http://www.comedi.org");
MODULE_DESCRIPTION("Comedi low-level driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
a7b5a2c4 AB	1	/*
	2	comedi/drivers/rti802.c
	3	Hardware driver for Analog Devices RTI-802 board
	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: rti802
	25	Description: Analog Devices RTI-802
	26	Author: Anders Blomdell <anders.blomdell@control.lth.se>
	27	Devices: [Analog Devices] RTI-802 (rti802)
	28	Status: works
	29
	30	Configuration Options:
	31	[0] - i/o base
	32	[1] - unused
	33	[2] - dac#0 0=two's comp, 1=straight
	34	[3] - dac#0 0=bipolar, 1=unipolar
	35	[4] - dac#1 ...
	36	...
	37	[17] - dac#7 ...
	38	*/
	39
	40	#include "../comedidev.h"
	41
	42	#include <linux/ioport.h>
	43
	44	#define RTI802_SIZE 4
	45
	46	#define RTI802_SELECT 0
	47	#define RTI802_DATALOW 1
	48	#define RTI802_DATAHIGH 2
	49
0a85b6f0 MT	50	static int rti802_attach(struct comedi_device *dev,
0a85b6f0 MT	51	struct comedi_devconfig *it);
da91b269	52	static int rti802_detach(struct comedi_device *dev);
139dfbdf	53	static struct comedi_driver driver_rti802 = {
68c3dbff BP	54	.driver_name = "rti802",
	55	.module = THIS_MODULE,
	56	.attach = rti802_attach,
	57	.detach = rti802_detach,
a7b5a2c4 AB	58	};
a7b5a2c4 AB	59
7114a280 AT	60	static int __init driver_rti802_init_module(void)
	61	{
	62	return comedi_driver_register(&driver_rti802);
	63	}
	64
	65	static void __exit driver_rti802_cleanup_module(void)
	66	{
	67	comedi_driver_unregister(&driver_rti802);
	68	}
	69
	70	module_init(driver_rti802_init_module);
	71	module_exit(driver_rti802_cleanup_module);
a7b5a2c4	72
201007e8	73	struct rti802_private {
a7b5a2c4 AB	74	enum {
	75	dac_2comp, dac_straight
	76	} dac_coding[8];
9ced1de6	77	const struct comedi_lrange *range_type_list[8];
790c5541	78	unsigned int ao_readback[8];
201007e8	79	};
a7b5a2c4	80
201007e8	81	#define devpriv ((struct rti802_private *)dev->private)
a7b5a2c4	82
0a85b6f0 MT	83	static int rti802_ao_insn_read(struct comedi_device *dev,
	84	struct comedi_subdevice *s,
	85	struct comedi_insn insn, unsigned int data)
a7b5a2c4 AB	86	{
	87	int i;
	88
	89	for (i = 0; i < insn->n; i++)
	90	data[i] = devpriv->ao_readback[CR_CHAN(insn->chanspec)];
	91
	92	return i;
	93	}
	94
0a85b6f0 MT	95	static int rti802_ao_insn_write(struct comedi_device *dev,
	96	struct comedi_subdevice *s,
	97	struct comedi_insn insn, unsigned int data)
a7b5a2c4 AB	98	{
	99	int i, d;
	100	int chan = CR_CHAN(insn->chanspec);
	101
	102	for (i = 0; i < insn->n; i++) {
	103	d = devpriv->ao_readback[chan] = data[i];
	104	if (devpriv->dac_coding[chan] == dac_2comp)
	105	d ^= 0x800;
	106	outb(chan, dev->iobase + RTI802_SELECT);
	107	outb(d & 0xff, dev->iobase + RTI802_DATALOW);
	108	outb(d >> 8, dev->iobase + RTI802_DATAHIGH);
	109	}
	110	return i;
	111	}
	112
da91b269	113	static int rti802_attach(struct comedi_device dev, struct comedi_devconfig it)
a7b5a2c4	114	{
34c43922	115	struct comedi_subdevice *s;
a7b5a2c4 AB	116	int i;
	117	unsigned long iobase;
	118
	119	iobase = it->options[0];
83c41dab	120	printk(KERN_INFO "comedi%d: rti802: 0x%04lx ", dev->minor, iobase);
a7b5a2c4	121	if (!request_region(iobase, RTI802_SIZE, "rti802")) {
83c41dab	122	printk(KERN_WARNING "I/O port conflict\n");
a7b5a2c4 AB	123	return -EIO;
	124	}
	125	dev->iobase = iobase;
	126
	127	dev->board_name = "rti802";
	128
	129	if (alloc_subdevices(dev, 1) < 0
0a85b6f0	130	\|\| alloc_private(dev, sizeof(struct rti802_private))) {
a7b5a2c4 AB	131	return -ENOMEM;
	132	}
	133
	134	s = dev->subdevices;
	135	/* ao subdevice */
	136	s->type = COMEDI_SUBD_AO;
	137	s->subdev_flags = SDF_WRITABLE;
	138	s->maxdata = 0xfff;
	139	s->n_chan = 8;
	140	s->insn_read = rti802_ao_insn_read;
	141	s->insn_write = rti802_ao_insn_write;
	142	s->range_table_list = devpriv->range_type_list;
	143
	144	for (i = 0; i < 8; i++) {
	145	devpriv->dac_coding[i] = (it->options[3 + 2 * i])
0a85b6f0 MT	146	? (dac_straight)
0a85b6f0 MT	147	: (dac_2comp);
a7b5a2c4	148	devpriv->range_type_list[i] = (it->options[2 + 2 * i])
0a85b6f0	149	? &range_unipolar10 : &range_bipolar10;
a7b5a2c4 AB	150	}
a7b5a2c4 AB	151
a7b5a2c4 AB	152	return 0;
	153	}
	154
da91b269	155	static int rti802_detach(struct comedi_device *dev)
a7b5a2c4	156	{
83c41dab	157	printk(KERN_INFO "comedi%d: rti802: remove\n", dev->minor);
a7b5a2c4 AB	158
	159	if (dev->iobase)
	160	release_region(dev->iobase, RTI802_SIZE);
	161
	162	return 0;
	163	}
90f703d3 AT	164
	165	MODULE_AUTHOR("Comedi http://www.comedi.org");
	166	MODULE_DESCRIPTION("Comedi low-level driver");
	167	MODULE_LICENSE("GPL");