Commit a6e7003c authored by Steve Longerbeam's avatar Steve Longerbeam Committed by Mauro Carvalho Chehab

media: v4l2: async: Allow searching for asd of any type

Generalize v4l2_async_notifier_fwnode_has_async_subdev() to allow
searching for any type of async subdev, not just fwnodes. Rename to
v4l2_async_notifier_has_async_subdev() and pass it an asd pointer.
Signed-off-by: default avatarSteve Longerbeam <slongerbeam@gmail.com>
Signed-off-by: default avatarSakari Ailus <sakari.ailus@linux.intel.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab+samsung@kernel.org>
parent 4382f37b
...@@ -124,6 +124,31 @@ static struct v4l2_async_subdev *v4l2_async_find_match( ...@@ -124,6 +124,31 @@ static struct v4l2_async_subdev *v4l2_async_find_match(
return NULL; return NULL;
} }
/* Compare two async sub-device descriptors for equivalence */
static bool asd_equal(struct v4l2_async_subdev *asd_x,
struct v4l2_async_subdev *asd_y)
{
if (asd_x->match_type != asd_y->match_type)
return false;
switch (asd_x->match_type) {
case V4L2_ASYNC_MATCH_DEVNAME:
return strcmp(asd_x->match.device_name,
asd_y->match.device_name) == 0;
case V4L2_ASYNC_MATCH_I2C:
return asd_x->match.i2c.adapter_id ==
asd_y->match.i2c.adapter_id &&
asd_x->match.i2c.address ==
asd_y->match.i2c.address;
case V4L2_ASYNC_MATCH_FWNODE:
return asd_x->match.fwnode == asd_y->match.fwnode;
default:
break;
}
return false;
}
/* Find the sub-device notifier registered by a sub-device driver. */ /* Find the sub-device notifier registered by a sub-device driver. */
static struct v4l2_async_notifier *v4l2_async_find_subdev_notifier( static struct v4l2_async_notifier *v4l2_async_find_subdev_notifier(
struct v4l2_subdev *sd) struct v4l2_subdev *sd)
...@@ -308,29 +333,23 @@ static void v4l2_async_notifier_unbind_all_subdevs( ...@@ -308,29 +333,23 @@ static void v4l2_async_notifier_unbind_all_subdevs(
notifier->parent = NULL; notifier->parent = NULL;
} }
/* See if an fwnode can be found in a notifier's lists. */ /* See if an async sub-device can be found in a notifier's lists. */
static bool __v4l2_async_notifier_fwnode_has_async_subdev( static bool
struct v4l2_async_notifier *notifier, struct fwnode_handle *fwnode) __v4l2_async_notifier_has_async_subdev(struct v4l2_async_notifier *notifier,
struct v4l2_async_subdev *asd)
{ {
struct v4l2_async_subdev *asd; struct v4l2_async_subdev *asd_y;
struct v4l2_subdev *sd; struct v4l2_subdev *sd;
list_for_each_entry(asd, &notifier->waiting, list) { list_for_each_entry(asd_y, &notifier->waiting, list)
if (asd->match_type != V4L2_ASYNC_MATCH_FWNODE) if (asd_equal(asd, asd_y))
continue;
if (asd->match.fwnode == fwnode)
return true; return true;
}
list_for_each_entry(sd, &notifier->done, async_list) { list_for_each_entry(sd, &notifier->done, async_list) {
if (WARN_ON(!sd->asd)) if (WARN_ON(!sd->asd))
continue; continue;
if (sd->asd->match_type != V4L2_ASYNC_MATCH_FWNODE) if (asd_equal(asd, sd->asd))
continue;
if (sd->asd->match.fwnode == fwnode)
return true; return true;
} }
...@@ -338,32 +357,29 @@ static bool __v4l2_async_notifier_fwnode_has_async_subdev( ...@@ -338,32 +357,29 @@ static bool __v4l2_async_notifier_fwnode_has_async_subdev(
} }
/* /*
* Find out whether an async sub-device was set up for an fwnode already or * Find out whether an async sub-device was set up already or
* whether it exists in a given notifier before @this_index. * whether it exists in a given notifier before @this_index.
*/ */
static bool v4l2_async_notifier_fwnode_has_async_subdev( static bool
struct v4l2_async_notifier *notifier, struct fwnode_handle *fwnode, v4l2_async_notifier_has_async_subdev(struct v4l2_async_notifier *notifier,
struct v4l2_async_subdev *asd,
unsigned int this_index) unsigned int this_index)
{ {
unsigned int j; unsigned int j;
lockdep_assert_held(&list_lock); lockdep_assert_held(&list_lock);
/* Check that an fwnode is not being added more than once. */ /* Check that an asd is not being added more than once. */
for (j = 0; j < this_index; j++) { for (j = 0; j < this_index; j++) {
struct v4l2_async_subdev *asd = notifier->subdevs[this_index]; struct v4l2_async_subdev *asd_y = notifier->subdevs[j];
struct v4l2_async_subdev *other_asd = notifier->subdevs[j];
if (other_asd->match_type == V4L2_ASYNC_MATCH_FWNODE && if (asd_equal(asd, asd_y))
asd->match.fwnode ==
other_asd->match.fwnode)
return true; return true;
} }
/* Check than an fwnode did not exist in other notifiers. */ /* Check that an asd does not exist in other notifiers. */
list_for_each_entry(notifier, &notifier_list, list) list_for_each_entry(notifier, &notifier_list, list)
if (__v4l2_async_notifier_fwnode_has_async_subdev( if (__v4l2_async_notifier_has_async_subdev(notifier, asd))
notifier, fwnode))
return true; return true;
return false; return false;
...@@ -392,12 +408,11 @@ static int __v4l2_async_notifier_register(struct v4l2_async_notifier *notifier) ...@@ -392,12 +408,11 @@ static int __v4l2_async_notifier_register(struct v4l2_async_notifier *notifier)
case V4L2_ASYNC_MATCH_CUSTOM: case V4L2_ASYNC_MATCH_CUSTOM:
case V4L2_ASYNC_MATCH_DEVNAME: case V4L2_ASYNC_MATCH_DEVNAME:
case V4L2_ASYNC_MATCH_I2C: case V4L2_ASYNC_MATCH_I2C:
break;
case V4L2_ASYNC_MATCH_FWNODE: case V4L2_ASYNC_MATCH_FWNODE:
if (v4l2_async_notifier_fwnode_has_async_subdev( if (v4l2_async_notifier_has_async_subdev(notifier,
notifier, asd->match.fwnode, i)) { asd, i)) {
dev_err(dev, dev_err(dev,
"fwnode has already been registered or in notifier's subdev list\n"); "subdev descriptor already listed in this or other notifiers\n");
ret = -EEXIST; ret = -EEXIST;
goto err_unlock; goto err_unlock;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment