[deliverable/linux.git] / drivers / iio / inkern.c

/* The industrial I/O core in kernel channel mapping
 *
 * Copyright (c) 2011 Jonathan Cameron
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 */
#include <linux/err.h>
#include <linux/export.h>
#include <linux/slab.h>
#include <linux/mutex.h>

#include <linux/iio/iio.h>
#include "iio_core.h"
#include <linux/iio/machine.h>
#include <linux/iio/driver.h>
#include <linux/iio/consumer.h>

struct iio_map_internal {
	struct iio_dev *indio_dev;
	struct iio_map *map;
	struct list_head l;
};

static LIST_HEAD(iio_map_list);
static DEFINE_MUTEX(iio_map_list_lock);

int iio_map_array_register(struct iio_dev *indio_dev, struct iio_map *maps)
{
	int i = 0, ret = 0;
	struct iio_map_internal *mapi;

	if (maps == NULL)
		return 0;

	mutex_lock(&iio_map_list_lock);
	while (maps[i].consumer_dev_name != NULL) {
		mapi = kzalloc(sizeof(*mapi), GFP_KERNEL);
		if (mapi == NULL) {
			ret = -ENOMEM;
			goto error_ret;
		}
		mapi->map = &maps[i];
		mapi->indio_dev = indio_dev;
		list_add(&mapi->l, &iio_map_list);
		i++;
	}
error_ret:
	mutex_unlock(&iio_map_list_lock);

	return ret;
}
EXPORT_SYMBOL_GPL(iio_map_array_register);


/* Assumes the exact same array (e.g. memory locations)
 * used at unregistration as used at registration rather than
 * more complex checking of contents.
 */
int iio_map_array_unregister(struct iio_dev *indio_dev,
			     struct iio_map *maps)
{
	int i = 0, ret = 0;
	bool found_it;
	struct iio_map_internal *mapi;

	if (maps == NULL)
		return 0;

	mutex_lock(&iio_map_list_lock);
	while (maps[i].consumer_dev_name != NULL) {
		found_it = false;
		list_for_each_entry(mapi, &iio_map_list, l)
			if (&maps[i] == mapi->map) {
				list_del(&mapi->l);
				kfree(mapi);
				found_it = true;
				break;
			}
		if (found_it == false) {
			ret = -ENODEV;
			goto error_ret;
		}
		i++;
	}
error_ret:
	mutex_unlock(&iio_map_list_lock);

	return ret;
}
EXPORT_SYMBOL_GPL(iio_map_array_unregister);

static const struct iio_chan_spec
*iio_chan_spec_from_name(const struct iio_dev *indio_dev, const char *name)
{
	int i;
	const struct iio_chan_spec *chan = NULL;

	for (i = 0; i < indio_dev->num_channels; i++)
		if (indio_dev->channels[i].datasheet_name &&
		    strcmp(name, indio_dev->channels[i].datasheet_name) == 0) {
			chan = &indio_dev->channels[i];
			break;
		}
	return chan;
}


struct iio_channel *iio_channel_get(const char *name, const char *channel_name)
{
	struct iio_map_internal *c_i = NULL, *c = NULL;
	struct iio_channel *channel;

	if (name == NULL && channel_name == NULL)
		return ERR_PTR(-ENODEV);

	/* first find matching entry the channel map */
	mutex_lock(&iio_map_list_lock);
	list_for_each_entry(c_i, &iio_map_list, l) {
		if ((name && strcmp(name, c_i->map->consumer_dev_name) != 0) ||
		    (channel_name &&
		     strcmp(channel_name, c_i->map->consumer_channel) != 0))
			continue;
		c = c_i;
		iio_device_get(c->indio_dev);
		break;
	}
	mutex_unlock(&iio_map_list_lock);
	if (c == NULL)
		return ERR_PTR(-ENODEV);

	channel = kmalloc(sizeof(*channel), GFP_KERNEL);
	if (channel == NULL)
		return ERR_PTR(-ENOMEM);

