cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

imx-media-dev.c (3593B)

      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
     15static 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 */
     21static 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	dev_dbg(imxmd->md.dev, "subdev %s bound\n", sd->name);
     36
     37	return 0;
     38}
     39
     40/* async subdev complete notifier */
     41static 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		imxmd->m2m_vdev = NULL;
     57		goto unlock;
     58	}
     59
     60	ret = imx_media_csc_scaler_device_register(imxmd->m2m_vdev);
     61unlock:
     62	mutex_unlock(&imxmd->mutex);
     63	return ret;
     64}
     65
     66/* async subdev complete notifier */
     67static const struct v4l2_async_notifier_operations imx_media_notifier_ops = {
     68	.bound = imx_media_subdev_bound,
     69	.complete = imx6_media_probe_complete,
     70};
     71
     72static int imx_media_probe(struct platform_device *pdev)
     73{
     74	struct device *dev = &pdev->dev;
     75	struct device_node *node = dev->of_node;
     76	struct imx_media_dev *imxmd;
     77	int ret;
     78
     79	imxmd = imx_media_dev_init(dev, NULL);
     80	if (IS_ERR(imxmd))
     81		return PTR_ERR(imxmd);
     82
     83	ret = imx_media_add_of_subdevs(imxmd, node);
     84	if (ret) {
     85		v4l2_err(&imxmd->v4l2_dev,
     86			 "add_of_subdevs failed with %d\n", ret);
     87		goto cleanup;
     88	}
     89
     90	ret = imx_media_dev_notifier_register(imxmd, &imx_media_notifier_ops);
     91	if (ret)
     92		goto cleanup;
     93
     94	return 0;
     95
     96cleanup:
     97	v4l2_async_nf_cleanup(&imxmd->notifier);
     98	v4l2_device_unregister(&imxmd->v4l2_dev);
     99	media_device_cleanup(&imxmd->md);
    100
    101	return ret;
    102}
    103
    104static int imx_media_remove(struct platform_device *pdev)
    105{
    106	struct imx_media_dev *imxmd =
    107		(struct imx_media_dev *)platform_get_drvdata(pdev);
    108
    109	v4l2_info(&imxmd->v4l2_dev, "Removing imx-media\n");
    110
    111	if (imxmd->m2m_vdev) {
    112		imx_media_csc_scaler_device_unregister(imxmd->m2m_vdev);
    113		imxmd->m2m_vdev = NULL;
    114	}
    115
    116	v4l2_async_nf_unregister(&imxmd->notifier);
    117	imx_media_unregister_ipu_internal_subdevs(imxmd);
    118	v4l2_async_nf_cleanup(&imxmd->notifier);
    119	media_device_unregister(&imxmd->md);
    120	v4l2_device_unregister(&imxmd->v4l2_dev);
    121	media_device_cleanup(&imxmd->md);
    122
    123	return 0;
    124}
    125
    126static const struct of_device_id imx_media_dt_ids[] = {
    127	{ .compatible = "fsl,imx-capture-subsystem" },
    128	{ /* sentinel */ }
    129};
    130MODULE_DEVICE_TABLE(of, imx_media_dt_ids);
    131
    132static struct platform_driver imx_media_pdrv = {
    133	.probe		= imx_media_probe,
    134	.remove		= imx_media_remove,
    135	.driver		= {
    136		.name	= "imx-media",
    137		.of_match_table	= imx_media_dt_ids,
    138	},
    139};
    140
    141module_platform_driver(imx_media_pdrv);
    142
    143MODULE_DESCRIPTION("i.MX5/6 v4l2 media controller driver");
    144MODULE_AUTHOR("Steve Longerbeam <steve_longerbeam@mentor.com>");
    145MODULE_LICENSE("GPL");