v4l: async: Add a pointer to of_node to struct v4l2_subdev, match it
V4L2 async sub-devices are currently matched (OF case) based on the struct device_node pointer in struct device. LED devices may have more than one LED, and in that case the OF node to match is not directly the device's node, but a LED's node. Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Signed-off-by: Sakari Ailus <sakari.ailus@iki.fi> Signed-off-by: Bryan Wu <cooloney@gmail.com>
This commit is contained in:
parent
aaf2cbca46
commit
862176512b
2 changed files with 29 additions and 12 deletions
|
@ -22,10 +22,10 @@
|
|||
#include <media/v4l2-device.h>
|
||||
#include <media/v4l2-subdev.h>
|
||||
|
||||
static bool match_i2c(struct device *dev, struct v4l2_async_subdev *asd)
|
||||
static bool match_i2c(struct v4l2_subdev *sd, struct v4l2_async_subdev *asd)
|
||||
{
|
||||
#if IS_ENABLED(CONFIG_I2C)
|
||||
struct i2c_client *client = i2c_verify_client(dev);
|
||||
struct i2c_client *client = i2c_verify_client(sd->dev);
|
||||
return client &&
|
||||
asd->match.i2c.adapter_id == client->adapter->nr &&
|
||||
asd->match.i2c.address == client->addr;
|
||||
|
@ -34,14 +34,24 @@ static bool match_i2c(struct device *dev, struct v4l2_async_subdev *asd)
|
|||
#endif
|
||||
}
|
||||
|
||||
static bool match_devname(struct device *dev, struct v4l2_async_subdev *asd)
|
||||
static bool match_devname(struct v4l2_subdev *sd,
|
||||
struct v4l2_async_subdev *asd)
|
||||
{
|
||||
return !strcmp(asd->match.device_name.name, dev_name(dev));
|
||||
return !strcmp(asd->match.device_name.name, dev_name(sd->dev));
|
||||
}
|
||||
|
||||
static bool match_of(struct device *dev, struct v4l2_async_subdev *asd)
|
||||
static bool match_of(struct v4l2_subdev *sd, struct v4l2_async_subdev *asd)
|
||||
{
|
||||
return dev->of_node == asd->match.of.node;
|
||||
return sd->of_node == asd->match.of.node;
|
||||
}
|
||||
|
||||
static bool match_custom(struct v4l2_subdev *sd, struct v4l2_async_subdev *asd)
|
||||
{
|
||||
if (!asd->match.custom.match)
|
||||
/* Match always */
|
||||
return true;
|
||||
|
||||
return asd->match.custom.match(sd->dev, asd);
|
||||
}
|
||||
|
||||
static LIST_HEAD(subdev_list);
|
||||
|
@ -51,17 +61,14 @@ static DEFINE_MUTEX(list_lock);
|
|||
static struct v4l2_async_subdev *v4l2_async_belongs(struct v4l2_async_notifier *notifier,
|
||||
struct v4l2_subdev *sd)
|
||||
{
|
||||
bool (*match)(struct v4l2_subdev *, struct v4l2_async_subdev *);
|
||||
struct v4l2_async_subdev *asd;
|
||||
bool (*match)(struct device *, struct v4l2_async_subdev *);
|
||||
|
||||
list_for_each_entry(asd, ¬ifier->waiting, list) {
|
||||
/* bus_type has been verified valid before */
|
||||
switch (asd->match_type) {
|
||||
case V4L2_ASYNC_MATCH_CUSTOM:
|
||||
match = asd->match.custom.match;
|
||||
if (!match)
|
||||
/* Match always */
|
||||
return asd;
|
||||
match = match_custom;
|
||||
break;
|
||||
case V4L2_ASYNC_MATCH_DEVNAME:
|
||||
match = match_devname;
|
||||
|
@ -79,7 +86,7 @@ static struct v4l2_async_subdev *v4l2_async_belongs(struct v4l2_async_notifier *
|
|||
}
|
||||
|
||||
/* match cannot be NULL here */
|
||||
if (match(sd->dev, asd))
|
||||
if (match(sd, asd))
|
||||
return asd;
|
||||
}
|
||||
|
||||
|
@ -266,6 +273,14 @@ int v4l2_async_register_subdev(struct v4l2_subdev *sd)
|
|||
{
|
||||
struct v4l2_async_notifier *notifier;
|
||||
|
||||
/*
|
||||
* No reference taken. The reference is held by the device
|
||||
* (struct v4l2_subdev.dev), and async sub-device does not
|
||||
* exist independently of the device at any point of time.
|
||||
*/
|
||||
if (!sd->of_node && sd->dev)
|
||||
sd->of_node = sd->dev->of_node;
|
||||
|
||||
mutex_lock(&list_lock);
|
||||
|
||||
INIT_LIST_HEAD(&sd->async_list);
|
||||
|
|
|
@ -619,6 +619,8 @@ struct v4l2_subdev {
|
|||
struct video_device *devnode;
|
||||
/* pointer to the physical device, if any */
|
||||
struct device *dev;
|
||||
/* The device_node of the subdev, usually the same as dev->of_node. */
|
||||
struct device_node *of_node;
|
||||
/* Links this subdev to a global subdev_list or @notifier->done list. */
|
||||
struct list_head async_list;
|
||||
/* Pointer to respective struct v4l2_async_subdev. */
|
||||
|
|
Loading…
Reference in a new issue