	channel->indio_dev = c->indio_dev;

	if (c->map->adc_channel_label)
		channel->channel =
			iio_chan_spec_from_name(channel->indio_dev,
						c->map->adc_channel_label);

	return channel;
}
EXPORT_SYMBOL_GPL(iio_channel_get);

void iio_channel_release(struct iio_channel *channel)
{
	iio_device_put(channel->indio_dev);
	kfree(channel);
}
EXPORT_SYMBOL_GPL(iio_channel_release);

struct iio_channel *iio_channel_get_all(const char *name)
{
	struct iio_channel *chans;
	struct iio_map_internal *c = NULL;
	int nummaps = 0;
	int mapind = 0;
	int i, ret;

	if (name == NULL)
		return ERR_PTR(-EINVAL);

	mutex_lock(&iio_map_list_lock);
	/* first count the matching maps */
	list_for_each_entry(c, &iio_map_list, l)
		if (name && strcmp(name, c->map->consumer_dev_name) != 0)
			continue;
		else
			nummaps++;

	if (nummaps == 0) {
		ret = -ENODEV;
		goto error_ret;
	}

	/* NULL terminated array to save passing size */
	chans = kzalloc(sizeof(*chans)*(nummaps + 1), GFP_KERNEL);
	if (chans == NULL) {
		ret = -ENOMEM;
		goto error_ret;
	}

	/* for each map fill in the chans element */
	list_for_each_entry(c, &iio_map_list, l) {
		if (name && strcmp(name, c->map->consumer_dev_name) != 0)
			continue;
		chans[mapind].indio_dev = c->indio_dev;
		chans[mapind].channel =
			iio_chan_spec_from_name(chans[mapind].indio_dev,
						c->map->adc_channel_label);
		if (chans[mapind].channel == NULL) {
			ret = -EINVAL;
			goto error_free_chans;
		}
		iio_device_get(chans[mapind].indio_dev);
		mapind++;
	}
	if (mapind == 0) {
		ret = -ENODEV;
		goto error_free_chans;
	}
	mutex_unlock(&iio_map_list_lock);

	return chans;

error_free_chans:
	for (i = 0; i < nummaps; i++)
		iio_device_put(chans[i].indio_dev);
	kfree(chans);
error_ret:
	mutex_unlock(&iio_map_list_lock);

	return ERR_PTR(ret);
}
EXPORT_SYMBOL_GPL(iio_channel_get_all);

void iio_channel_release_all(struct iio_channel *channels)
{
	struct iio_channel *chan = &channels[0];

	while (chan->indio_dev) {
		iio_device_put(chan->indio_dev);
		chan++;
	}
	kfree(channels);
}
EXPORT_SYMBOL_GPL(iio_channel_release_all);

int iio_read_channel_raw(struct iio_channel *chan, int *val)
{
	int val2, ret;

	mutex_lock(&chan->indio_dev->info_exist_lock);
	if (chan->indio_dev->info == NULL) {
		ret = -ENODEV;
		goto err_unlock;
	}

	ret = chan->indio_dev->info->read_raw(chan->indio_dev, chan->channel,
					      val, &val2, 0);
err_unlock:
	mutex_unlock(&chan->indio_dev->info_exist_lock);

	return ret;
}
EXPORT_SYMBOL_GPL(iio_read_channel_raw);

int iio_read_channel_scale(struct iio_channel *chan, int *val, int *val2)
{
	int ret;

	mutex_lock(&chan->indio_dev->info_exist_lock);
	if (chan->indio_dev->info == NULL) {
		ret = -ENODEV;
		goto err_unlock;
	}

	ret = chan->indio_dev->info->read_raw(chan->indio_dev,
					      chan->channel,
					      val, val2,
					      IIO_CHAN_INFO_SCALE);
err_unlock:
	mutex_unlock(&chan->indio_dev->info_exist_lock);

	return ret;
}
EXPORT_SYMBOL_GPL(iio_read_channel_scale);

