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

/*
    module/range.c
    comedi routines for voltage ranges

    COMEDI - Linux Control and Measurement Device Interface
    Copyright (C) 1997-8 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.

*/

#include <linux/uaccess.h>
#include "comedidev.h"
#include "internal.h"

const struct comedi_lrange range_bipolar10 = { 1, {BIP_RANGE(10)} };
EXPORT_SYMBOL(range_bipolar10);
const struct comedi_lrange range_bipolar5 = { 1, {BIP_RANGE(5)} };
EXPORT_SYMBOL(range_bipolar5);
const struct comedi_lrange range_bipolar2_5 = { 1, {BIP_RANGE(2.5)} };
EXPORT_SYMBOL(range_bipolar2_5);
const struct comedi_lrange range_unipolar10 = { 1, {UNI_RANGE(10)} };
EXPORT_SYMBOL(range_unipolar10);
const struct comedi_lrange range_unipolar5 = { 1, {UNI_RANGE(5)} };
EXPORT_SYMBOL(range_unipolar5);
const struct comedi_lrange range_unknown = { 1, {{0, 1000000, UNIT_none} } };
EXPORT_SYMBOL(range_unknown);

/*
	COMEDI_RANGEINFO
	range information ioctl

	arg:
		pointer to rangeinfo structure

	reads:
		range info structure

	writes:
		n struct comedi_krange structures to rangeinfo->range_ptr
*/
int do_rangeinfo_ioctl(struct comedi_device *dev,
		       struct comedi_rangeinfo __user *arg)
{
	struct comedi_rangeinfo it;
	int subd, chan;
	const struct comedi_lrange *lr;
	struct comedi_subdevice *s;

	if (copy_from_user(&it, arg, sizeof(struct comedi_rangeinfo)))
		return -EFAULT;
	subd = (it.range_type >> 24) & 0xf;
	chan = (it.range_type >> 16) & 0xff;

	if (!dev->attached)
		return -EINVAL;
	if (subd >= dev->n_subdevices)
		return -EINVAL;
	s = dev->subdevices + subd;
	if (s->range_table) {
		lr = s->range_table;
	} else if (s->range_table_list) {
		if (chan >= s->n_chan)
			return -EINVAL;
		lr = s->range_table_list[chan];
	} else {
		return -EINVAL;
	}

	if (RANGE_LENGTH(it.range_type) != lr->length) {
		DPRINTK("wrong length %d should be %d (0x%08x)\n",
			RANGE_LENGTH(it.range_type), lr->length, it.range_type);
		return -EINVAL;
	}

	if (copy_to_user(it.range_ptr, lr->range,
			 sizeof(struct comedi_krange) * lr->length))
		return -EFAULT;

	return 0;
}

static int aref_invalid(struct comedi_subdevice *s, unsigned int chanspec)
{
	unsigned int aref;

	/*  disable reporting invalid arefs... maybe someday */
	return 0;

	aref = CR_AREF(chanspec);
	switch (aref) {
	case AREF_DIFF:
		if (s->subdev_flags & SDF_DIFF)
			return 0;
		break;
	case AREF_COMMON:
		if (s->subdev_flags & SDF_COMMON)
			return 0;
		break;
	case AREF_GROUND:
		if (s->subdev_flags & SDF_GROUND)
			return 0;
		break;
	case AREF_OTHER:
		if (s->subdev_flags & SDF_OTHER)
			return 0;
		break;
	default:
		break;
	}
	DPRINTK("subdevice does not support aref %i", aref);
	return 1;
}

