[deliverable/linux.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.
*/

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

const struct comedi_lrange range_bipolar10 = { 1, {BIP_RANGE(10)} };
EXPORT_SYMBOL_GPL(range_bipolar10);
const struct comedi_lrange range_bipolar5 = { 1, {BIP_RANGE(5)} };
EXPORT_SYMBOL_GPL(range_bipolar5);
const struct comedi_lrange range_bipolar2_5 = { 1, {BIP_RANGE(2.5)} };
EXPORT_SYMBOL_GPL(range_bipolar2_5);
const struct comedi_lrange range_unipolar10 = { 1, {UNI_RANGE(10)} };
EXPORT_SYMBOL_GPL(range_unipolar10);
const struct comedi_lrange range_unipolar5 = { 1, {UNI_RANGE(5)} };
EXPORT_SYMBOL_GPL(range_unipolar5);
const struct comedi_lrange range_unipolar2_5 = { 1, {UNI_RANGE(2.5)} };
EXPORT_SYMBOL_GPL(range_unipolar2_5);
const struct comedi_lrange range_0_20mA = { 1, {RANGE_mA(0, 20)} };
EXPORT_SYMBOL_GPL(range_0_20mA);
const struct comedi_lrange range_4_20mA = { 1, {RANGE_mA(4, 20)} };
EXPORT_SYMBOL_GPL(range_4_20mA);
const struct comedi_lrange range_0_32mA = { 1, {RANGE_mA(0, 32)} };
EXPORT_SYMBOL_GPL(range_0_32mA);
const struct comedi_lrange range_unknown = { 1, {{0, 1000000, UNIT_none} } };
EXPORT_SYMBOL_GPL(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) {
		dev_dbg(dev->class_dev,
			"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;
	}
	dev_dbg(s->device->class_dev, "subdevice does not support aref %i",
		aref);
	return 1;
}

/**
 * comedi_check_chanlist() - Validate each element in a chanlist.
 * @s: comedi_subdevice struct
 * @n: number of elements in the chanlist
 * @chanlist: the chanlist to validate
*/
int comedi_check_chanlist(struct comedi_subdevice *s, int n,
			  unsigned int *chanlist)
{
	struct comedi_device *dev = s->device;
	unsigned int chanspec;
	int chan, range_len, i;

	for (i = 0; i < n; i++) {
		chanspec = chanlist[i];
		chan = CR_CHAN(chanspec);
		if (s->range_table)
			range_len = s->range_table->length;
		else if (s->range_table_list && chan < s->n_chan)
			range_len = s->range_table_list[chan]->length;
		else
			range_len = 0;
		if (chan >= s->n_chan ||
		    CR_RANGE(chanspec) >= range_len ||
		    aref_invalid(s, chanspec)) {
			dev_warn(dev->class_dev,
				 "bad chanlist[%d]=0x%08x chan=%d range length=%d\n",
				 i, chanspec, chan, range_len);
			return -EINVAL;
		}
	}
	return 0;
}
EXPORT_SYMBOL_GPL(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.
ed9eccbe DS	17	*/
ed9eccbe DS	18
ecfe20db	19	#include <linux/uaccess.h>
3b6b25b5	20	#include "comedidev.h"
3a5fa275	21	#include "comedi_internal.h"
ed9eccbe	22
9ced1de6	23	const struct comedi_lrange range_bipolar10 = { 1, {BIP_RANGE(10)} };
5660e742	24	EXPORT_SYMBOL_GPL(range_bipolar10);
f0f29184	25	const struct comedi_lrange range_bipolar5 = { 1, {BIP_RANGE(5)} };
5660e742	26	EXPORT_SYMBOL_GPL(range_bipolar5);
f0f29184	27	const struct comedi_lrange range_bipolar2_5 = { 1, {BIP_RANGE(2.5)} };
5660e742	28	EXPORT_SYMBOL_GPL(range_bipolar2_5);
f0f29184	29	const struct comedi_lrange range_unipolar10 = { 1, {UNI_RANGE(10)} };
5660e742	30	EXPORT_SYMBOL_GPL(range_unipolar10);
f0f29184	31	const struct comedi_lrange range_unipolar5 = { 1, {UNI_RANGE(5)} };
5660e742	32	EXPORT_SYMBOL_GPL(range_unipolar5);
5f8eb72c	33	const struct comedi_lrange range_unipolar2_5 = { 1, {UNI_RANGE(2.5)} };
5660e742	34	EXPORT_SYMBOL_GPL(range_unipolar2_5);
2c71c4ff	35	const struct comedi_lrange range_0_20mA = { 1, {RANGE_mA(0, 20)} };
5660e742	36	EXPORT_SYMBOL_GPL(range_0_20mA);
2c71c4ff	37	const struct comedi_lrange range_4_20mA = { 1, {RANGE_mA(4, 20)} };
5660e742	38	EXPORT_SYMBOL_GPL(range_4_20mA);
2c71c4ff	39	const struct comedi_lrange range_0_32mA = { 1, {RANGE_mA(0, 32)} };
5660e742	40	EXPORT_SYMBOL_GPL(range_0_32mA);
f0f29184	41	const struct comedi_lrange range_unknown = { 1, {{0, 1000000, UNIT_none} } };
5660e742	42	EXPORT_SYMBOL_GPL(range_unknown);
ed9eccbe DS	43
ed9eccbe DS	44	/*
356cdbcb	45	COMEDI_RANGEINFO
ed9eccbe DS	46	range information ioctl
	47
	48	arg:
	49	pointer to rangeinfo structure
	50
	51	reads:
	52	range info structure
	53
	54	writes:
1f6325d6	55	n struct comedi_krange structures to rangeinfo->range_ptr
ed9eccbe	56	*/
3b6b25b5 GKH	57	int do_rangeinfo_ioctl(struct comedi_device *dev,
3b6b25b5 GKH	58	struct comedi_rangeinfo __user *arg)
ed9eccbe	59	{
d0a353f6	60	struct comedi_rangeinfo it;
ed9eccbe	61	int subd, chan;
9ced1de6	62	const struct comedi_lrange *lr;
34c43922	63	struct comedi_subdevice *s;
ed9eccbe	64
d0a353f6	65	if (copy_from_user(&it, arg, sizeof(struct comedi_rangeinfo)))
ed9eccbe DS	66	return -EFAULT;
	67	subd = (it.range_type >> 24) & 0xf;
	68	chan = (it.range_type >> 16) & 0xff;
	69
	70	if (!dev->attached)
	71	return -EINVAL;
	72	if (subd >= dev->n_subdevices)
	73	return -EINVAL;
d08d6cfe	74	s = &dev->subdevices[subd];
ed9eccbe DS	75	if (s->range_table) {
	76	lr = s->range_table;
	77	} else if (s->range_table_list) {
	78	if (chan >= s->n_chan)
	79	return -EINVAL;
	80	lr = s->range_table_list[chan];
	81	} else {
	82	return -EINVAL;
	83	}
	84
	85	if (RANGE_LENGTH(it.range_type) != lr->length) {
2cde476d HS	86	dev_dbg(dev->class_dev,
	87	"wrong length %d should be %d (0x%08x)\n",
	88	RANGE_LENGTH(it.range_type),
	89	lr->length, it.range_type);
ed9eccbe DS	90	return -EINVAL;
	91	}
	92
	93	if (copy_to_user(it.range_ptr, lr->range,
0a85b6f0	94	sizeof(struct comedi_krange) * lr->length))
ed9eccbe DS	95	return -EFAULT;
	96
	97	return 0;
	98	}
	99
34c43922	100	static int aref_invalid(struct comedi_subdevice *s, unsigned int chanspec)
ed9eccbe DS	101	{
	102	unsigned int aref;
	103
b6c77757	104	/* disable reporting invalid arefs... maybe someday */
ed9eccbe DS	105	return 0;
	106
	107	aref = CR_AREF(chanspec);
	108	switch (aref) {
	109	case AREF_DIFF:
	110	if (s->subdev_flags & SDF_DIFF)
	111	return 0;
	112	break;
	113	case AREF_COMMON:
	114	if (s->subdev_flags & SDF_COMMON)
	115	return 0;
	116	break;
	117	case AREF_GROUND:
	118	if (s->subdev_flags & SDF_GROUND)
	119	return 0;
	120	break;
	121	case AREF_OTHER:
	122	if (s->subdev_flags & SDF_OTHER)
	123	return 0;
	124	break;
	125	default:
	126	break;
	127	}
2cde476d HS	128	dev_dbg(s->device->class_dev, "subdevice does not support aref %i",
2cde476d HS	129	aref);
ed9eccbe DS	130	return 1;
	131	}
	132
065b0912 HS	133	/**
	134	* comedi_check_chanlist() - Validate each element in a chanlist.
	135	* @s: comedi_subdevice struct
	136	* @n: number of elements in the chanlist
	137	* @chanlist: the chanlist to validate
ed9eccbe	138	*/
0fd0ca75 GKH	139	int comedi_check_chanlist(struct comedi_subdevice *s, int n,
0fd0ca75 GKH	140	unsigned int *chanlist)
ed9eccbe	141	{
4f870fe6	142	struct comedi_device *dev = s->device;
065b0912 HS	143	unsigned int chanspec;
065b0912 HS	144	int chan, range_len, i;
ed9eccbe	145
afdc37ee FA	146	for (i = 0; i < n; i++) {
	147	chanspec = chanlist[i];
	148	chan = CR_CHAN(chanspec);
	149	if (s->range_table)
	150	range_len = s->range_table->length;
	151	else if (s->range_table_list && chan < s->n_chan)
	152	range_len = s->range_table_list[chan]->length;
	153	else
	154	range_len = 0;
	155	if (chan >= s->n_chan \|\|
	156	CR_RANGE(chanspec) >= range_len \|\|
	157	aref_invalid(s, chanspec)) {
	158	dev_warn(dev->class_dev,
	159	"bad chanlist[%d]=0x%08x chan=%d range length=%d\n",
	160	i, chanspec, chan, range_len);
	161	return -EINVAL;
	162	}
	163	}
ed9eccbe DS	164	return 0;
ed9eccbe DS	165	}
5660e742	166	EXPORT_SYMBOL_GPL(comedi_check_chanlist);