int iio_get_channel_type(struct iio_channel *chan, enum iio_chan_type *type)
{
	int ret = 0;
	/* Need to verify underlying driver has not gone away */

	mutex_lock(&chan->indio_dev->info_exist_lock);
	if (chan->indio_dev->info == NULL) {
		ret = -ENODEV;
		goto err_unlock;
	}

	*type = chan->channel->type;
err_unlock:
	mutex_unlock(&chan->indio_dev->info_exist_lock);

	return ret;
}
EXPORT_SYMBOL_GPL(iio_get_channel_type);
Commit	Line	Data
e27d75d7 JC	1	/* The industrial I/O core in kernel channel mapping
	2	*
	3	* Copyright (c) 2011 Jonathan Cameron
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of the GNU General Public License version 2 as published by
	7	* the Free Software Foundation.
	8	*/
	9	#include <linux/err.h>
	10	#include <linux/export.h>
	11	#include <linux/slab.h>
	12	#include <linux/mutex.h>
	13
06458e27	14	#include <linux/iio/iio.h>
e27d75d7	15	#include "iio_core.h"
06458e27 JC	16	#include <linux/iio/machine.h>
	17	#include <linux/iio/driver.h>
	18	#include <linux/iio/consumer.h>
e27d75d7 JC	19
	20	struct iio_map_internal {
	21	struct iio_dev *indio_dev;
	22	struct iio_map *map;
	23	struct list_head l;
	24	};
	25
	26	static LIST_HEAD(iio_map_list);
	27	static DEFINE_MUTEX(iio_map_list_lock);
	28
	29	int iio_map_array_register(struct iio_dev indio_dev, struct iio_map maps)
	30	{
	31	int i = 0, ret = 0;
	32	struct iio_map_internal *mapi;
	33
	34	if (maps == NULL)
	35	return 0;
	36
	37	mutex_lock(&iio_map_list_lock);
	38	while (maps[i].consumer_dev_name != NULL) {
	39	mapi = kzalloc(sizeof(*mapi), GFP_KERNEL);
	40	if (mapi == NULL) {
	41	ret = -ENOMEM;
	42	goto error_ret;
	43	}
	44	mapi->map = &maps[i];
	45	mapi->indio_dev = indio_dev;
	46	list_add(&mapi->l, &iio_map_list);
	47	i++;
	48	}
	49	error_ret:
	50	mutex_unlock(&iio_map_list_lock);
	51
	52	return ret;
	53	}
	54	EXPORT_SYMBOL_GPL(iio_map_array_register);
	55
	56
	57	/* Assumes the exact same array (e.g. memory locations)
	58	* used at unregistration as used at registration rather than
	59	* more complex checking of contents.
	60	*/
	61	int iio_map_array_unregister(struct iio_dev *indio_dev,
	62	struct iio_map *maps)
	63	{
	64	int i = 0, ret = 0;
	65	bool found_it;
	66	struct iio_map_internal *mapi;
	67
	68	if (maps == NULL)
	69	return 0;
	70
	71	mutex_lock(&iio_map_list_lock);
	72	while (maps[i].consumer_dev_name != NULL) {
	73	found_it = false;
	74	list_for_each_entry(mapi, &iio_map_list, l)
	75	if (&maps[i] == mapi->map) {
	76	list_del(&mapi->l);
	77	kfree(mapi);
	78	found_it = true;
	79	break;
	80	}
	81	if (found_it == false) {
	82	ret = -ENODEV;
83	goto error_ret;
84	}
218f4d43	85	i++;
e27d75d7 JC	86	}
	87	error_ret:
	88	mutex_unlock(&iio_map_list_lock);
	89
	90	return ret;
	91	}
	92	EXPORT_SYMBOL_GPL(iio_map_array_unregister);
	93
	94	static const struct iio_chan_spec
