hc
2023-11-06 e3e12f52b214121840b44c91de5b3e5af5d3eb84
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
/*
 * V4L2 Image Converter Subdev for Freescale i.MX5/6 SOC
 *
 * Copyright (c) 2014-2016 Mentor Graphics Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */
#include <linux/module.h>
#include <linux/platform_device.h>
#include <media/v4l2-device.h>
#include <media/v4l2-subdev.h>
#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_internal_sd_platformdata *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_IC_PRP:
       priv->task_id = IC_TASK_PRP;
       break;
   case IMX_MEDIA_GRP_ID_IC_PRPENC:
       priv->task_id = IC_TASK_ENCODER;
       break;
   case IMX_MEDIA_GRP_ID_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;
   strncpy(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 <steve_longerbeam@mentor.com>");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:imx-ipuv3-ic");