/*
   This function checks each element in a channel/gain list to make
   make sure it is valid.
*/
int comedi_check_chanlist(struct comedi_subdevice *s, int n,
			  unsigned int *chanlist)
{
	int i;
	int chan;

	if (s->range_table) {
		for (i = 0; i < n; i++)
			if (CR_CHAN(chanlist[i]) >= s->n_chan ||
			    CR_RANGE(chanlist[i]) >= s->range_table->length
			    || aref_invalid(s, chanlist[i])) {
				printk(KERN_ERR "bad chanlist[%d]=0x%08x "
				       "in_chan=%d range length=%d\n", i,
				       chanlist[i], s->n_chan,
				       s->range_table->length);
				return -EINVAL;
			}
	} else if (s->range_table_list) {
		for (i = 0; i < n; i++) {
			chan = CR_CHAN(chanlist[i]);
			if (chan >= s->n_chan ||
			    CR_RANGE(chanlist[i]) >=
			    s->range_table_list[chan]->length
			    || aref_invalid(s, chanlist[i])) {
				printk(KERN_ERR "bad chanlist[%d]=0x%08x\n",
				       i, chanlist[i]);
				return -EINVAL;
			}
		}
	} else {
		printk(KERN_ERR "comedi: (bug) no range type list!\n");
		return -EINVAL;
	}
	return 0;
}
EXPORT_SYMBOL(comedi_check_chanlist);
Commit	Line	Data
ed9eccbe DS	1	/*
	2	module/range.c
	3	comedi routines for voltage ranges
	4
	5	COMEDI - Linux Control and Measurement Device Interface
	6	Copyright (C) 1997-8 David A. Schleef <ds@schleef.org>
	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
ecfe20db	24	#include <linux/uaccess.h>
3b6b25b5 GKH	25	#include "comedidev.h"
3b6b25b5 GKH	26	#include "internal.h"
ed9eccbe	27
9ced1de6	28	const struct comedi_lrange range_bipolar10 = { 1, {BIP_RANGE(10)} };
e4231517	29	EXPORT_SYMBOL(range_bipolar10);
f0f29184	30	const struct comedi_lrange range_bipolar5 = { 1, {BIP_RANGE(5)} };
e4231517	31	EXPORT_SYMBOL(range_bipolar5);
f0f29184	32	const struct comedi_lrange range_bipolar2_5 = { 1, {BIP_RANGE(2.5)} };
e4231517	33	EXPORT_SYMBOL(range_bipolar2_5);
f0f29184	34	const struct comedi_lrange range_unipolar10 = { 1, {UNI_RANGE(10)} };
e4231517	35	EXPORT_SYMBOL(range_unipolar10);
f0f29184	36	const struct comedi_lrange range_unipolar5 = { 1, {UNI_RANGE(5)} };
e4231517	37	EXPORT_SYMBOL(range_unipolar5);
f0f29184	38	const struct comedi_lrange range_unknown = { 1, {{0, 1000000, UNIT_none} } };
e4231517	39	EXPORT_SYMBOL(range_unknown);
ed9eccbe DS	40
ed9eccbe DS	41	/*
356cdbcb	42	COMEDI_RANGEINFO
ed9eccbe DS	43	range information ioctl
	44
	45	arg:
	46	pointer to rangeinfo structure
	47
	48	reads:
	49	range info structure
	50
	51	writes:
1f6325d6	52	n struct comedi_krange structures to rangeinfo->range_ptr
ed9eccbe	53	*/
3b6b25b5 GKH	54	int do_rangeinfo_ioctl(struct comedi_device *dev,
3b6b25b5 GKH	55	struct comedi_rangeinfo __user *arg)
ed9eccbe	56	{
d0a353f6	57	struct comedi_rangeinfo it;
ed9eccbe	58	int subd, chan;
9ced1de6	59	const struct comedi_lrange *lr;
34c43922	60	struct comedi_subdevice *s;
ed9eccbe	61
d0a353f6	62	if (copy_from_user(&it, arg, sizeof(struct comedi_rangeinfo)))
ed9eccbe DS	63	return -EFAULT;
	64	subd = (it.range_type >> 24) & 0xf;
	65	chan = (it.range_type >> 16) & 0xff;
	66
	67	if (!dev->attached)
	68	return -EINVAL;
	69	if (subd >= dev->n_subdevices)
	70	return -EINVAL;
	71	s = dev->subdevices + subd;
	72	if (s->range_table) {
	73	lr = s->range_table;
	74	} else if (s->range_table_list) {
	75	if (chan >= s->n_chan)
	76	return -EINVAL;
	77	lr = s->range_table_list[chan];
	78	} else {
	79	return -EINVAL;
	80	}
	81
	82	if (RANGE_LENGTH(it.range_type) != lr->length) {
	83	DPRINTK("wrong length %d should be %d (0x%08x)\n",
	84	RANGE_LENGTH(it.range_type), lr->length, it.range_type);
	85	return -EINVAL;
	86	}
	87
	88	if (copy_to_user(it.range_ptr, lr->range,
0a85b6f0	89	sizeof(struct comedi_krange) * lr->length))
ed9eccbe DS	90	return -EFAULT;
	91
	92	return 0;
	93	}
	94
