1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Media driver for Freescale i.MX5/6 SOC
4 *
5 * Open Firmware parsing.
6 *
7 * Copyright (c) 2016 Mentor Graphics Inc.
8 */
9 #include <linux/of_platform.h>
10 #include <media/v4l2-ctrls.h>
11 #include <media/v4l2-device.h>
12 #include <media/v4l2-fwnode.h>
13 #include <media/v4l2-subdev.h>
14 #include <media/videobuf2-dma-contig.h>
15 #include <linux/of_graph.h>
16 #include <video/imx-ipu-v3.h>
17 #include "imx-media.h"
18
imx_media_of_add_csi(struct imx_media_dev * imxmd,struct device_node * csi_np)19 int imx_media_of_add_csi(struct imx_media_dev *imxmd,
20 struct device_node *csi_np)
21 {
22 struct v4l2_async_subdev *asd;
23 int ret = 0;
24
25 if (!of_device_is_available(csi_np)) {
26 dev_dbg(imxmd->md.dev, "%s: %pOFn not enabled\n", __func__,
27 csi_np);
28 return -ENODEV;
29 }
30
31 /* add CSI fwnode to async notifier */
32 asd = v4l2_async_nf_add_fwnode(&imxmd->notifier,
33 of_fwnode_handle(csi_np),
34 struct v4l2_async_subdev);
35 if (IS_ERR(asd)) {
36 ret = PTR_ERR(asd);
37 if (ret == -EEXIST)
38 dev_dbg(imxmd->md.dev, "%s: already added %pOFn\n",
39 __func__, csi_np);
40 }
41
42 return ret;
43 }
44 EXPORT_SYMBOL_GPL(imx_media_of_add_csi);
45
imx_media_add_of_subdevs(struct imx_media_dev * imxmd,struct device_node * np)46 int imx_media_add_of_subdevs(struct imx_media_dev *imxmd,
47 struct device_node *np)
48 {
49 struct device_node *csi_np;
50 int i, ret;
51
52 for (i = 0; ; i++) {
53 csi_np = of_parse_phandle(np, "ports", i);
54 if (!csi_np)
55 break;
56
57 ret = imx_media_of_add_csi(imxmd, csi_np);
58 if (ret) {
59 /* unavailable or already added is not an error */
60 if (ret == -ENODEV || ret == -EEXIST) {
61 of_node_put(csi_np);
62 continue;
63 }
64
65 /* other error, can't continue */
66 goto err_out;
67 }
68 }
69
70 return 0;
71
72 err_out:
73 of_node_put(csi_np);
74 return ret;
75 }
76 EXPORT_SYMBOL_GPL(imx_media_add_of_subdevs);
77