[media] v4l2-ctrls: prepare for array support

Add core support for N-dimensional arrays.

Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: Mauro Carvalho Chehab <m.chehab@samsung.com>
This commit is contained in:
Hans Verkuil 2014-06-10 07:55:00 -03:00 committed by Mauro Carvalho Chehab
parent 20d88eef66
commit 998e765915
2 changed files with 44 additions and 22 deletions

View file

@ -1161,7 +1161,7 @@ static void send_event(struct v4l2_fh *fh, struct v4l2_ctrl *ctrl, u32 changes)
v4l2_event_queue_fh(sev->fh, &ev); v4l2_event_queue_fh(sev->fh, &ev);
} }
static bool std_equal(const struct v4l2_ctrl *ctrl, static bool std_equal(const struct v4l2_ctrl *ctrl, u32 idx,
union v4l2_ctrl_ptr ptr1, union v4l2_ctrl_ptr ptr1,
union v4l2_ctrl_ptr ptr2) union v4l2_ctrl_ptr ptr2)
{ {
@ -1180,7 +1180,7 @@ static bool std_equal(const struct v4l2_ctrl *ctrl,
} }
} }
static void std_init(const struct v4l2_ctrl *ctrl, static void std_init(const struct v4l2_ctrl *ctrl, u32 idx,
union v4l2_ctrl_ptr ptr) union v4l2_ctrl_ptr ptr)
{ {
switch (ctrl->type) { switch (ctrl->type) {
@ -1207,6 +1207,14 @@ static void std_log(const struct v4l2_ctrl *ctrl)
{ {
union v4l2_ctrl_ptr ptr = ctrl->p_cur; union v4l2_ctrl_ptr ptr = ctrl->p_cur;
if (ctrl->is_array) {
unsigned i;
for (i = 0; i < ctrl->nr_of_dims; i++)
pr_cont("[%u]", ctrl->dims[i]);
pr_cont(" ");
}
switch (ctrl->type) { switch (ctrl->type) {
case V4L2_CTRL_TYPE_INTEGER: case V4L2_CTRL_TYPE_INTEGER:
pr_cont("%d", *ptr.p_s32); pr_cont("%d", *ptr.p_s32);
@ -1249,7 +1257,7 @@ static void std_log(const struct v4l2_ctrl *ctrl)
}) })
/* Validate a new control */ /* Validate a new control */
static int std_validate(const struct v4l2_ctrl *ctrl, static int std_validate(const struct v4l2_ctrl *ctrl, u32 idx,
union v4l2_ctrl_ptr ptr) union v4l2_ctrl_ptr ptr)
{ {
size_t len; size_t len;
@ -1473,8 +1481,8 @@ static int cluster_changed(struct v4l2_ctrl *master)
if (ctrl == NULL) if (ctrl == NULL)
continue; continue;
ctrl->has_changed = !ctrl->type_ops->equal(ctrl, ctrl->has_changed = !ctrl->type_ops->equal(ctrl, 0,
ctrl->p_cur, ctrl->p_new); ctrl->p_cur, ctrl->p_new);
changed |= ctrl->has_changed; changed |= ctrl->has_changed;
} }
return changed; return changed;
@ -1531,15 +1539,15 @@ static int validate_new(const struct v4l2_ctrl *ctrl,
case V4L2_CTRL_TYPE_BUTTON: case V4L2_CTRL_TYPE_BUTTON:
case V4L2_CTRL_TYPE_CTRL_CLASS: case V4L2_CTRL_TYPE_CTRL_CLASS:
ptr.p_s32 = &c->value; ptr.p_s32 = &c->value;
return ctrl->type_ops->validate(ctrl, ptr); return ctrl->type_ops->validate(ctrl, 0, ptr);
case V4L2_CTRL_TYPE_INTEGER64: case V4L2_CTRL_TYPE_INTEGER64:
ptr.p_s64 = &c->value64; ptr.p_s64 = &c->value64;
return ctrl->type_ops->validate(ctrl, ptr); return ctrl->type_ops->validate(ctrl, 0, ptr);
default: default:
ptr.p = c->ptr; ptr.p = c->ptr;
return ctrl->type_ops->validate(ctrl, ptr); return ctrl->type_ops->validate(ctrl, 0, ptr);
} }
} }
@ -1767,6 +1775,8 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
unsigned sz_extra; unsigned sz_extra;
unsigned nr_of_dims = 0; unsigned nr_of_dims = 0;
unsigned elems = 1; unsigned elems = 1;
bool is_array;
unsigned tot_ctrl_size;
void *data; void *data;
int err; int err;
@ -1779,6 +1789,7 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
if (nr_of_dims == V4L2_CTRL_MAX_DIMS) if (nr_of_dims == V4L2_CTRL_MAX_DIMS)
break; break;
} }
is_array = nr_of_dims > 0;
if (type == V4L2_CTRL_TYPE_INTEGER64) if (type == V4L2_CTRL_TYPE_INTEGER64)
elem_size = sizeof(s64); elem_size = sizeof(s64);
@ -1786,10 +1797,11 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
elem_size = max + 1; elem_size = max + 1;
else if (type < V4L2_CTRL_COMPOUND_TYPES) else if (type < V4L2_CTRL_COMPOUND_TYPES)
elem_size = sizeof(s32); elem_size = sizeof(s32);
tot_ctrl_size = elem_size * elems;
/* Sanity checks */ /* Sanity checks */
if (id == 0 || name == NULL || id >= V4L2_CID_PRIVATE_BASE || if (id == 0 || name == NULL || !elem_size ||
elem_size == 0 || id >= V4L2_CID_PRIVATE_BASE ||
(type == V4L2_CTRL_TYPE_MENU && qmenu == NULL) || (type == V4L2_CTRL_TYPE_MENU && qmenu == NULL) ||
(type == V4L2_CTRL_TYPE_INTEGER_MENU && qmenu_int == NULL)) { (type == V4L2_CTRL_TYPE_INTEGER_MENU && qmenu_int == NULL)) {
handler_set_err(hdl, -ERANGE); handler_set_err(hdl, -ERANGE);
@ -1804,6 +1816,12 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
handler_set_err(hdl, -ERANGE); handler_set_err(hdl, -ERANGE);
return NULL; return NULL;
} }
if (is_array &&
(type == V4L2_CTRL_TYPE_BUTTON ||
type == V4L2_CTRL_TYPE_CTRL_CLASS)) {
handler_set_err(hdl, -EINVAL);
return NULL;
}
sz_extra = 0; sz_extra = 0;
if (type == V4L2_CTRL_TYPE_BUTTON) if (type == V4L2_CTRL_TYPE_BUTTON)
@ -1812,8 +1830,9 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
flags |= V4L2_CTRL_FLAG_READ_ONLY; flags |= V4L2_CTRL_FLAG_READ_ONLY;
else if (type == V4L2_CTRL_TYPE_INTEGER64 || else if (type == V4L2_CTRL_TYPE_INTEGER64 ||
type == V4L2_CTRL_TYPE_STRING || type == V4L2_CTRL_TYPE_STRING ||
type >= V4L2_CTRL_COMPOUND_TYPES) type >= V4L2_CTRL_COMPOUND_TYPES ||
sz_extra += 2 * elem_size; is_array)
sz_extra += 2 * tot_ctrl_size;
ctrl = kzalloc(sizeof(*ctrl) + sz_extra, GFP_KERNEL); ctrl = kzalloc(sizeof(*ctrl) + sz_extra, GFP_KERNEL);
if (ctrl == NULL) { if (ctrl == NULL) {
@ -1834,9 +1853,10 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
ctrl->maximum = max; ctrl->maximum = max;
ctrl->step = step; ctrl->step = step;
ctrl->default_value = def; ctrl->default_value = def;
ctrl->is_string = type == V4L2_CTRL_TYPE_STRING; ctrl->is_string = !is_array && type == V4L2_CTRL_TYPE_STRING;
ctrl->is_ptr = type >= V4L2_CTRL_COMPOUND_TYPES || ctrl->is_string; ctrl->is_ptr = is_array || type >= V4L2_CTRL_COMPOUND_TYPES || ctrl->is_string;
ctrl->is_int = !ctrl->is_ptr && type != V4L2_CTRL_TYPE_INTEGER64; ctrl->is_int = !ctrl->is_ptr && type != V4L2_CTRL_TYPE_INTEGER64;
ctrl->is_array = is_array;
ctrl->elems = elems; ctrl->elems = elems;
ctrl->nr_of_dims = nr_of_dims; ctrl->nr_of_dims = nr_of_dims;
if (nr_of_dims) if (nr_of_dims)
@ -1852,13 +1872,13 @@ static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
if (!ctrl->is_int) { if (!ctrl->is_int) {
ctrl->p_new.p = data; ctrl->p_new.p = data;
ctrl->p_cur.p = data + elem_size; ctrl->p_cur.p = data + tot_ctrl_size;
} else { } else {
ctrl->p_new.p = &ctrl->val; ctrl->p_new.p = &ctrl->val;
ctrl->p_cur.p = &ctrl->cur.val; ctrl->p_cur.p = &ctrl->cur.val;
} }
ctrl->type_ops->init(ctrl, ctrl->p_cur); ctrl->type_ops->init(ctrl, 0, ctrl->p_cur);
ctrl->type_ops->init(ctrl, ctrl->p_new); ctrl->type_ops->init(ctrl, 0, ctrl->p_new);
if (handler_new_ref(hdl, ctrl)) { if (handler_new_ref(hdl, ctrl)) {
kfree(ctrl); kfree(ctrl);
@ -2764,7 +2784,7 @@ s64 v4l2_ctrl_g_ctrl_int64(struct v4l2_ctrl *ctrl)
struct v4l2_ext_control c; struct v4l2_ext_control c;
/* It's a driver bug if this happens. */ /* It's a driver bug if this happens. */
WARN_ON(ctrl->type != V4L2_CTRL_TYPE_INTEGER64); WARN_ON(ctrl->is_ptr || ctrl->type != V4L2_CTRL_TYPE_INTEGER64);
c.value = 0; c.value = 0;
get_ctrl(ctrl, &c); get_ctrl(ctrl, &c);
return c.value; return c.value;
@ -3074,7 +3094,7 @@ int v4l2_ctrl_s_ctrl_int64(struct v4l2_ctrl *ctrl, s64 val)
struct v4l2_ext_control c; struct v4l2_ext_control c;
/* It's a driver bug if this happens. */ /* It's a driver bug if this happens. */
WARN_ON(ctrl->type != V4L2_CTRL_TYPE_INTEGER64); WARN_ON(ctrl->is_ptr || ctrl->type != V4L2_CTRL_TYPE_INTEGER64);
c.value64 = val; c.value64 = val;
return set_ctrl_lock(NULL, ctrl, &c); return set_ctrl_lock(NULL, ctrl, &c);
} }

View file

@ -74,13 +74,13 @@ struct v4l2_ctrl_ops {
* @validate: validate the value. Return 0 on success and a negative value otherwise. * @validate: validate the value. Return 0 on success and a negative value otherwise.
*/ */
struct v4l2_ctrl_type_ops { struct v4l2_ctrl_type_ops {
bool (*equal)(const struct v4l2_ctrl *ctrl, bool (*equal)(const struct v4l2_ctrl *ctrl, u32 idx,
union v4l2_ctrl_ptr ptr1, union v4l2_ctrl_ptr ptr1,
union v4l2_ctrl_ptr ptr2); union v4l2_ctrl_ptr ptr2);
void (*init)(const struct v4l2_ctrl *ctrl, void (*init)(const struct v4l2_ctrl *ctrl, u32 idx,
union v4l2_ctrl_ptr ptr); union v4l2_ctrl_ptr ptr);
void (*log)(const struct v4l2_ctrl *ctrl); void (*log)(const struct v4l2_ctrl *ctrl);
int (*validate)(const struct v4l2_ctrl *ctrl, int (*validate)(const struct v4l2_ctrl *ctrl, u32 idx,
union v4l2_ctrl_ptr ptr); union v4l2_ctrl_ptr ptr);
}; };
@ -111,6 +111,7 @@ typedef void (*v4l2_ctrl_notify_fnc)(struct v4l2_ctrl *ctrl, void *priv);
* @is_ptr: If set, then this control is an array and/or has type >= V4L2_CTRL_COMPOUND_TYPES * @is_ptr: If set, then this control is an array and/or has type >= V4L2_CTRL_COMPOUND_TYPES
* and/or has type V4L2_CTRL_TYPE_STRING. In other words, struct * and/or has type V4L2_CTRL_TYPE_STRING. In other words, struct
* v4l2_ext_control uses field p to point to the data. * v4l2_ext_control uses field p to point to the data.
* @is_array: If set, then this control contains an N-dimensional array.
* @has_volatiles: If set, then one or more members of the cluster are volatile. * @has_volatiles: If set, then one or more members of the cluster are volatile.
* Drivers should never touch this flag. * Drivers should never touch this flag.
* @call_notify: If set, then call the handler's notify function whenever the * @call_notify: If set, then call the handler's notify function whenever the
@ -169,6 +170,7 @@ struct v4l2_ctrl {
unsigned int is_int:1; unsigned int is_int:1;
unsigned int is_string:1; unsigned int is_string:1;
unsigned int is_ptr:1; unsigned int is_ptr:1;
unsigned int is_array:1;
unsigned int has_volatiles:1; unsigned int has_volatiles:1;
unsigned int call_notify:1; unsigned int call_notify:1;
unsigned int manual_mode_value:8; unsigned int manual_mode_value:8;