34c43922	95	static int aref_invalid(struct comedi_subdevice *s, unsigned int chanspec)
ed9eccbe DS	96	{
	97	unsigned int aref;
	98
b6c77757	99	/* disable reporting invalid arefs... maybe someday */
ed9eccbe DS	100	return 0;
	101
	102	aref = CR_AREF(chanspec);
	103	switch (aref) {
	104	case AREF_DIFF:
	105	if (s->subdev_flags & SDF_DIFF)
	106	return 0;
	107	break;
	108	case AREF_COMMON:
	109	if (s->subdev_flags & SDF_COMMON)
	110	return 0;
	111	break;
	112	case AREF_GROUND:
	113	if (s->subdev_flags & SDF_GROUND)
	114	return 0;
	115	break;
	116	case AREF_OTHER:
	117	if (s->subdev_flags & SDF_OTHER)
	118	return 0;
	119	break;
	120	default:
	121	break;
	122	}
	123	DPRINTK("subdevice does not support aref %i", aref);
	124	return 1;
	125	}
	126
	127	/*
	128	This function checks each element in a channel/gain list to make
	129	make sure it is valid.
	130	*/
0fd0ca75 GKH	131	int comedi_check_chanlist(struct comedi_subdevice *s, int n,
0fd0ca75 GKH	132	unsigned int *chanlist)
ed9eccbe DS	133	{
	134	int i;
	135	int chan;
	136
	137	if (s->range_table) {
	138	for (i = 0; i < n; i++)
	139	if (CR_CHAN(chanlist[i]) >= s->n_chan \|\|
0a85b6f0 MT	140	CR_RANGE(chanlist[i]) >= s->range_table->length
0a85b6f0 MT	141	\|\| aref_invalid(s, chanlist[i])) {
ecfe20db GKH	142	printk(KERN_ERR "bad chanlist[%d]=0x%08x "
	143	"in_chan=%d range length=%d\n", i,
	144	chanlist[i], s->n_chan,
	145	s->range_table->length);
ed9eccbe DS	146	return -EINVAL;
	147	}
	148	} else if (s->range_table_list) {
	149	for (i = 0; i < n; i++) {
	150	chan = CR_CHAN(chanlist[i]);
	151	if (chan >= s->n_chan \|\|
0a85b6f0 MT	152	CR_RANGE(chanlist[i]) >=
	153	s->range_table_list[chan]->length
	154	\|\| aref_invalid(s, chanlist[i])) {
ecfe20db GKH	155	printk(KERN_ERR "bad chanlist[%d]=0x%08x\n",
ecfe20db GKH	156	i, chanlist[i]);
ed9eccbe DS	157	return -EINVAL;
	158	}
	159	}
	160	} else {
ecfe20db	161	printk(KERN_ERR "comedi: (bug) no range type list!\n");
ed9eccbe DS	162	return -EINVAL;
	163	}
	164	return 0;
	165	}
0fd0ca75	166	EXPORT_SYMBOL(comedi_check_chanlist);