314be14b	95	iio_chan_spec_from_name(const struct iio_dev indio_dev, const char *name)
e27d75d7 JC	96	{
	97	int i;
	98	const struct iio_chan_spec *chan = NULL;
	99
	100	for (i = 0; i < indio_dev->num_channels; i++)
	101	if (indio_dev->channels[i].datasheet_name &&
	102	strcmp(name, indio_dev->channels[i].datasheet_name) == 0) {
	103	chan = &indio_dev->channels[i];
	104	break;
	105	}
	106	return chan;
	107	}
	108
	109
314be14b	110	struct iio_channel iio_channel_get(const char name, const char *channel_name)
e27d75d7 JC	111	{
	112	struct iio_map_internal c_i = NULL, c = NULL;
	113	struct iio_channel *channel;
	114
	115	if (name == NULL && channel_name == NULL)
	116	return ERR_PTR(-ENODEV);
	117
	118	/* first find matching entry the channel map */
	119	mutex_lock(&iio_map_list_lock);
	120	list_for_each_entry(c_i, &iio_map_list, l) {
	121	if ((name && strcmp(name, c_i->map->consumer_dev_name) != 0) \|\|
	122	(channel_name &&
	123	strcmp(channel_name, c_i->map->consumer_channel) != 0))
	124	continue;
	125	c = c_i;
1875ffd2	126	iio_device_get(c->indio_dev);
e27d75d7 JC	127	break;
	128	}
	129	mutex_unlock(&iio_map_list_lock);
	130	if (c == NULL)
	131	return ERR_PTR(-ENODEV);
	132
	133	channel = kmalloc(sizeof(*channel), GFP_KERNEL);
	134	if (channel == NULL)
	135	return ERR_PTR(-ENOMEM);
	136
	137	channel->indio_dev = c->indio_dev;
	138
	139	if (c->map->adc_channel_label)
	140	channel->channel =
	141	iio_chan_spec_from_name(channel->indio_dev,
	142	c->map->adc_channel_label);
	143
	144	return channel;
	145	}
314be14b	146	EXPORT_SYMBOL_GPL(iio_channel_get);
e27d75d7	147
314be14b	148	void iio_channel_release(struct iio_channel *channel)
e27d75d7	149	{
1875ffd2	150	iio_device_put(channel->indio_dev);
e27d75d7 JC	151	kfree(channel);
e27d75d7 JC	152	}
314be14b	153	EXPORT_SYMBOL_GPL(iio_channel_release);
e27d75d7	154
314be14b	155	struct iio_channel iio_channel_get_all(const char name)
e27d75d7 JC	156	{
	157	struct iio_channel *chans;
	158	struct iio_map_internal *c = NULL;
	159	int nummaps = 0;
	160	int mapind = 0;
	161	int i, ret;
	162
	163	if (name == NULL)
	164	return ERR_PTR(-EINVAL);
	165
	166	mutex_lock(&iio_map_list_lock);
	167	/* first count the matching maps */
	168	list_for_each_entry(c, &iio_map_list, l)
	169	if (name && strcmp(name, c->map->consumer_dev_name) != 0)
	170	continue;
	171	else
	172	nummaps++;
	173
	174	if (nummaps == 0) {
	175	ret = -ENODEV;
	176	goto error_ret;
	177	}
	178
	179	/* NULL terminated array to save passing size */
	180	chans = kzalloc(sizeof(chans)(nummaps + 1), GFP_KERNEL);
	181	if (chans == NULL) {
	182	ret = -ENOMEM;
	183	goto error_ret;
	184	}
	185
	186	/* for each map fill in the chans element */
	187	list_for_each_entry(c, &iio_map_list, l) {
	188	if (name && strcmp(name, c->map->consumer_dev_name) != 0)
	189	continue;
	190	chans[mapind].indio_dev = c->indio_dev;
	191	chans[mapind].channel =
	192	iio_chan_spec_from_name(chans[mapind].indio_dev,
	193	c->map->adc_channel_label);
	194	if (chans[mapind].channel == NULL) {
	195	ret = -EINVAL;
e27d75d7 JC	196	goto error_free_chans;
e27d75d7 JC	197	}
1875ffd2	198	iio_device_get(chans[mapind].indio_dev);
e27d75d7 JC	199	mapind++;
e27d75d7 JC	200	}
e27d75d7 JC	201	if (mapind == 0) {
	202	ret = -ENODEV;
	203	goto error_free_chans;
	204	}
e59b9afe DC	205	mutex_unlock(&iio_map_list_lock);
e59b9afe DC	206
e27d75d7 JC	207	return chans;
	208
	209	error_free_chans:
	210	for (i = 0; i < nummaps; i++)
1875ffd2	211	iio_device_put(chans[i].indio_dev);
e27d75d7 JC	212	kfree(chans);
	213	error_ret:
	214	mutex_unlock(&iio_map_list_lock);
	215
	216	return ERR_PTR(ret);
	217	}
