root/drivers/staging/media/imx/imx-media-dev.c

DEFINITIONS

1. notifier2dev
2. imx_media_subdev_bound
3. imx6_media_probe_complete
4. imx_media_probe
5. imx_media_remove

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * V4L2 Media Controller Driver for Freescale i.MX5/6 SOC
   4  *
   5  * Copyright (c) 2016-2019 Mentor Graphics Inc.
   6  */
   7 #include <linux/fs.h>
   8 #include <linux/module.h>
   9 #include <linux/platform_device.h>
  10 #include <media/v4l2-async.h>
  11 #include <media/v4l2-event.h>
  12 #include <media/imx.h>
  13 #include "imx-media.h"
  14 
  15 static inline struct imx_media_dev *notifier2dev(struct v4l2_async_notifier *n)
  16 {
  17         return container_of(n, struct imx_media_dev, notifier);
  18 }
  19 
  20 /* async subdev bound notifier */
  21 static int imx_media_subdev_bound(struct v4l2_async_notifier *notifier,
  22                                   struct v4l2_subdev *sd,
  23                                   struct v4l2_async_subdev *asd)
  24 {
  25         struct imx_media_dev *imxmd = notifier2dev(notifier);
  26         int ret;
  27 
  28         if (sd->grp_id & IMX_MEDIA_GRP_ID_IPU_CSI) {
  29                 /* register the IPU internal subdevs */
  30                 ret = imx_media_register_ipu_internal_subdevs(imxmd, sd);
  31                 if (ret)
  32                         return ret;
  33         }
  34 
  35         v4l2_info(&imxmd->v4l2_dev, "subdev %s bound\n", sd->name);
  36 
  37         return 0;
  38 }
  39 
  40 /* async subdev complete notifier */
  41 static int imx6_media_probe_complete(struct v4l2_async_notifier *notifier)
  42 {
  43         struct imx_media_dev *imxmd = notifier2dev(notifier);
  44         int ret;
  45 
  46         /* call the imx5/6/7 common probe completion handler */
  47         ret = imx_media_probe_complete(notifier);
  48         if (ret)
  49                 return ret;
  50 
  51         mutex_lock(&imxmd->mutex);
  52 
  53         imxmd->m2m_vdev = imx_media_csc_scaler_device_init(imxmd);
  54         if (IS_ERR(imxmd->m2m_vdev)) {
  55                 ret = PTR_ERR(imxmd->m2m_vdev);
  56                 goto unlock;
  57         }
  58 
  59         ret = imx_media_csc_scaler_device_register(imxmd->m2m_vdev);
  60 unlock:
  61         mutex_unlock(&imxmd->mutex);
  62         return ret;
  63 }
  64 
  65 /* async subdev complete notifier */
  66 static const struct v4l2_async_notifier_operations imx_media_notifier_ops = {
  67         .bound = imx_media_subdev_bound,
  68         .complete = imx6_media_probe_complete,
  69 };
  70 
  71 static int imx_media_probe(struct platform_device *pdev)
  72 {
  73         struct device *dev = &pdev->dev;
  74         struct device_node *node = dev->of_node;
  75         struct imx_media_dev *imxmd;
  76         int ret;
  77 
  78         imxmd = imx_media_dev_init(dev, NULL);
  79         if (IS_ERR(imxmd))
  80                 return PTR_ERR(imxmd);
  81 
  82         ret = imx_media_add_of_subdevs(imxmd, node);
  83         if (ret) {
  84                 v4l2_err(&imxmd->v4l2_dev,
  85                          "add_of_subdevs failed with %d\n", ret);
  86                 goto cleanup;
  87         }
  88 
  89         ret = imx_media_dev_notifier_register(imxmd, &imx_media_notifier_ops);
  90         if (ret)
  91                 goto cleanup;
  92 
  93         return 0;
  94 
  95 cleanup:
  96         v4l2_async_notifier_cleanup(&imxmd->notifier);
  97         v4l2_device_unregister(&imxmd->v4l2_dev);
  98         media_device_cleanup(&imxmd->md);
  99 
 100         return ret;
 101 }
 102 
 103 static int imx_media_remove(struct platform_device *pdev)
 104 {
 105         struct imx_media_dev *imxmd =
 106                 (struct imx_media_dev *)platform_get_drvdata(pdev);
 107 
 108         v4l2_info(&imxmd->v4l2_dev, "Removing imx-media\n");
 109 
 110         v4l2_async_notifier_unregister(&imxmd->notifier);
 111         imx_media_unregister_ipu_internal_subdevs(imxmd);
 112         v4l2_async_notifier_cleanup(&imxmd->notifier);
 113         imx_media_csc_scaler_device_unregister(imxmd->m2m_vdev);
 114         media_device_unregister(&imxmd->md);
 115         v4l2_device_unregister(&imxmd->v4l2_dev);
 116         media_device_cleanup(&imxmd->md);
 117 
 118         return 0;
 119 }
 120 
 121 static const struct of_device_id imx_media_dt_ids[] = {
 122         { .compatible = "fsl,imx-capture-subsystem" },
 123         { /* sentinel */ }
 124 };
 125 MODULE_DEVICE_TABLE(of, imx_media_dt_ids);
 126 
 127 static struct platform_driver imx_media_pdrv = {
 128         .probe          = imx_media_probe,
 129         .remove         = imx_media_remove,
 130         .driver         = {
 131                 .name   = "imx-media",
 132                 .of_match_table = imx_media_dt_ids,
 133         },
 134 };
 135 
 136 module_platform_driver(imx_media_pdrv);
 137 
 138 MODULE_DESCRIPTION("i.MX5/6 v4l2 media controller driver");
 139 MODULE_AUTHOR("Steve Longerbeam <steve_longerbeam@mentor.com>");
 140 MODULE_LICENSE("GPL");