[PATCH v4 3/3] v4l: fwnode: Support generic parsing of graph endpoints in a single port

[Sakari Ailus]

This is the preferred way to parse the endpoints.

Signed-off-by: Sakari Ailus <sakari.ai...@linux.intel.com>
---
 drivers/media/v4l2-core/v4l2-fwnode.c | 51 +++++++++++++++++++++++++++++++++++
 include/media/v4l2-fwnode.h           |  7 +++++
 2 files changed, 58 insertions(+)

diff --git a/drivers/media/v4l2-core/v4l2-fwnode.c 
b/drivers/media/v4l2-core/v4l2-fwnode.c
index cb0fc4b4e3bf..961bcdf22d9a 100644
--- a/drivers/media/v4l2-core/v4l2-fwnode.c
+++ b/drivers/media/v4l2-core/v4l2-fwnode.c
@@ -508,6 +508,57 @@ int v4l2_fwnode_endpoints_parse(
 }
 EXPORT_SYMBOL_GPL(v4l2_fwnode_endpoints_parse);
 
+/**
+ * v4l2_fwnode_endpoint_parse - Parse V4L2 fwnode endpoints in a port node
+ * @dev: local struct device
+ * @notifier: async notifier related to @dev
+ * @port: port number
+ * @endpoint: endpoint number
+ * @asd_struct_size: size of the driver's async sub-device struct, including
+ *                  sizeof(struct v4l2_async_subdev)
+ * @parse_single: driver's callback function called on each V4L2 fwnode 
endpoint
+ *
+ * Parse all V4L2 fwnode endpoints related to a given port. This is
+ * the preferred interface over v4l2_fwnode_endpoints_parse() and
+ * should be used by new drivers.
+ */
+int v4l2_fwnode_endpoint_parse_port(
+       struct device *dev, struct v4l2_async_notifier *notifier,
+       unsigned int port, unsigned int endpoint, size_t asd_struct_size,
+       int (*parse_single)(struct device *dev,
+                           struct v4l2_fwnode_endpoint *vep,
+                           struct v4l2_async_subdev *asd))
+{
+       struct fwnode_handle *fwnode;
+       struct v4l2_async_subdev *asd;
+       int ret;
+
+       fwnode = fwnode_graph_get_remote_node(dev_fwnode(dev), port, endpoint);
+       if (!fwnode)
+               return -ENOENT;
+
+       asd = devm_kzalloc(dev, asd_struct_size, GFP_KERNEL);
+       if (!asd)
+               return -ENOMEM;
+
+       ret = notifier_realloc(dev, notifier, notifier->num_subdevs + 1);
+       if (ret)
+               goto out_free;
+
+       ret = __v4l2_fwnode_endpoint_parse(dev, notifier, fwnode, asd,
+                                          parse_single);
+       if (ret)
+               goto out_free;
+
+       return 0;
+
+out_free:
+       devm_kfree(dev, asd);
+
+       return ret;
+}
+EXPORT_SYMBOL_GPL(v4l2_fwnode_endpoint_parse_port);
+
 MODULE_LICENSE("GPL");
 MODULE_AUTHOR("Sakari Ailus <sakari.ai...@linux.intel.com>");
 MODULE_AUTHOR("Sylwester Nawrocki <s.nawro...@samsung.com>");
diff --git a/include/media/v4l2-fwnode.h b/include/media/v4l2-fwnode.h
index c75a768d4ef7..5adf28e7b070 100644
--- a/include/media/v4l2-fwnode.h
+++ b/include/media/v4l2-fwnode.h
@@ -131,4 +131,11 @@ int v4l2_fwnode_endpoints_parse(
                            struct v4l2_fwnode_endpoint *vep,
                            struct v4l2_async_subdev *asd));
 
+int v4l2_fwnode_endpoint_parse_port(
+       struct device *dev, struct v4l2_async_notifier *notifier,
+       unsigned int port, unsigned int endpoint, size_t asd_struct_size,
+       int (*parse_single)(struct device *dev,
+                           struct v4l2_fwnode_endpoint *vep,
+                           struct v4l2_async_subdev *asd));
+
 #endif /* _V4L2_FWNODE_H */
-- 
2.11.0