314be14b	218	EXPORT_SYMBOL_GPL(iio_channel_get_all);
e27d75d7	219
314be14b	220	void iio_channel_release_all(struct iio_channel *channels)
e27d75d7 JC	221	{
	222	struct iio_channel *chan = &channels[0];
	223
	224	while (chan->indio_dev) {
1875ffd2	225	iio_device_put(chan->indio_dev);
e27d75d7 JC	226	chan++;
	227	}
	228	kfree(channels);
	229	}
314be14b	230	EXPORT_SYMBOL_GPL(iio_channel_release_all);
e27d75d7	231
314be14b	232	int iio_read_channel_raw(struct iio_channel chan, int val)
e27d75d7 JC	233	{
	234	int val2, ret;
	235
	236	mutex_lock(&chan->indio_dev->info_exist_lock);
	237	if (chan->indio_dev->info == NULL) {
	238	ret = -ENODEV;
	239	goto err_unlock;
	240	}
	241
	242	ret = chan->indio_dev->info->read_raw(chan->indio_dev, chan->channel,
	243	val, &val2, 0);
	244	err_unlock:
	245	mutex_unlock(&chan->indio_dev->info_exist_lock);
	246
	247	return ret;
	248	}
314be14b	249	EXPORT_SYMBOL_GPL(iio_read_channel_raw);
e27d75d7	250
314be14b	251	int iio_read_channel_scale(struct iio_channel chan, int val, int *val2)
e27d75d7 JC	252	{
	253	int ret;
	254
	255	mutex_lock(&chan->indio_dev->info_exist_lock);
	256	if (chan->indio_dev->info == NULL) {
	257	ret = -ENODEV;
	258	goto err_unlock;
	259	}
	260
	261	ret = chan->indio_dev->info->read_raw(chan->indio_dev,
	262	chan->channel,
	263	val, val2,
	264	IIO_CHAN_INFO_SCALE);
	265	err_unlock:
	266	mutex_unlock(&chan->indio_dev->info_exist_lock);
	267
	268	return ret;
	269	}
314be14b	270	EXPORT_SYMBOL_GPL(iio_read_channel_scale);
e27d75d7	271
314be14b	272	int iio_get_channel_type(struct iio_channel chan, enum iio_chan_type type)
e27d75d7 JC	273	{
	274	int ret = 0;
	275	/* Need to verify underlying driver has not gone away */
	276
	277	mutex_lock(&chan->indio_dev->info_exist_lock);
	278	if (chan->indio_dev->info == NULL) {
	279	ret = -ENODEV;
	280	goto err_unlock;
	281	}
	282
	283	*type = chan->channel->type;
	284	err_unlock:
	285	mutex_unlock(&chan->indio_dev->info_exist_lock);
	286
	287	return ret;
	288	}
314be14b	289	EXPORT_SYMBOL_GPL(iio_get_channel_type);