media/imx/imx-ic-common.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002 /*
0003  * V4L2 Image Converter Subdev for Freescale i.MX5/6 SOC
0004  *
0005  * Copyright (c) 2014-2016 Mentor Graphics Inc.
0006  */
0007 #include <media/v4l2-device.h>
0008 #include <media/v4l2-subdev.h>
0009 #include "imx-media.h"
0010 #include "imx-ic.h"
0011
0012 #define IC_TASK_PRP IC_NUM_TASKS
0013 #define IC_NUM_OPS  (IC_NUM_TASKS + 1)
0014
0015 static struct imx_ic_ops *ic_ops[IC_NUM_OPS] = {
0016     [IC_TASK_PRP]            = &imx_ic_prp_ops,
0017     [IC_TASK_ENCODER]        = &imx_ic_prpencvf_ops,
0018     [IC_TASK_VIEWFINDER]     = &imx_ic_prpencvf_ops,
0019 };
0020
0021 struct v4l2_subdev *imx_media_ic_register(struct v4l2_device *v4l2_dev,
0022                       struct device *ipu_dev,
0023                       struct ipu_soc *ipu,
0024                       u32 grp_id)
0025 {
0026     struct imx_ic_priv *priv;
0027     int ret;
0028
0029     priv = devm_kzalloc(ipu_dev, sizeof(*priv), GFP_KERNEL);
0030     if (!priv)
0031         return ERR_PTR(-ENOMEM);
0032
0033     priv->ipu_dev = ipu_dev;
0034     priv->ipu = ipu;
0035
0036     /* get our IC task id */
0037     switch (grp_id) {
0038     case IMX_MEDIA_GRP_ID_IPU_IC_PRP:
0039         priv->task_id = IC_TASK_PRP;
0040         break;
0041     case IMX_MEDIA_GRP_ID_IPU_IC_PRPENC:
0042         priv->task_id = IC_TASK_ENCODER;
0043         break;
0044     case IMX_MEDIA_GRP_ID_IPU_IC_PRPVF:
0045         priv->task_id = IC_TASK_VIEWFINDER;
0046         break;
0047     default:
0048         return ERR_PTR(-EINVAL);
0049     }
0050
0051     v4l2_subdev_init(&priv->sd, ic_ops[priv->task_id]->subdev_ops);
0052     v4l2_set_subdevdata(&priv->sd, priv);
0053     priv->sd.internal_ops = ic_ops[priv->task_id]->internal_ops;
0054     priv->sd.entity.ops = ic_ops[priv->task_id]->entity_ops;
0055     priv->sd.entity.function = MEDIA_ENT_F_PROC_VIDEO_SCALER;
0056     priv->sd.owner = ipu_dev->driver->owner;
0057     priv->sd.flags = V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS;
0058     priv->sd.grp_id = grp_id;
0059     imx_media_grp_id_to_sd_name(priv->sd.name, sizeof(priv->sd.name),
0060                     priv->sd.grp_id, ipu_get_num(ipu));
0061
0062     ret = ic_ops[priv->task_id]->init(priv);
0063     if (ret)
0064         return ERR_PTR(ret);
0065
0066     ret = v4l2_device_register_subdev(v4l2_dev, &priv->sd);
0067     if (ret) {
0068         ic_ops[priv->task_id]->remove(priv);
0069         return ERR_PTR(ret);
0070     }
0071
0072     return &priv->sd;
0073 }
0074
0075 int imx_media_ic_unregister(struct v4l2_subdev *sd)
0076 {
0077     struct imx_ic_priv *priv = container_of(sd, struct imx_ic_priv, sd);
0078
0079     v4l2_info(sd, "Removing\n");
0080
0081     ic_ops[priv->task_id]->remove(priv);
0082
0083     v4l2_device_unregister_subdev(sd);
0084     media_entity_cleanup(&sd->entity);
0085
0086     return 0;
0087 }