drivers/staging/media/imx/imx-media-of.c

   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
  19 static int imx_media_of_add_csi(struct imx_media_dev *imxmd,
  20                                 struct device_node *csi_np)
  21 {
  22         struct v4l2_async_connection *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_connection);
  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
  45 int imx_media_add_of_subdevs(struct imx_media_dev *imxmd,
  46                              struct device_node *np)
  47 {
  48         struct device_node *csi_np;
  49         int i, ret;
  50
  51         for (i = 0; ; i++) {
  52                 csi_np = of_parse_phandle(np, "ports", i);
  53                 if (!csi_np)
  54                         break;
  55
  56                 ret = imx_media_of_add_csi(imxmd, csi_np);
  57                 if (ret) {
  58                         /* unavailable or already added is not an error */
  59                         if (ret == -ENODEV || ret == -EEXIST) {
  60                                 of_node_put(csi_np);
  61                                 continue;
  62                         }
  63
  64                         /* other error, can't continue */
  65                         goto err_out;
  66                 }
  67         }
  68
  69         return 0;
  70
  71 err_out:
  72         of_node_put(csi_np);
  73         return ret;
  74 }
  75 EXPORT_SYMBOL_GPL(imx_media_add_of_subdevs);