// SPDX-License-Identifier: GPL-2.0+ /* * V4L2 Image Converter Subdev for Freescale i.MX5/6 SOC * * Copyright (c) 2014-2016 Mentor Graphics Inc. */ #include #include #include #include #include "imx-media.h" #include "imx-ic.h" #define IC_TASK_PRP IC_NUM_TASKS #define IC_NUM_OPS (IC_NUM_TASKS + 1) static struct imx_ic_ops *ic_ops[IC_NUM_OPS] = { [IC_TASK_PRP] = &imx_ic_prp_ops, [IC_TASK_ENCODER] = &imx_ic_prpencvf_ops, [IC_TASK_VIEWFINDER] = &imx_ic_prpencvf_ops, }; static int imx_ic_probe(struct platform_device *pdev) { struct imx_media_ipu_internal_sd_pdata *pdata; struct imx_ic_priv *priv; int ret; priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); if (!priv) return -ENOMEM; platform_set_drvdata(pdev, &priv->sd); priv->dev = &pdev->dev; /* get our ipu_id, grp_id and IC task id */ pdata = priv->dev->platform_data; priv->ipu_id = pdata->ipu_id; switch (pdata->grp_id) { case IMX_MEDIA_GRP_ID_IPU_IC_PRP: priv->task_id = IC_TASK_PRP; break; case IMX_MEDIA_GRP_ID_IPU_IC_PRPENC: priv->task_id = IC_TASK_ENCODER; break; case IMX_MEDIA_GRP_ID_IPU_IC_PRPVF: priv->task_id = IC_TASK_VIEWFINDER; break; default: return -EINVAL; } v4l2_subdev_init(&priv->sd, ic_ops[priv->task_id]->subdev_ops); v4l2_set_subdevdata(&priv->sd, priv); priv->sd.internal_ops = ic_ops[priv->task_id]->internal_ops; priv->sd.entity.ops = ic_ops[priv->task_id]->entity_ops; priv->sd.entity.function = MEDIA_ENT_F_PROC_VIDEO_SCALER; priv->sd.dev = &pdev->dev; priv->sd.owner = THIS_MODULE; priv->sd.flags = V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; priv->sd.grp_id = pdata->grp_id; strscpy(priv->sd.name, pdata->sd_name, sizeof(priv->sd.name)); ret = ic_ops[priv->task_id]->init(priv); if (ret) return ret; ret = v4l2_async_register_subdev(&priv->sd); if (ret) ic_ops[priv->task_id]->remove(priv); return ret; } static int imx_ic_remove(struct platform_device *pdev) { struct v4l2_subdev *sd = platform_get_drvdata(pdev); struct imx_ic_priv *priv = container_of(sd, struct imx_ic_priv, sd); v4l2_info(sd, "Removing\n"); ic_ops[priv->task_id]->remove(priv); v4l2_async_unregister_subdev(sd); media_entity_cleanup(&sd->entity); return 0; } static const struct platform_device_id imx_ic_ids[] = { { .name = "imx-ipuv3-ic" }, { }, }; MODULE_DEVICE_TABLE(platform, imx_ic_ids); static struct platform_driver imx_ic_driver = { .probe = imx_ic_probe, .remove = imx_ic_remove, .id_table = imx_ic_ids, .driver = { .name = "imx-ipuv3-ic", }, }; module_platform_driver(imx_ic_driver); MODULE_DESCRIPTION("i.MX IC subdev driver"); MODULE_AUTHOR("Steve Longerbeam "); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:imx-ipuv3-ic");