[deliverable/linux.git] / drivers / media / video / pvrusb2 / pvrusb2-ctrl.c

/*
 *
 *  $Id$
 *
 *  Copyright (C) 2005 Mike Isely <isely@pobox.com>
 *
 *  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
 *
 *  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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */

#include "pvrusb2-ctrl.h"
#include "pvrusb2-hdw-internal.h"
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/mutex.h>


static int pvr2_ctrl_range_check(struct pvr2_ctrl *cptr,int val)
{
	if (cptr->info->check_value) {
		if (!cptr->info->check_value(cptr,val)) return -ERANGE;
	} else {
		int lim;
		lim = cptr->info->def.type_int.min_value;
		if (cptr->info->get_min_value) {
			cptr->info->get_min_value(cptr,&lim);
		}
		if (val < lim) return -ERANGE;
		lim = cptr->info->def.type_int.max_value;
		if (cptr->info->get_max_value) {
			cptr->info->get_max_value(cptr,&lim);
		}
		if (val > lim) return -ERANGE;
	}
	return 0;
}


/* Set the given control. */
int pvr2_ctrl_set_value(struct pvr2_ctrl *cptr,int val)
{
	return pvr2_ctrl_set_mask_value(cptr,~0,val);
}


/* Set/clear specific bits of the given control. */
int pvr2_ctrl_set_mask_value(struct pvr2_ctrl *cptr,int mask,int val)
{
	int ret = 0;
	if (!cptr) return -EINVAL;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->set_value) {
			if (cptr->info->type == pvr2_ctl_bitmask) {
				mask &= cptr->info->def.type_bitmask.valid_bits;
			} else if (cptr->info->type == pvr2_ctl_int) {
				ret = pvr2_ctrl_range_check(cptr,val);
				if (ret < 0) break;
			} else if (cptr->info->type == pvr2_ctl_enum) {
				if (val >= cptr->info->def.type_enum.count) {
					break;
				}
			} else if (cptr->info->type != pvr2_ctl_bool) {
				break;
			}
			ret = cptr->info->set_value(cptr,mask,val);
		} else {
			ret = -EPERM;
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Get the current value of the given control. */
int pvr2_ctrl_get_value(struct pvr2_ctrl *cptr,int *valptr)
{
	int ret = 0;
	if (!cptr) return -EINVAL;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		ret = cptr->info->get_value(cptr,valptr);
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Retrieve control's type */
enum pvr2_ctl_type pvr2_ctrl_get_type(struct pvr2_ctrl *cptr)
{
	if (!cptr) return pvr2_ctl_int;
	return cptr->info->type;
}


/* Retrieve control's maximum value (int type) */
int pvr2_ctrl_get_max(struct pvr2_ctrl *cptr)
{
	int ret = 0;
	if (!cptr) return 0;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->get_max_value) {
			cptr->info->get_max_value(cptr,&ret);
		} else if (cptr->info->type == pvr2_ctl_int) {
			ret = cptr->info->def.type_int.max_value;
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Retrieve control's minimum value (int type) */
int pvr2_ctrl_get_min(struct pvr2_ctrl *cptr)
{
	int ret = 0;
	if (!cptr) return 0;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->get_min_value) {
			cptr->info->get_min_value(cptr,&ret);
		} else if (cptr->info->type == pvr2_ctl_int) {
			ret = cptr->info->def.type_int.min_value;
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Retrieve control's default value (any type) */
int pvr2_ctrl_get_def(struct pvr2_ctrl *cptr)
{
	int ret = 0;
	if (!cptr) return 0;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->type == pvr2_ctl_int) {
			ret = cptr->info->default_value;
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Retrieve control's enumeration count (enum only) */
int pvr2_ctrl_get_cnt(struct pvr2_ctrl *cptr)
{
	int ret = 0;
	if (!cptr) return 0;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->type == pvr2_ctl_enum) {
			ret = cptr->info->def.type_enum.count;
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Retrieve control's valid mask bits (bit mask only) */
int pvr2_ctrl_get_mask(struct pvr2_ctrl *cptr)
{
	int ret = 0;
	if (!cptr) return 0;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->type == pvr2_ctl_bitmask) {
			ret = cptr->info->def.type_bitmask.valid_bits;
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Retrieve the control's name */
const char *pvr2_ctrl_get_name(struct pvr2_ctrl *cptr)
{
	if (!cptr) return NULL;
	return cptr->info->name;
}


/* Retrieve the control's desc */
const char *pvr2_ctrl_get_desc(struct pvr2_ctrl *cptr)
{
	if (!cptr) return NULL;
	return cptr->info->desc;
}


/* Retrieve a control enumeration or bit mask value */
int pvr2_ctrl_get_valname(struct pvr2_ctrl *cptr,int val,
			  char *bptr,unsigned int bmax,
			  unsigned int *blen)
{
	int ret = -EINVAL;
	if (!cptr) return 0;
	*blen = 0;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->type == pvr2_ctl_enum) {
			const char **names;
			names = cptr->info->def.type_enum.value_names;
			if ((val >= 0) &&
			    (val < cptr->info->def.type_enum.count)) {
				if (names[val]) {
					*blen = scnprintf(
						bptr,bmax,"%s",
						names[val]);
				} else {
					*blen = 0;
				}
				ret = 0;
			}
		} else if (cptr->info->type == pvr2_ctl_bitmask) {
			const char **names;
			unsigned int idx;
			int msk;
			names = cptr->info->def.type_bitmask.bit_names;
			val &= cptr->info->def.type_bitmask.valid_bits;
			for (idx = 0, msk = 1; val; idx++, msk <<= 1) {
				if (val & msk) {
					*blen = scnprintf(bptr,bmax,"%s",
							  names[idx]);
					ret = 0;
					break;
				}
			}
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Return V4L ID for this control or zero if none */
int pvr2_ctrl_get_v4lid(struct pvr2_ctrl *cptr)
{
	if (!cptr) return 0;
	return cptr->info->v4l_id;
}


unsigned int pvr2_ctrl_get_v4lflags(struct pvr2_ctrl *cptr)
{
	unsigned int flags = 0;

	if (cptr->info->get_v4lflags) {
		flags = cptr->info->get_v4lflags(cptr);
	}

	if (cptr->info->set_value) {
		flags &= ~V4L2_CTRL_FLAG_READ_ONLY;
	} else {
		flags |= V4L2_CTRL_FLAG_READ_ONLY;
	}

	return flags;
}


/* Return true if control is writable */
int pvr2_ctrl_is_writable(struct pvr2_ctrl *cptr)
{
	if (!cptr) return 0;
	return cptr->info->set_value != NULL;
}


/* Return true if control has custom symbolic representation */
int pvr2_ctrl_has_custom_symbols(struct pvr2_ctrl *cptr)
{
	if (!cptr) return 0;
	if (!cptr->info->val_to_sym) return 0;
	if (!cptr->info->sym_to_val) return 0;
	return !0;
}


/* Convert a given mask/val to a custom symbolic value */
int pvr2_ctrl_custom_value_to_sym(struct pvr2_ctrl *cptr,
				  int mask,int val,
				  char *buf,unsigned int maxlen,
				  unsigned int *len)
{
	if (!cptr) return -EINVAL;
	if (!cptr->info->val_to_sym) return -EINVAL;
	return cptr->info->val_to_sym(cptr,mask,val,buf,maxlen,len);
}


/* Convert a symbolic value to a mask/value pair */
int pvr2_ctrl_custom_sym_to_value(struct pvr2_ctrl *cptr,
				  const char *buf,unsigned int len,
				  int *maskptr,int *valptr)
{
	if (!cptr) return -EINVAL;
	if (!cptr->info->sym_to_val) return -EINVAL;
	return cptr->info->sym_to_val(cptr,buf,len,maskptr,valptr);
}


static unsigned int gen_bitmask_string(int msk,int val,int msk_only,
				       const char **names,
				       char *ptr,unsigned int len)
{
	unsigned int idx;
	long sm,um;
	int spcFl;
	unsigned int uc,cnt;
	const char *idStr;

	spcFl = 0;
	uc = 0;
	um = 0;
	for (idx = 0, sm = 1; msk; idx++, sm <<= 1) {
		if (sm & msk) {
			msk &= ~sm;
			idStr = names[idx];
			if (idStr) {
				cnt = scnprintf(ptr,len,"%s%s%s",
						(spcFl ? " " : ""),
						(msk_only ? "" :
						 ((val & sm) ? "+" : "-")),
						idStr);
				ptr += cnt; len -= cnt; uc += cnt;
				spcFl = !0;
			} else {
				um |= sm;
			}
		}
	}
	if (um) {
		if (msk_only) {
			cnt = scnprintf(ptr,len,"%s0x%lx",
					(spcFl ? " " : ""),
					um);
			ptr += cnt; len -= cnt; uc += cnt;
			spcFl = !0;
		} else if (um & val) {
			cnt = scnprintf(ptr,len,"%s+0x%lx",
					(spcFl ? " " : ""),
					um & val);
			ptr += cnt; len -= cnt; uc += cnt;
			spcFl = !0;
		} else if (um & ~val) {
			cnt = scnprintf(ptr,len,"%s+0x%lx",
					(spcFl ? " " : ""),
					um & ~val);
			ptr += cnt; len -= cnt; uc += cnt;
			spcFl = !0;
		}
	}
	return uc;
}


static const char *boolNames[] = {
	"false",
	"true",
	"no",
	"yes",
};


static int parse_token(const char *ptr,unsigned int len,
		       int *valptr,
		       const char **names,unsigned int namecnt)
{
	char buf[33];
	unsigned int slen;
	unsigned int idx;
	int negfl;
	char *p2;
	*valptr = 0;
	if (!names) namecnt = 0;
	for (idx = 0; idx < namecnt; idx++) {
		if (!names[idx]) continue;
		slen = strlen(names[idx]);
		if (slen != len) continue;
		if (memcmp(names[idx],ptr,slen)) continue;
		*valptr = idx;
		return 0;
	}
	negfl = 0;
	if ((*ptr == '-') || (*ptr == '+')) {
		negfl = (*ptr == '-');
		ptr++; len--;
	}
	if (len >= sizeof(buf)) return -EINVAL;
	memcpy(buf,ptr,len);
	buf[len] = 0;
	*valptr = simple_strtol(buf,&p2,0);
	if (negfl) *valptr = -(*valptr);
	if (*p2) return -EINVAL;
	return 1;
}


static int parse_mtoken(const char *ptr,unsigned int len,
			int *valptr,
			const char **names,int valid_bits)
{
	char buf[33];
	unsigned int slen;
	unsigned int idx;
	char *p2;
	int msk;
	*valptr = 0;
	for (idx = 0, msk = 1; valid_bits; idx++, msk <<= 1) {
		if (!(msk & valid_bits)) continue;
		valid_bits &= ~msk;
		if (!names[idx]) continue;
		slen = strlen(names[idx]);
		if (slen != len) continue;
		if (memcmp(names[idx],ptr,slen)) continue;
		*valptr = msk;
		return 0;
	}
	if (len >= sizeof(buf)) return -EINVAL;
	memcpy(buf,ptr,len);
	buf[len] = 0;
	*valptr = simple_strtol(buf,&p2,0);
	if (*p2) return -EINVAL;
	return 0;
}


static int parse_tlist(const char *ptr,unsigned int len,
		       int *maskptr,int *valptr,
		       const char **names,int valid_bits)
{
	unsigned int cnt;
	int mask,val,kv,mode,ret;
	mask = 0;
	val = 0;
	ret = 0;
	while (len) {
		cnt = 0;
		while ((cnt < len) &&
		       ((ptr[cnt] <= 32) ||
			(ptr[cnt] >= 127))) cnt++;
		ptr += cnt;
		len -= cnt;
		mode = 0;
		if ((*ptr == '-') || (*ptr == '+')) {
			mode = (*ptr == '-') ? -1 : 1;
			ptr++;
			len--;
		}
		cnt = 0;
		while (cnt < len) {
			if (ptr[cnt] <= 32) break;
			if (ptr[cnt] >= 127) break;
			cnt++;
		}
		if (!cnt) break;
		if (parse_mtoken(ptr,cnt,&kv,names,valid_bits)) {
			ret = -EINVAL;
			break;
		}
		ptr += cnt;
		len -= cnt;
		switch (mode) {
		case 0:
			mask = valid_bits;
			val |= kv;
			break;
		case -1:
			mask |= kv;
			val &= ~kv;
			break;
		case 1:
			mask |= kv;
			val |= kv;
			break;
		default:
			break;
		}
	}
	*maskptr = mask;
	*valptr = val;
	return ret;
}


/* Convert a symbolic value to a mask/value pair */
int pvr2_ctrl_sym_to_value(struct pvr2_ctrl *cptr,
			   const char *ptr,unsigned int len,
			   int *maskptr,int *valptr)
{
	int ret = -EINVAL;
	unsigned int cnt;

	*maskptr = 0;
	*valptr = 0;

	cnt = 0;
	while ((cnt < len) && ((ptr[cnt] <= 32) || (ptr[cnt] >= 127))) cnt++;
	len -= cnt; ptr += cnt;
	cnt = 0;
	while ((cnt < len) && ((ptr[len-(cnt+1)] <= 32) ||
			       (ptr[len-(cnt+1)] >= 127))) cnt++;
	len -= cnt;

	if (!len) return -EINVAL;

	LOCK_TAKE(cptr->hdw->big_lock); do {
		if (cptr->info->type == pvr2_ctl_int) {
			ret = parse_token(ptr,len,valptr,NULL,0);
			if (ret >= 0) {
				ret = pvr2_ctrl_range_check(cptr,*valptr);
			}
			if (maskptr) *maskptr = ~0;
		} else if (cptr->info->type == pvr2_ctl_bool) {
			ret = parse_token(ptr,len,valptr,boolNames,
					  ARRAY_SIZE(boolNames));
			if (ret == 1) {
				*valptr = *valptr ? !0 : 0;
			} else if (ret == 0) {
				*valptr = (*valptr & 1) ? !0 : 0;
			}
			if (maskptr) *maskptr = 1;
		} else if (cptr->info->type == pvr2_ctl_enum) {
			ret = parse_token(
				ptr,len,valptr,
				cptr->info->def.type_enum.value_names,
				cptr->info->def.type_enum.count);
			if ((ret >= 0) &&
			    ((*valptr < 0) ||
			     (*valptr >= cptr->info->def.type_enum.count))) {
				ret = -ERANGE;
			}
			if (maskptr) *maskptr = ~0;
		} else if (cptr->info->type == pvr2_ctl_bitmask) {
			ret = parse_tlist(
				ptr,len,maskptr,valptr,
				cptr->info->def.type_bitmask.bit_names,
				cptr->info->def.type_bitmask.valid_bits);
		}
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/* Convert a given mask/val to a symbolic value */
int pvr2_ctrl_value_to_sym_internal(struct pvr2_ctrl *cptr,
				    int mask,int val,
				    char *buf,unsigned int maxlen,
				    unsigned int *len)
{
	int ret = -EINVAL;

	*len = 0;
	if (cptr->info->type == pvr2_ctl_int) {
		*len = scnprintf(buf,maxlen,"%d",val);
		ret = 0;
	} else if (cptr->info->type == pvr2_ctl_bool) {
		*len = scnprintf(buf,maxlen,"%s",val ? "true" : "false");
		ret = 0;
	} else if (cptr->info->type == pvr2_ctl_enum) {
		const char **names;
		names = cptr->info->def.type_enum.value_names;
		if ((val >= 0) &&
		    (val < cptr->info->def.type_enum.count)) {
			if (names[val]) {
				*len = scnprintf(
					buf,maxlen,"%s",
					names[val]);
			} else {
				*len = 0;
			}
			ret = 0;
		}
	} else if (cptr->info->type == pvr2_ctl_bitmask) {
		*len = gen_bitmask_string(
			val & mask & cptr->info->def.type_bitmask.valid_bits,
			~0,!0,
			cptr->info->def.type_bitmask.bit_names,
			buf,maxlen);
	}
	return ret;
}


/* Convert a given mask/val to a symbolic value */
int pvr2_ctrl_value_to_sym(struct pvr2_ctrl *cptr,
			   int mask,int val,
			   char *buf,unsigned int maxlen,
			   unsigned int *len)
{
	int ret;
	LOCK_TAKE(cptr->hdw->big_lock); do {
		ret = pvr2_ctrl_value_to_sym_internal(cptr,mask,val,
						      buf,maxlen,len);
	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	return ret;
}


/*
  Stuff for Emacs to see, in order to encourage consistent editing style:
  *** Local Variables: ***
  *** mode: c ***
  *** fill-column: 75 ***
  *** tab-width: 8 ***
  *** c-basic-offset: 8 ***
  *** End: ***
  */
Commit	Line	Data
d855497e MI	1	/*
	2	*
	3	* $Id$
	4	*
	5	* Copyright (C) 2005 Mike Isely <isely@pobox.com>
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	19	*
	20	*/
	21
	22	#include "pvrusb2-ctrl.h"
	23	#include "pvrusb2-hdw-internal.h"
	24	#include <linux/errno.h>
	25	#include <linux/string.h>
	26	#include <linux/mutex.h>
	27
	28
5549f54f MI	29	static int pvr2_ctrl_range_check(struct pvr2_ctrl *cptr,int val)
	30	{
	31	if (cptr->info->check_value) {
	32	if (!cptr->info->check_value(cptr,val)) return -ERANGE;
	33	} else {
	34	int lim;
	35	lim = cptr->info->def.type_int.min_value;
	36	if (cptr->info->get_min_value) {
	37	cptr->info->get_min_value(cptr,&lim);
	38	}
	39	if (val < lim) return -ERANGE;
	40	lim = cptr->info->def.type_int.max_value;
	41	if (cptr->info->get_max_value) {
	42	cptr->info->get_max_value(cptr,&lim);
	43	}
	44	if (val > lim) return -ERANGE;
	45	}
	46	return 0;
	47	}
	48
	49
d855497e MI	50	/* Set the given control. */
	51	int pvr2_ctrl_set_value(struct pvr2_ctrl *cptr,int val)
	52	{
	53	return pvr2_ctrl_set_mask_value(cptr,~0,val);
	54	}
	55
	56
	57	/* Set/clear specific bits of the given control. */
	58	int pvr2_ctrl_set_mask_value(struct pvr2_ctrl *cptr,int mask,int val)
	59	{
	60	int ret = 0;
	61	if (!cptr) return -EINVAL;
	62	LOCK_TAKE(cptr->hdw->big_lock); do {
5fa1247a	63	if (cptr->info->set_value) {
d855497e MI	64	if (cptr->info->type == pvr2_ctl_bitmask) {
	65	mask &= cptr->info->def.type_bitmask.valid_bits;
	66	} else if (cptr->info->type == pvr2_ctl_int) {
5549f54f MI	67	ret = pvr2_ctrl_range_check(cptr,val);
5549f54f MI	68	if (ret < 0) break;
d855497e MI	69	} else if (cptr->info->type == pvr2_ctl_enum) {
	70	if (val >= cptr->info->def.type_enum.count) {
	71	break;
	72	}
33213963 MI	73	} else if (cptr->info->type != pvr2_ctl_bool) {
33213963 MI	74	break;
d855497e MI	75	}
	76	ret = cptr->info->set_value(cptr,mask,val);
	77	} else {
	78	ret = -EPERM;
	79	}
	80	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	81	return ret;
	82	}
	83
	84
	85	/* Get the current value of the given control. */
	86	int pvr2_ctrl_get_value(struct pvr2_ctrl cptr,int valptr)
	87	{
	88	int ret = 0;
	89	if (!cptr) return -EINVAL;
	90	LOCK_TAKE(cptr->hdw->big_lock); do {
	91	ret = cptr->info->get_value(cptr,valptr);
	92	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	93	return ret;
	94	}
	95
	96
	97	/* Retrieve control's type */
	98	enum pvr2_ctl_type pvr2_ctrl_get_type(struct pvr2_ctrl *cptr)
	99	{
	100	if (!cptr) return pvr2_ctl_int;
	101	return cptr->info->type;
	102	}
	103
	104
	105	/* Retrieve control's maximum value (int type) */
	106	int pvr2_ctrl_get_max(struct pvr2_ctrl *cptr)
	107	{
	108	int ret = 0;
	109	if (!cptr) return 0;
	110	LOCK_TAKE(cptr->hdw->big_lock); do {
89ebd63f MI	111	if (cptr->info->get_max_value) {
	112	cptr->info->get_max_value(cptr,&ret);
	113	} else if (cptr->info->type == pvr2_ctl_int) {
d855497e MI	114	ret = cptr->info->def.type_int.max_value;
	115	}
	116	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	117	return ret;
	118	}
	119
	120
	121	/* Retrieve control's minimum value (int type) */
	122	int pvr2_ctrl_get_min(struct pvr2_ctrl *cptr)
	123	{
	124	int ret = 0;
	125	if (!cptr) return 0;
	126	LOCK_TAKE(cptr->hdw->big_lock); do {
89ebd63f MI	127	if (cptr->info->get_min_value) {
	128	cptr->info->get_min_value(cptr,&ret);
	129	} else if (cptr->info->type == pvr2_ctl_int) {
d855497e MI	130	ret = cptr->info->def.type_int.min_value;
	131	}
	132	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	133	return ret;
	134	}
	135
	136
	137	/* Retrieve control's default value (any type) */
	138	int pvr2_ctrl_get_def(struct pvr2_ctrl *cptr)
	139	{
	140	int ret = 0;
	141	if (!cptr) return 0;
	142	LOCK_TAKE(cptr->hdw->big_lock); do {
	143	if (cptr->info->type == pvr2_ctl_int) {
	144	ret = cptr->info->default_value;
	145	}
	146	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	147	return ret;
	148	}
	149
	150
	151	/* Retrieve control's enumeration count (enum only) */
	152	int pvr2_ctrl_get_cnt(struct pvr2_ctrl *cptr)
	153	{
	154	int ret = 0;
	155	if (!cptr) return 0;
	156	LOCK_TAKE(cptr->hdw->big_lock); do {
	157	if (cptr->info->type == pvr2_ctl_enum) {
	158	ret = cptr->info->def.type_enum.count;
	159	}
	160	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	161	return ret;
	162	}
	163
	164
	165	/* Retrieve control's valid mask bits (bit mask only) */
	166	int pvr2_ctrl_get_mask(struct pvr2_ctrl *cptr)
	167	{
	168	int ret = 0;
	169	if (!cptr) return 0;
	170	LOCK_TAKE(cptr->hdw->big_lock); do {
	171	if (cptr->info->type == pvr2_ctl_bitmask) {
	172	ret = cptr->info->def.type_bitmask.valid_bits;
	173	}
	174	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	175	return ret;
	176	}
	177
	178
	179	/* Retrieve the control's name */
	180	const char pvr2_ctrl_get_name(struct pvr2_ctrl cptr)
	181	{
a0fd1cb1	182	if (!cptr) return NULL;
d855497e MI	183	return cptr->info->name;
	184	}
	185
	186
	187	/* Retrieve the control's desc */
	188	const char pvr2_ctrl_get_desc(struct pvr2_ctrl cptr)
	189	{
a0fd1cb1	190	if (!cptr) return NULL;
d855497e MI	191	return cptr->info->desc;
	192	}
	193
	194
	195	/* Retrieve a control enumeration or bit mask value */
	196	int pvr2_ctrl_get_valname(struct pvr2_ctrl *cptr,int val,
	197	char *bptr,unsigned int bmax,
	198	unsigned int *blen)
	199	{
	200	int ret = -EINVAL;
	201	if (!cptr) return 0;
	202	*blen = 0;
	203	LOCK_TAKE(cptr->hdw->big_lock); do {
	204	if (cptr->info->type == pvr2_ctl_enum) {
	205	const char **names;
	206	names = cptr->info->def.type_enum.value_names;
	207	if ((val >= 0) &&
	208	(val < cptr->info->def.type_enum.count)) {
	209	if (names[val]) {
	210	*blen = scnprintf(
	211	bptr,bmax,"%s",
	212	names[val]);
	213	} else {
	214	*blen = 0;
	215	}
	216	ret = 0;
	217	}
	218	} else if (cptr->info->type == pvr2_ctl_bitmask) {
	219	const char **names;
	220	unsigned int idx;
	221	int msk;
	222	names = cptr->info->def.type_bitmask.bit_names;
	223	val &= cptr->info->def.type_bitmask.valid_bits;
	224	for (idx = 0, msk = 1; val; idx++, msk <<= 1) {
	225	if (val & msk) {
	226	*blen = scnprintf(bptr,bmax,"%s",
	227	names[idx]);
	228	ret = 0;
	229	break;
	230	}
	231	}
	232	}
	233	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	234	return ret;
	235	}
	236
	237
a761f431 MI	238	/* Return V4L ID for this control or zero if none */
	239	int pvr2_ctrl_get_v4lid(struct pvr2_ctrl *cptr)
	240	{
	241	if (!cptr) return 0;
	242	return cptr->info->v4l_id;
	243	}
	244
	245
	246	unsigned int pvr2_ctrl_get_v4lflags(struct pvr2_ctrl *cptr)
	247	{
	248	unsigned int flags = 0;
	249
	250	if (cptr->info->get_v4lflags) {
	251	flags = cptr->info->get_v4lflags(cptr);
	252	}
	253
1d9f8461 MI	254	if (cptr->info->set_value) {
	255	flags &= ~V4L2_CTRL_FLAG_READ_ONLY;
	256	} else {
	257	flags \|= V4L2_CTRL_FLAG_READ_ONLY;
	258	}
a761f431 MI	259
	260	return flags;
	261	}
	262
	263
d855497e MI	264	/* Return true if control is writable */
	265	int pvr2_ctrl_is_writable(struct pvr2_ctrl *cptr)
	266	{
	267	if (!cptr) return 0;
5fa1247a	268	return cptr->info->set_value != NULL;
d855497e MI	269	}
	270
	271
	272	/* Return true if control has custom symbolic representation */
	273	int pvr2_ctrl_has_custom_symbols(struct pvr2_ctrl *cptr)
	274	{
	275	if (!cptr) return 0;
	276	if (!cptr->info->val_to_sym) return 0;
	277	if (!cptr->info->sym_to_val) return 0;
	278	return !0;
	279	}
	280
	281
	282	/* Convert a given mask/val to a custom symbolic value */
	283	int pvr2_ctrl_custom_value_to_sym(struct pvr2_ctrl *cptr,
	284	int mask,int val,
	285	char *buf,unsigned int maxlen,
	286	unsigned int *len)
	287	{
	288	if (!cptr) return -EINVAL;
	289	if (!cptr->info->val_to_sym) return -EINVAL;
	290	return cptr->info->val_to_sym(cptr,mask,val,buf,maxlen,len);
	291	}
	292
	293
	294	/* Convert a symbolic value to a mask/value pair */
	295	int pvr2_ctrl_custom_sym_to_value(struct pvr2_ctrl *cptr,
	296	const char *buf,unsigned int len,
	297	int maskptr,int valptr)
	298	{
	299	if (!cptr) return -EINVAL;
	300	if (!cptr->info->sym_to_val) return -EINVAL;
	301	return cptr->info->sym_to_val(cptr,buf,len,maskptr,valptr);
	302	}
	303
	304
	305	static unsigned int gen_bitmask_string(int msk,int val,int msk_only,
	306	const char **names,
	307	char *ptr,unsigned int len)
	308	{
	309	unsigned int idx;
	310	long sm,um;
	311	int spcFl;
	312	unsigned int uc,cnt;
	313	const char *idStr;
	314
	315	spcFl = 0;
	316	uc = 0;
	317	um = 0;
	318	for (idx = 0, sm = 1; msk; idx++, sm <<= 1) {
	319	if (sm & msk) {
	320	msk &= ~sm;
	321	idStr = names[idx];
	322	if (idStr) {
	323	cnt = scnprintf(ptr,len,"%s%s%s",
	324	(spcFl ? " " : ""),
	325	(msk_only ? "" :
	326	((val & sm) ? "+" : "-")),
	327	idStr);
	328	ptr += cnt; len -= cnt; uc += cnt;
	329	spcFl = !0;
	330	} else {
	331	um \|= sm;
	332	}
333	}
334	}
335	if (um) {
336	if (msk_only) {
337	cnt = scnprintf(ptr,len,"%s0x%lx",
338	(spcFl ? " " : ""),
339	um);
340	ptr += cnt; len -= cnt; uc += cnt;
341	spcFl = !0;
342	} else if (um & val) {
343	cnt = scnprintf(ptr,len,"%s+0x%lx",
344	(spcFl ? " " : ""),
345	um & val);
346	ptr += cnt; len -= cnt; uc += cnt;
347	spcFl = !0;
348	} else if (um & ~val) {
349	cnt = scnprintf(ptr,len,"%s+0x%lx",
350	(spcFl ? " " : ""),
351	um & ~val);
352	ptr += cnt; len -= cnt; uc += cnt;
353	spcFl = !0;
354	}
355	}
356	return uc;
357	}
358
359
33213963 MI	360	static const char *boolNames[] = {
	361	"false",
	362	"true",
	363	"no",
	364	"yes",
	365	};
	366
	367
d855497e MI	368	static int parse_token(const char *ptr,unsigned int len,
	369	int *valptr,
	370	const char **names,unsigned int namecnt)
	371	{
	372	char buf[33];
	373	unsigned int slen;
	374	unsigned int idx;
	375	int negfl;
	376	char *p2;
	377	*valptr = 0;
	378	if (!names) namecnt = 0;
	379	for (idx = 0; idx < namecnt; idx++) {
	380	if (!names[idx]) continue;
	381	slen = strlen(names[idx]);
	382	if (slen != len) continue;
	383	if (memcmp(names[idx],ptr,slen)) continue;
	384	*valptr = idx;
	385	return 0;
	386	}
	387	negfl = 0;
	388	if ((ptr == '-') \|\| (ptr == '+')) {
	389	negfl = (*ptr == '-');
	390	ptr++; len--;
	391	}
	392	if (len >= sizeof(buf)) return -EINVAL;
	393	memcpy(buf,ptr,len);
	394	buf[len] = 0;
	395	*valptr = simple_strtol(buf,&p2,0);
	396	if (negfl) valptr = -(valptr);
	397	if (*p2) return -EINVAL;
33213963	398	return 1;
d855497e MI	399	}
	400
	401
	402	static int parse_mtoken(const char *ptr,unsigned int len,
	403	int *valptr,
	404	const char **names,int valid_bits)
	405	{
	406	char buf[33];
	407	unsigned int slen;
	408	unsigned int idx;
	409	char *p2;
	410	int msk;
	411	*valptr = 0;
	412	for (idx = 0, msk = 1; valid_bits; idx++, msk <<= 1) {
4ed53a5a	413	if (!(msk & valid_bits)) continue;
d855497e MI	414	valid_bits &= ~msk;
	415	if (!names[idx]) continue;
	416	slen = strlen(names[idx]);
	417	if (slen != len) continue;
	418	if (memcmp(names[idx],ptr,slen)) continue;
	419	*valptr = msk;
	420	return 0;
	421	}
	422	if (len >= sizeof(buf)) return -EINVAL;
	423	memcpy(buf,ptr,len);
	424	buf[len] = 0;
	425	*valptr = simple_strtol(buf,&p2,0);
	426	if (*p2) return -EINVAL;
	427	return 0;
	428	}
	429
	430
	431	static int parse_tlist(const char *ptr,unsigned int len,
	432	int maskptr,int valptr,
	433	const char **names,int valid_bits)
	434	{
	435	unsigned int cnt;
	436	int mask,val,kv,mode,ret;
	437	mask = 0;
	438	val = 0;
	439	ret = 0;
	440	while (len) {
	441	cnt = 0;
	442	while ((cnt < len) &&
	443	((ptr[cnt] <= 32) \|\|
	444	(ptr[cnt] >= 127))) cnt++;
	445	ptr += cnt;
	446	len -= cnt;
	447	mode = 0;
	448	if ((ptr == '-') \|\| (ptr == '+')) {
	449	mode = (*ptr == '-') ? -1 : 1;
	450	ptr++;
	451	len--;
	452	}
	453	cnt = 0;
	454	while (cnt < len) {
	455	if (ptr[cnt] <= 32) break;
	456	if (ptr[cnt] >= 127) break;
	457	cnt++;
	458	}
	459	if (!cnt) break;
	460	if (parse_mtoken(ptr,cnt,&kv,names,valid_bits)) {
	461	ret = -EINVAL;
	462	break;
	463	}
	464	ptr += cnt;
	465	len -= cnt;
	466	switch (mode) {
	467	case 0:
	468	mask = valid_bits;
	469	val \|= kv;
	470	break;
	471	case -1:
	472	mask \|= kv;
	473	val &= ~kv;
	474	break;
	475	case 1:
	476	mask \|= kv;
	477	val \|= kv;
478	break;
479	default:
480	break;
481	}
482	}
483	*maskptr = mask;
484	*valptr = val;
485	return ret;
486	}
487
488
489	/* Convert a symbolic value to a mask/value pair */
490	int pvr2_ctrl_sym_to_value(struct pvr2_ctrl *cptr,
491	const char *ptr,unsigned int len,
492	int maskptr,int valptr)
493	{
494	int ret = -EINVAL;
495	unsigned int cnt;
496
497	*maskptr = 0;
498	*valptr = 0;
499
500	cnt = 0;
501	while ((cnt < len) && ((ptr[cnt] <= 32) \|\| (ptr[cnt] >= 127))) cnt++;
502	len -= cnt; ptr += cnt;
503	cnt = 0;
504	while ((cnt < len) && ((ptr[len-(cnt+1)] <= 32) \|\|
505	(ptr[len-(cnt+1)] >= 127))) cnt++;
506	len -= cnt;
507
508	if (!len) return -EINVAL;
509
510	LOCK_TAKE(cptr->hdw->big_lock); do {
511	if (cptr->info->type == pvr2_ctl_int) {
a0fd1cb1	512	ret = parse_token(ptr,len,valptr,NULL,0);
6fcb5b3e	513	if (ret >= 0) {
5549f54f	514	ret = pvr2_ctrl_range_check(cptr,*valptr);
d855497e MI	515	}
d855497e MI	516	if (maskptr) *maskptr = ~0;
33213963	517	} else if (cptr->info->type == pvr2_ctl_bool) {
27c7b710 MI	518	ret = parse_token(ptr,len,valptr,boolNames,
27c7b710 MI	519	ARRAY_SIZE(boolNames));
33213963 MI	520	if (ret == 1) {
	521	valptr = valptr ? !0 : 0;
	522	} else if (ret == 0) {
	523	valptr = (valptr & 1) ? !0 : 0;
	524	}
	525	if (maskptr) *maskptr = 1;
d855497e MI	526	} else if (cptr->info->type == pvr2_ctl_enum) {
	527	ret = parse_token(
	528	ptr,len,valptr,
	529	cptr->info->def.type_enum.value_names,
	530	cptr->info->def.type_enum.count);
33213963	531	if ((ret >= 0) &&
d855497e MI	532	((*valptr < 0) \|\|
d855497e MI	533	(*valptr >= cptr->info->def.type_enum.count))) {
33213963	534	ret = -ERANGE;
d855497e MI	535	}
	536	if (maskptr) *maskptr = ~0;
	537	} else if (cptr->info->type == pvr2_ctl_bitmask) {
	538	ret = parse_tlist(
	539	ptr,len,maskptr,valptr,
	540	cptr->info->def.type_bitmask.bit_names,
	541	cptr->info->def.type_bitmask.valid_bits);
	542	}
	543	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	544	return ret;
	545	}
	546
	547
	548	/* Convert a given mask/val to a symbolic value */
	549	int pvr2_ctrl_value_to_sym_internal(struct pvr2_ctrl *cptr,
	550	int mask,int val,
	551	char *buf,unsigned int maxlen,
	552	unsigned int *len)
	553	{
	554	int ret = -EINVAL;
	555
	556	*len = 0;
	557	if (cptr->info->type == pvr2_ctl_int) {
	558	*len = scnprintf(buf,maxlen,"%d",val);
	559	ret = 0;
33213963 MI	560	} else if (cptr->info->type == pvr2_ctl_bool) {
	561	*len = scnprintf(buf,maxlen,"%s",val ? "true" : "false");
	562	ret = 0;
d855497e MI	563	} else if (cptr->info->type == pvr2_ctl_enum) {
	564	const char **names;
	565	names = cptr->info->def.type_enum.value_names;
	566	if ((val >= 0) &&
	567	(val < cptr->info->def.type_enum.count)) {
	568	if (names[val]) {
	569	*len = scnprintf(
	570	buf,maxlen,"%s",
	571	names[val]);
	572	} else {
	573	*len = 0;
	574	}
	575	ret = 0;
	576	}
	577	} else if (cptr->info->type == pvr2_ctl_bitmask) {
	578	*len = gen_bitmask_string(
	579	val & mask & cptr->info->def.type_bitmask.valid_bits,
	580	~0,!0,
	581	cptr->info->def.type_bitmask.bit_names,
	582	buf,maxlen);
	583	}
	584	return ret;
	585	}
	586
	587
	588	/* Convert a given mask/val to a symbolic value */
	589	int pvr2_ctrl_value_to_sym(struct pvr2_ctrl *cptr,
	590	int mask,int val,
	591	char *buf,unsigned int maxlen,
	592	unsigned int *len)
	593	{
	594	int ret;
	595	LOCK_TAKE(cptr->hdw->big_lock); do {
	596	ret = pvr2_ctrl_value_to_sym_internal(cptr,mask,val,
	597	buf,maxlen,len);
	598	} while(0); LOCK_GIVE(cptr->hdw->big_lock);
	599	return ret;
	600	}
	601
	602
	603	/*
	604	Stuff for Emacs to see, in order to encourage consistent editing style:
	605	* Local Variables: *
	606	* mode: c *
	607	* fill-column: 75 *
	608	* tab-width: 8 *
	609	* c-basic-offset: 8 *
	610	* End: *
	611	*/