1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Support for Medifield PNW Camera Imaging ISP subsystem.
4 *
5 * Copyright (c) 2010 Intel Corporation. All Rights Reserved.
6 *
7 * Copyright (c) 2010 Silicon Hive www.siliconhive.com.
8 *
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License version
11 * 2 as published by the Free Software Foundation.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 *
19 */
20
21 #include <media/v4l2-event.h>
22 #include <media/v4l2-mediabus.h>
23 #include "atomisp_internal.h"
24 #include "atomisp_tpg.h"
25
tpg_s_stream(struct v4l2_subdev * sd,int enable)26 static int tpg_s_stream(struct v4l2_subdev *sd, int enable)
27 {
28 return 0;
29 }
30
tpg_get_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * format)31 static int tpg_get_fmt(struct v4l2_subdev *sd,
32 struct v4l2_subdev_state *sd_state,
33 struct v4l2_subdev_format *format)
34 {
35 /*to fake*/
36 return 0;
37 }
38
tpg_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * format)39 static int tpg_set_fmt(struct v4l2_subdev *sd,
40 struct v4l2_subdev_state *sd_state,
41 struct v4l2_subdev_format *format)
42 {
43 struct v4l2_mbus_framefmt *fmt = &format->format;
44
45 if (format->pad)
46 return -EINVAL;
47 /* only raw8 grbg is supported by TPG */
48 fmt->code = MEDIA_BUS_FMT_SGRBG8_1X8;
49 if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
50 sd_state->pads->try_fmt = *fmt;
51 return 0;
52 }
53 return 0;
54 }
55
tpg_log_status(struct v4l2_subdev * sd)56 static int tpg_log_status(struct v4l2_subdev *sd)
57 {
58 /*to fake*/
59 return 0;
60 }
61
tpg_s_power(struct v4l2_subdev * sd,int on)62 static int tpg_s_power(struct v4l2_subdev *sd, int on)
63 {
64 return 0;
65 }
66
tpg_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)67 static int tpg_enum_mbus_code(struct v4l2_subdev *sd,
68 struct v4l2_subdev_state *sd_state,
69 struct v4l2_subdev_mbus_code_enum *code)
70 {
71 /*to fake*/
72 return 0;
73 }
74
tpg_enum_frame_size(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_size_enum * fse)75 static int tpg_enum_frame_size(struct v4l2_subdev *sd,
76 struct v4l2_subdev_state *sd_state,
77 struct v4l2_subdev_frame_size_enum *fse)
78 {
79 /*to fake*/
80 return 0;
81 }
82
tpg_enum_frame_ival(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_interval_enum * fie)83 static int tpg_enum_frame_ival(struct v4l2_subdev *sd,
84 struct v4l2_subdev_state *sd_state,
85 struct v4l2_subdev_frame_interval_enum *fie)
86 {
87 /*to fake*/
88 return 0;
89 }
90
91 static const struct v4l2_subdev_video_ops tpg_video_ops = {
92 .s_stream = tpg_s_stream,
93 };
94
95 static const struct v4l2_subdev_core_ops tpg_core_ops = {
96 .log_status = tpg_log_status,
97 .s_power = tpg_s_power,
98 };
99
100 static const struct v4l2_subdev_pad_ops tpg_pad_ops = {
101 .enum_mbus_code = tpg_enum_mbus_code,
102 .enum_frame_size = tpg_enum_frame_size,
103 .enum_frame_interval = tpg_enum_frame_ival,
104 .get_fmt = tpg_get_fmt,
105 .set_fmt = tpg_set_fmt,
106 };
107
108 static const struct v4l2_subdev_ops tpg_ops = {
109 .core = &tpg_core_ops,
110 .video = &tpg_video_ops,
111 .pad = &tpg_pad_ops,
112 };
113
atomisp_tpg_unregister_entities(struct atomisp_tpg_device * tpg)114 void atomisp_tpg_unregister_entities(struct atomisp_tpg_device *tpg)
115 {
116 media_entity_cleanup(&tpg->sd.entity);
117 v4l2_device_unregister_subdev(&tpg->sd);
118 }
119
atomisp_tpg_register_entities(struct atomisp_tpg_device * tpg,struct v4l2_device * vdev)120 int atomisp_tpg_register_entities(struct atomisp_tpg_device *tpg,
121 struct v4l2_device *vdev)
122 {
123 int ret;
124 /* Register the subdev and video nodes. */
125 ret = v4l2_device_register_subdev(vdev, &tpg->sd);
126 if (ret < 0)
127 goto error;
128
129 return 0;
130
131 error:
132 atomisp_tpg_unregister_entities(tpg);
133 return ret;
134 }
135
atomisp_tpg_cleanup(struct atomisp_device * isp)136 void atomisp_tpg_cleanup(struct atomisp_device *isp)
137 {
138 }
139
atomisp_tpg_init(struct atomisp_device * isp)140 int atomisp_tpg_init(struct atomisp_device *isp)
141 {
142 struct atomisp_tpg_device *tpg = &isp->tpg;
143 struct v4l2_subdev *sd = &tpg->sd;
144 struct media_pad *pads = tpg->pads;
145 struct media_entity *me = &sd->entity;
146 int ret;
147
148 tpg->isp = isp;
149 v4l2_subdev_init(sd, &tpg_ops);
150 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
151 strscpy(sd->name, "tpg_subdev", sizeof(sd->name));
152 v4l2_set_subdevdata(sd, tpg);
153
154 pads[0].flags = MEDIA_PAD_FL_SINK;
155 me->function = MEDIA_ENT_F_PROC_VIDEO_ISP;
156
157 ret = media_entity_pads_init(me, 1, pads);
158 if (ret < 0)
159 goto fail;
160 return 0;
161 fail:
162 atomisp_tpg_cleanup(isp);
163 return ret;
164 }
165