Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * vimc-common.c Virtual Media Controller Driver
4 *
5 * Copyright (C) 2015-2017 Helen Koike <helen.fornazier@gmail.com>
6 */
7
8#include <linux/init.h>
9#include <linux/module.h>
10
11#include "vimc-common.h"
12
13/*
14 * NOTE: non-bayer formats need to come first (necessary for enum_mbus_code
15 * in the scaler)
16 */
17static const struct vimc_pix_map vimc_pix_map_list[] = {
18 /* TODO: add all missing formats */
19
20 /* RGB formats */
21 {
22 .code = MEDIA_BUS_FMT_BGR888_1X24,
23 .pixelformat = V4L2_PIX_FMT_BGR24,
24 .bpp = 3,
25 .bayer = false,
26 },
27 {
28 .code = MEDIA_BUS_FMT_RGB888_1X24,
29 .pixelformat = V4L2_PIX_FMT_RGB24,
30 .bpp = 3,
31 .bayer = false,
32 },
33 {
34 .code = MEDIA_BUS_FMT_ARGB8888_1X32,
35 .pixelformat = V4L2_PIX_FMT_ARGB32,
36 .bpp = 4,
37 .bayer = false,
38 },
39
40 /* Bayer formats */
41 {
42 .code = MEDIA_BUS_FMT_SBGGR8_1X8,
43 .pixelformat = V4L2_PIX_FMT_SBGGR8,
44 .bpp = 1,
45 .bayer = true,
46 },
47 {
48 .code = MEDIA_BUS_FMT_SGBRG8_1X8,
49 .pixelformat = V4L2_PIX_FMT_SGBRG8,
50 .bpp = 1,
51 .bayer = true,
52 },
53 {
54 .code = MEDIA_BUS_FMT_SGRBG8_1X8,
55 .pixelformat = V4L2_PIX_FMT_SGRBG8,
56 .bpp = 1,
57 .bayer = true,
58 },
59 {
60 .code = MEDIA_BUS_FMT_SRGGB8_1X8,
61 .pixelformat = V4L2_PIX_FMT_SRGGB8,
62 .bpp = 1,
63 .bayer = true,
64 },
65 {
66 .code = MEDIA_BUS_FMT_SBGGR10_1X10,
67 .pixelformat = V4L2_PIX_FMT_SBGGR10,
68 .bpp = 2,
69 .bayer = true,
70 },
71 {
72 .code = MEDIA_BUS_FMT_SGBRG10_1X10,
73 .pixelformat = V4L2_PIX_FMT_SGBRG10,
74 .bpp = 2,
75 .bayer = true,
76 },
77 {
78 .code = MEDIA_BUS_FMT_SGRBG10_1X10,
79 .pixelformat = V4L2_PIX_FMT_SGRBG10,
80 .bpp = 2,
81 .bayer = true,
82 },
83 {
84 .code = MEDIA_BUS_FMT_SRGGB10_1X10,
85 .pixelformat = V4L2_PIX_FMT_SRGGB10,
86 .bpp = 2,
87 .bayer = true,
88 },
89
90 /* 10bit raw bayer a-law compressed to 8 bits */
91 {
92 .code = MEDIA_BUS_FMT_SBGGR10_ALAW8_1X8,
93 .pixelformat = V4L2_PIX_FMT_SBGGR10ALAW8,
94 .bpp = 1,
95 .bayer = true,
96 },
97 {
98 .code = MEDIA_BUS_FMT_SGBRG10_ALAW8_1X8,
99 .pixelformat = V4L2_PIX_FMT_SGBRG10ALAW8,
100 .bpp = 1,
101 .bayer = true,
102 },
103 {
104 .code = MEDIA_BUS_FMT_SGRBG10_ALAW8_1X8,
105 .pixelformat = V4L2_PIX_FMT_SGRBG10ALAW8,
106 .bpp = 1,
107 .bayer = true,
108 },
109 {
110 .code = MEDIA_BUS_FMT_SRGGB10_ALAW8_1X8,
111 .pixelformat = V4L2_PIX_FMT_SRGGB10ALAW8,
112 .bpp = 1,
113 .bayer = true,
114 },
115
116 /* 10bit raw bayer DPCM compressed to 8 bits */
117 {
118 .code = MEDIA_BUS_FMT_SBGGR10_DPCM8_1X8,
119 .pixelformat = V4L2_PIX_FMT_SBGGR10DPCM8,
120 .bpp = 1,
121 .bayer = true,
122 },
123 {
124 .code = MEDIA_BUS_FMT_SGBRG10_DPCM8_1X8,
125 .pixelformat = V4L2_PIX_FMT_SGBRG10DPCM8,
126 .bpp = 1,
127 .bayer = true,
128 },
129 {
130 .code = MEDIA_BUS_FMT_SGRBG10_DPCM8_1X8,
131 .pixelformat = V4L2_PIX_FMT_SGRBG10DPCM8,
132 .bpp = 1,
133 .bayer = true,
134 },
135 {
136 .code = MEDIA_BUS_FMT_SRGGB10_DPCM8_1X8,
137 .pixelformat = V4L2_PIX_FMT_SRGGB10DPCM8,
138 .bpp = 1,
139 .bayer = true,
140 },
141 {
142 .code = MEDIA_BUS_FMT_SBGGR12_1X12,
143 .pixelformat = V4L2_PIX_FMT_SBGGR12,
144 .bpp = 2,
145 .bayer = true,
146 },
147 {
148 .code = MEDIA_BUS_FMT_SGBRG12_1X12,
149 .pixelformat = V4L2_PIX_FMT_SGBRG12,
150 .bpp = 2,
151 .bayer = true,
152 },
153 {
154 .code = MEDIA_BUS_FMT_SGRBG12_1X12,
155 .pixelformat = V4L2_PIX_FMT_SGRBG12,
156 .bpp = 2,
157 .bayer = true,
158 },
159 {
160 .code = MEDIA_BUS_FMT_SRGGB12_1X12,
161 .pixelformat = V4L2_PIX_FMT_SRGGB12,
162 .bpp = 2,
163 .bayer = true,
164 },
165};
166
167const struct vimc_pix_map *vimc_pix_map_by_index(unsigned int i)
168{
169 if (i >= ARRAY_SIZE(vimc_pix_map_list))
170 return NULL;
171
172 return &vimc_pix_map_list[i];
173}
174EXPORT_SYMBOL_GPL(vimc_pix_map_by_index);
175
176const struct vimc_pix_map *vimc_pix_map_by_code(u32 code)
177{
178 unsigned int i;
179
180 for (i = 0; i < ARRAY_SIZE(vimc_pix_map_list); i++) {
181 if (vimc_pix_map_list[i].code == code)
182 return &vimc_pix_map_list[i];
183 }
184 return NULL;
185}
186EXPORT_SYMBOL_GPL(vimc_pix_map_by_code);
187
188const struct vimc_pix_map *vimc_pix_map_by_pixelformat(u32 pixelformat)
189{
190 unsigned int i;
191
192 for (i = 0; i < ARRAY_SIZE(vimc_pix_map_list); i++) {
193 if (vimc_pix_map_list[i].pixelformat == pixelformat)
194 return &vimc_pix_map_list[i];
195 }
196 return NULL;
197}
198EXPORT_SYMBOL_GPL(vimc_pix_map_by_pixelformat);
199
200/* Helper function to allocate and initialize pads */
201struct media_pad *vimc_pads_init(u16 num_pads, const unsigned long *pads_flag)
202{
203 struct media_pad *pads;
204 unsigned int i;
205
206 /* Allocate memory for the pads */
207 pads = kcalloc(num_pads, sizeof(*pads), GFP_KERNEL);
208 if (!pads)
209 return ERR_PTR(-ENOMEM);
210
211 /* Initialize the pads */
212 for (i = 0; i < num_pads; i++) {
213 pads[i].index = i;
214 pads[i].flags = pads_flag[i];
215 }
216
217 return pads;
218}
219EXPORT_SYMBOL_GPL(vimc_pads_init);
220
221int vimc_pipeline_s_stream(struct media_entity *ent, int enable)
222{
223 struct v4l2_subdev *sd;
224 struct media_pad *pad;
225 unsigned int i;
226 int ret;
227
228 for (i = 0; i < ent->num_pads; i++) {
229 if (ent->pads[i].flags & MEDIA_PAD_FL_SOURCE)
230 continue;
231
232 /* Start the stream in the subdevice direct connected */
233 pad = media_entity_remote_pad(&ent->pads[i]);
234 if (!pad)
235 continue;
236
237 if (!is_media_entity_v4l2_subdev(pad->entity))
238 return -EINVAL;
239
240 sd = media_entity_to_v4l2_subdev(pad->entity);
241 ret = v4l2_subdev_call(sd, video, s_stream, enable);
242 if (ret && ret != -ENOIOCTLCMD)
243 return ret;
244 }
245
246 return 0;
247}
248EXPORT_SYMBOL_GPL(vimc_pipeline_s_stream);
249
250static int vimc_get_mbus_format(struct media_pad *pad,
251 struct v4l2_subdev_format *fmt)
252{
253 if (is_media_entity_v4l2_subdev(pad->entity)) {
254 struct v4l2_subdev *sd =
255 media_entity_to_v4l2_subdev(pad->entity);
256 int ret;
257
258 fmt->which = V4L2_SUBDEV_FORMAT_ACTIVE;
259 fmt->pad = pad->index;
260
261 ret = v4l2_subdev_call(sd, pad, get_fmt, NULL, fmt);
262 if (ret)
263 return ret;
264
265 } else if (is_media_entity_v4l2_video_device(pad->entity)) {
266 struct video_device *vdev = container_of(pad->entity,
267 struct video_device,
268 entity);
269 struct vimc_ent_device *ved = video_get_drvdata(vdev);
270 const struct vimc_pix_map *vpix;
271 struct v4l2_pix_format vdev_fmt;
272
273 if (!ved->vdev_get_format)
274 return -ENOIOCTLCMD;
275
276 ved->vdev_get_format(ved, &vdev_fmt);
277 vpix = vimc_pix_map_by_pixelformat(vdev_fmt.pixelformat);
278 v4l2_fill_mbus_format(&fmt->format, &vdev_fmt, vpix->code);
279 } else {
280 return -EINVAL;
281 }
282
283 return 0;
284}
285
286int vimc_link_validate(struct media_link *link)
287{
288 struct v4l2_subdev_format source_fmt, sink_fmt;
289 int ret;
290
291 ret = vimc_get_mbus_format(link->source, &source_fmt);
292 if (ret)
293 return ret;
294
295 ret = vimc_get_mbus_format(link->sink, &sink_fmt);
296 if (ret)
297 return ret;
298
299 pr_info("vimc link validate: "
300 "%s:src:%dx%d (0x%x, %d, %d, %d, %d) "
301 "%s:snk:%dx%d (0x%x, %d, %d, %d, %d)\n",
302 /* src */
303 link->source->entity->name,
304 source_fmt.format.width, source_fmt.format.height,
305 source_fmt.format.code, source_fmt.format.colorspace,
306 source_fmt.format.quantization, source_fmt.format.xfer_func,
307 source_fmt.format.ycbcr_enc,
308 /* sink */
309 link->sink->entity->name,
310 sink_fmt.format.width, sink_fmt.format.height,
311 sink_fmt.format.code, sink_fmt.format.colorspace,
312 sink_fmt.format.quantization, sink_fmt.format.xfer_func,
313 sink_fmt.format.ycbcr_enc);
314
315 /* The width, height and code must match. */
316 if (source_fmt.format.width != sink_fmt.format.width
317 || source_fmt.format.height != sink_fmt.format.height
318 || source_fmt.format.code != sink_fmt.format.code)
319 return -EPIPE;
320
321 /*
322 * The field order must match, or the sink field order must be NONE
323 * to support interlaced hardware connected to bridges that support
324 * progressive formats only.
325 */
326 if (source_fmt.format.field != sink_fmt.format.field &&
327 sink_fmt.format.field != V4L2_FIELD_NONE)
328 return -EPIPE;
329
330 /*
331 * If colorspace is DEFAULT, then assume all the colorimetry is also
332 * DEFAULT, return 0 to skip comparing the other colorimetry parameters
333 */
334 if (source_fmt.format.colorspace == V4L2_COLORSPACE_DEFAULT
335 || sink_fmt.format.colorspace == V4L2_COLORSPACE_DEFAULT)
336 return 0;
337
338 /* Colorspace must match. */
339 if (source_fmt.format.colorspace != sink_fmt.format.colorspace)
340 return -EPIPE;
341
342 /* Colorimetry must match if they are not set to DEFAULT */
343 if (source_fmt.format.ycbcr_enc != V4L2_YCBCR_ENC_DEFAULT
344 && sink_fmt.format.ycbcr_enc != V4L2_YCBCR_ENC_DEFAULT
345 && source_fmt.format.ycbcr_enc != sink_fmt.format.ycbcr_enc)
346 return -EPIPE;
347
348 if (source_fmt.format.quantization != V4L2_QUANTIZATION_DEFAULT
349 && sink_fmt.format.quantization != V4L2_QUANTIZATION_DEFAULT
350 && source_fmt.format.quantization != sink_fmt.format.quantization)
351 return -EPIPE;
352
353 if (source_fmt.format.xfer_func != V4L2_XFER_FUNC_DEFAULT
354 && sink_fmt.format.xfer_func != V4L2_XFER_FUNC_DEFAULT
355 && source_fmt.format.xfer_func != sink_fmt.format.xfer_func)
356 return -EPIPE;
357
358 return 0;
359}
360EXPORT_SYMBOL_GPL(vimc_link_validate);
361
362static const struct media_entity_operations vimc_ent_sd_mops = {
363 .link_validate = vimc_link_validate,
364};
365
366int vimc_ent_sd_register(struct vimc_ent_device *ved,
367 struct v4l2_subdev *sd,
368 struct v4l2_device *v4l2_dev,
369 const char *const name,
370 u32 function,
371 u16 num_pads,
372 const unsigned long *pads_flag,
373 const struct v4l2_subdev_internal_ops *sd_int_ops,
374 const struct v4l2_subdev_ops *sd_ops)
375{
376 int ret;
377
378 /* Allocate the pads */
379 ved->pads = vimc_pads_init(num_pads, pads_flag);
380 if (IS_ERR(ved->pads))
381 return PTR_ERR(ved->pads);
382
383 /* Fill the vimc_ent_device struct */
384 ved->ent = &sd->entity;
385
386 /* Initialize the subdev */
387 v4l2_subdev_init(sd, sd_ops);
388 sd->internal_ops = sd_int_ops;
389 sd->entity.function = function;
390 sd->entity.ops = &vimc_ent_sd_mops;
391 sd->owner = THIS_MODULE;
392 strscpy(sd->name, name, sizeof(sd->name));
393 v4l2_set_subdevdata(sd, ved);
394
395 /* Expose this subdev to user space */
396 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
397 if (sd->ctrl_handler)
398 sd->flags |= V4L2_SUBDEV_FL_HAS_EVENTS;
399
400 /* Initialize the media entity */
401 ret = media_entity_pads_init(&sd->entity, num_pads, ved->pads);
402 if (ret)
403 goto err_clean_pads;
404
405 /* Register the subdev with the v4l2 and the media framework */
406 ret = v4l2_device_register_subdev(v4l2_dev, sd);
407 if (ret) {
408 dev_err(v4l2_dev->dev,
409 "%s: subdev register failed (err=%d)\n",
410 name, ret);
411 goto err_clean_m_ent;
412 }
413
414 return 0;
415
416err_clean_m_ent:
417 media_entity_cleanup(&sd->entity);
418err_clean_pads:
419 vimc_pads_cleanup(ved->pads);
420 return ret;
421}
422EXPORT_SYMBOL_GPL(vimc_ent_sd_register);
423
424void vimc_ent_sd_unregister(struct vimc_ent_device *ved, struct v4l2_subdev *sd)
425{
426 media_entity_cleanup(ved->ent);
427 vimc_pads_cleanup(ved->pads);
428 v4l2_device_unregister_subdev(sd);
429}
430EXPORT_SYMBOL_GPL(vimc_ent_sd_unregister);
1/*
2 * vimc-common.c Virtual Media Controller Driver
3 *
4 * Copyright (C) 2015-2017 Helen Koike <helen.fornazier@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 */
17
18#include <linux/init.h>
19#include <linux/module.h>
20
21#include "vimc-common.h"
22
23/*
24 * NOTE: non-bayer formats need to come first (necessary for enum_mbus_code
25 * in the scaler)
26 */
27static const struct vimc_pix_map vimc_pix_map_list[] = {
28 /* TODO: add all missing formats */
29
30 /* RGB formats */
31 {
32 .code = MEDIA_BUS_FMT_BGR888_1X24,
33 .pixelformat = V4L2_PIX_FMT_BGR24,
34 .bpp = 3,
35 .bayer = false,
36 },
37 {
38 .code = MEDIA_BUS_FMT_RGB888_1X24,
39 .pixelformat = V4L2_PIX_FMT_RGB24,
40 .bpp = 3,
41 .bayer = false,
42 },
43 {
44 .code = MEDIA_BUS_FMT_ARGB8888_1X32,
45 .pixelformat = V4L2_PIX_FMT_ARGB32,
46 .bpp = 4,
47 .bayer = false,
48 },
49
50 /* Bayer formats */
51 {
52 .code = MEDIA_BUS_FMT_SBGGR8_1X8,
53 .pixelformat = V4L2_PIX_FMT_SBGGR8,
54 .bpp = 1,
55 .bayer = true,
56 },
57 {
58 .code = MEDIA_BUS_FMT_SGBRG8_1X8,
59 .pixelformat = V4L2_PIX_FMT_SGBRG8,
60 .bpp = 1,
61 .bayer = true,
62 },
63 {
64 .code = MEDIA_BUS_FMT_SGRBG8_1X8,
65 .pixelformat = V4L2_PIX_FMT_SGRBG8,
66 .bpp = 1,
67 .bayer = true,
68 },
69 {
70 .code = MEDIA_BUS_FMT_SRGGB8_1X8,
71 .pixelformat = V4L2_PIX_FMT_SRGGB8,
72 .bpp = 1,
73 .bayer = true,
74 },
75 {
76 .code = MEDIA_BUS_FMT_SBGGR10_1X10,
77 .pixelformat = V4L2_PIX_FMT_SBGGR10,
78 .bpp = 2,
79 .bayer = true,
80 },
81 {
82 .code = MEDIA_BUS_FMT_SGBRG10_1X10,
83 .pixelformat = V4L2_PIX_FMT_SGBRG10,
84 .bpp = 2,
85 .bayer = true,
86 },
87 {
88 .code = MEDIA_BUS_FMT_SGRBG10_1X10,
89 .pixelformat = V4L2_PIX_FMT_SGRBG10,
90 .bpp = 2,
91 .bayer = true,
92 },
93 {
94 .code = MEDIA_BUS_FMT_SRGGB10_1X10,
95 .pixelformat = V4L2_PIX_FMT_SRGGB10,
96 .bpp = 2,
97 .bayer = true,
98 },
99
100 /* 10bit raw bayer a-law compressed to 8 bits */
101 {
102 .code = MEDIA_BUS_FMT_SBGGR10_ALAW8_1X8,
103 .pixelformat = V4L2_PIX_FMT_SBGGR10ALAW8,
104 .bpp = 1,
105 .bayer = true,
106 },
107 {
108 .code = MEDIA_BUS_FMT_SGBRG10_ALAW8_1X8,
109 .pixelformat = V4L2_PIX_FMT_SGBRG10ALAW8,
110 .bpp = 1,
111 .bayer = true,
112 },
113 {
114 .code = MEDIA_BUS_FMT_SGRBG10_ALAW8_1X8,
115 .pixelformat = V4L2_PIX_FMT_SGRBG10ALAW8,
116 .bpp = 1,
117 .bayer = true,
118 },
119 {
120 .code = MEDIA_BUS_FMT_SRGGB10_ALAW8_1X8,
121 .pixelformat = V4L2_PIX_FMT_SRGGB10ALAW8,
122 .bpp = 1,
123 .bayer = true,
124 },
125
126 /* 10bit raw bayer DPCM compressed to 8 bits */
127 {
128 .code = MEDIA_BUS_FMT_SBGGR10_DPCM8_1X8,
129 .pixelformat = V4L2_PIX_FMT_SBGGR10DPCM8,
130 .bpp = 1,
131 .bayer = true,
132 },
133 {
134 .code = MEDIA_BUS_FMT_SGBRG10_DPCM8_1X8,
135 .pixelformat = V4L2_PIX_FMT_SGBRG10DPCM8,
136 .bpp = 1,
137 .bayer = true,
138 },
139 {
140 .code = MEDIA_BUS_FMT_SGRBG10_DPCM8_1X8,
141 .pixelformat = V4L2_PIX_FMT_SGRBG10DPCM8,
142 .bpp = 1,
143 .bayer = true,
144 },
145 {
146 .code = MEDIA_BUS_FMT_SRGGB10_DPCM8_1X8,
147 .pixelformat = V4L2_PIX_FMT_SRGGB10DPCM8,
148 .bpp = 1,
149 .bayer = true,
150 },
151 {
152 .code = MEDIA_BUS_FMT_SBGGR12_1X12,
153 .pixelformat = V4L2_PIX_FMT_SBGGR12,
154 .bpp = 2,
155 .bayer = true,
156 },
157 {
158 .code = MEDIA_BUS_FMT_SGBRG12_1X12,
159 .pixelformat = V4L2_PIX_FMT_SGBRG12,
160 .bpp = 2,
161 .bayer = true,
162 },
163 {
164 .code = MEDIA_BUS_FMT_SGRBG12_1X12,
165 .pixelformat = V4L2_PIX_FMT_SGRBG12,
166 .bpp = 2,
167 .bayer = true,
168 },
169 {
170 .code = MEDIA_BUS_FMT_SRGGB12_1X12,
171 .pixelformat = V4L2_PIX_FMT_SRGGB12,
172 .bpp = 2,
173 .bayer = true,
174 },
175};
176
177const struct vimc_pix_map *vimc_pix_map_by_index(unsigned int i)
178{
179 if (i >= ARRAY_SIZE(vimc_pix_map_list))
180 return NULL;
181
182 return &vimc_pix_map_list[i];
183}
184EXPORT_SYMBOL_GPL(vimc_pix_map_by_index);
185
186const struct vimc_pix_map *vimc_pix_map_by_code(u32 code)
187{
188 unsigned int i;
189
190 for (i = 0; i < ARRAY_SIZE(vimc_pix_map_list); i++) {
191 if (vimc_pix_map_list[i].code == code)
192 return &vimc_pix_map_list[i];
193 }
194 return NULL;
195}
196EXPORT_SYMBOL_GPL(vimc_pix_map_by_code);
197
198const struct vimc_pix_map *vimc_pix_map_by_pixelformat(u32 pixelformat)
199{
200 unsigned int i;
201
202 for (i = 0; i < ARRAY_SIZE(vimc_pix_map_list); i++) {
203 if (vimc_pix_map_list[i].pixelformat == pixelformat)
204 return &vimc_pix_map_list[i];
205 }
206 return NULL;
207}
208EXPORT_SYMBOL_GPL(vimc_pix_map_by_pixelformat);
209
210int vimc_propagate_frame(struct media_pad *src, const void *frame)
211{
212 struct media_link *link;
213
214 if (!(src->flags & MEDIA_PAD_FL_SOURCE))
215 return -EINVAL;
216
217 /* Send this frame to all sink pads that are direct linked */
218 list_for_each_entry(link, &src->entity->links, list) {
219 if (link->source == src &&
220 (link->flags & MEDIA_LNK_FL_ENABLED)) {
221 struct vimc_ent_device *ved = NULL;
222 struct media_entity *entity = link->sink->entity;
223
224 if (is_media_entity_v4l2_subdev(entity)) {
225 struct v4l2_subdev *sd =
226 container_of(entity, struct v4l2_subdev,
227 entity);
228 ved = v4l2_get_subdevdata(sd);
229 } else if (is_media_entity_v4l2_video_device(entity)) {
230 struct video_device *vdev =
231 container_of(entity,
232 struct video_device,
233 entity);
234 ved = video_get_drvdata(vdev);
235 }
236 if (ved && ved->process_frame)
237 ved->process_frame(ved, link->sink, frame);
238 }
239 }
240
241 return 0;
242}
243EXPORT_SYMBOL_GPL(vimc_propagate_frame);
244
245/* Helper function to allocate and initialize pads */
246struct media_pad *vimc_pads_init(u16 num_pads, const unsigned long *pads_flag)
247{
248 struct media_pad *pads;
249 unsigned int i;
250
251 /* Allocate memory for the pads */
252 pads = kcalloc(num_pads, sizeof(*pads), GFP_KERNEL);
253 if (!pads)
254 return ERR_PTR(-ENOMEM);
255
256 /* Initialize the pads */
257 for (i = 0; i < num_pads; i++) {
258 pads[i].index = i;
259 pads[i].flags = pads_flag[i];
260 }
261
262 return pads;
263}
264EXPORT_SYMBOL_GPL(vimc_pads_init);
265
266int vimc_pipeline_s_stream(struct media_entity *ent, int enable)
267{
268 struct v4l2_subdev *sd;
269 struct media_pad *pad;
270 unsigned int i;
271 int ret;
272
273 for (i = 0; i < ent->num_pads; i++) {
274 if (ent->pads[i].flags & MEDIA_PAD_FL_SOURCE)
275 continue;
276
277 /* Start the stream in the subdevice direct connected */
278 pad = media_entity_remote_pad(&ent->pads[i]);
279
280 if (!is_media_entity_v4l2_subdev(pad->entity))
281 return -EINVAL;
282
283 sd = media_entity_to_v4l2_subdev(pad->entity);
284 ret = v4l2_subdev_call(sd, video, s_stream, enable);
285 if (ret && ret != -ENOIOCTLCMD)
286 return ret;
287 }
288
289 return 0;
290}
291EXPORT_SYMBOL_GPL(vimc_pipeline_s_stream);
292
293static int vimc_get_mbus_format(struct media_pad *pad,
294 struct v4l2_subdev_format *fmt)
295{
296 if (is_media_entity_v4l2_subdev(pad->entity)) {
297 struct v4l2_subdev *sd =
298 media_entity_to_v4l2_subdev(pad->entity);
299 int ret;
300
301 fmt->which = V4L2_SUBDEV_FORMAT_ACTIVE;
302 fmt->pad = pad->index;
303
304 ret = v4l2_subdev_call(sd, pad, get_fmt, NULL, fmt);
305 if (ret)
306 return ret;
307
308 } else if (is_media_entity_v4l2_video_device(pad->entity)) {
309 struct video_device *vdev = container_of(pad->entity,
310 struct video_device,
311 entity);
312 struct vimc_ent_device *ved = video_get_drvdata(vdev);
313 const struct vimc_pix_map *vpix;
314 struct v4l2_pix_format vdev_fmt;
315
316 if (!ved->vdev_get_format)
317 return -ENOIOCTLCMD;
318
319 ved->vdev_get_format(ved, &vdev_fmt);
320 vpix = vimc_pix_map_by_pixelformat(vdev_fmt.pixelformat);
321 v4l2_fill_mbus_format(&fmt->format, &vdev_fmt, vpix->code);
322 } else {
323 return -EINVAL;
324 }
325
326 return 0;
327}
328
329int vimc_link_validate(struct media_link *link)
330{
331 struct v4l2_subdev_format source_fmt, sink_fmt;
332 int ret;
333
334 ret = vimc_get_mbus_format(link->source, &source_fmt);
335 if (ret)
336 return ret;
337
338 ret = vimc_get_mbus_format(link->sink, &sink_fmt);
339 if (ret)
340 return ret;
341
342 pr_info("vimc link validate: "
343 "%s:src:%dx%d (0x%x, %d, %d, %d, %d) "
344 "%s:snk:%dx%d (0x%x, %d, %d, %d, %d)\n",
345 /* src */
346 link->source->entity->name,
347 source_fmt.format.width, source_fmt.format.height,
348 source_fmt.format.code, source_fmt.format.colorspace,
349 source_fmt.format.quantization, source_fmt.format.xfer_func,
350 source_fmt.format.ycbcr_enc,
351 /* sink */
352 link->sink->entity->name,
353 sink_fmt.format.width, sink_fmt.format.height,
354 sink_fmt.format.code, sink_fmt.format.colorspace,
355 sink_fmt.format.quantization, sink_fmt.format.xfer_func,
356 sink_fmt.format.ycbcr_enc);
357
358 /* The width, height and code must match. */
359 if (source_fmt.format.width != sink_fmt.format.width
360 || source_fmt.format.height != sink_fmt.format.height
361 || source_fmt.format.code != sink_fmt.format.code)
362 return -EPIPE;
363
364 /*
365 * The field order must match, or the sink field order must be NONE
366 * to support interlaced hardware connected to bridges that support
367 * progressive formats only.
368 */
369 if (source_fmt.format.field != sink_fmt.format.field &&
370 sink_fmt.format.field != V4L2_FIELD_NONE)
371 return -EPIPE;
372
373 /*
374 * If colorspace is DEFAULT, then assume all the colorimetry is also
375 * DEFAULT, return 0 to skip comparing the other colorimetry parameters
376 */
377 if (source_fmt.format.colorspace == V4L2_COLORSPACE_DEFAULT
378 || sink_fmt.format.colorspace == V4L2_COLORSPACE_DEFAULT)
379 return 0;
380
381 /* Colorspace must match. */
382 if (source_fmt.format.colorspace != sink_fmt.format.colorspace)
383 return -EPIPE;
384
385 /* Colorimetry must match if they are not set to DEFAULT */
386 if (source_fmt.format.ycbcr_enc != V4L2_YCBCR_ENC_DEFAULT
387 && sink_fmt.format.ycbcr_enc != V4L2_YCBCR_ENC_DEFAULT
388 && source_fmt.format.ycbcr_enc != sink_fmt.format.ycbcr_enc)
389 return -EPIPE;
390
391 if (source_fmt.format.quantization != V4L2_QUANTIZATION_DEFAULT
392 && sink_fmt.format.quantization != V4L2_QUANTIZATION_DEFAULT
393 && source_fmt.format.quantization != sink_fmt.format.quantization)
394 return -EPIPE;
395
396 if (source_fmt.format.xfer_func != V4L2_XFER_FUNC_DEFAULT
397 && sink_fmt.format.xfer_func != V4L2_XFER_FUNC_DEFAULT
398 && source_fmt.format.xfer_func != sink_fmt.format.xfer_func)
399 return -EPIPE;
400
401 return 0;
402}
403EXPORT_SYMBOL_GPL(vimc_link_validate);
404
405static const struct media_entity_operations vimc_ent_sd_mops = {
406 .link_validate = vimc_link_validate,
407};
408
409int vimc_ent_sd_register(struct vimc_ent_device *ved,
410 struct v4l2_subdev *sd,
411 struct v4l2_device *v4l2_dev,
412 const char *const name,
413 u32 function,
414 u16 num_pads,
415 const unsigned long *pads_flag,
416 const struct v4l2_subdev_ops *sd_ops)
417{
418 int ret;
419
420 /* Allocate the pads */
421 ved->pads = vimc_pads_init(num_pads, pads_flag);
422 if (IS_ERR(ved->pads))
423 return PTR_ERR(ved->pads);
424
425 /* Fill the vimc_ent_device struct */
426 ved->ent = &sd->entity;
427
428 /* Initialize the subdev */
429 v4l2_subdev_init(sd, sd_ops);
430 sd->entity.function = function;
431 sd->entity.ops = &vimc_ent_sd_mops;
432 sd->owner = THIS_MODULE;
433 strlcpy(sd->name, name, sizeof(sd->name));
434 v4l2_set_subdevdata(sd, ved);
435
436 /* Expose this subdev to user space */
437 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
438 if (sd->ctrl_handler)
439 sd->flags |= V4L2_SUBDEV_FL_HAS_EVENTS;
440
441 /* Initialize the media entity */
442 ret = media_entity_pads_init(&sd->entity, num_pads, ved->pads);
443 if (ret)
444 goto err_clean_pads;
445
446 /* Register the subdev with the v4l2 and the media framework */
447 ret = v4l2_device_register_subdev(v4l2_dev, sd);
448 if (ret) {
449 dev_err(v4l2_dev->dev,
450 "%s: subdev register failed (err=%d)\n",
451 name, ret);
452 goto err_clean_m_ent;
453 }
454
455 return 0;
456
457err_clean_m_ent:
458 media_entity_cleanup(&sd->entity);
459err_clean_pads:
460 vimc_pads_cleanup(ved->pads);
461 return ret;
462}
463EXPORT_SYMBOL_GPL(vimc_ent_sd_register);
464
465void vimc_ent_sd_unregister(struct vimc_ent_device *ved, struct v4l2_subdev *sd)
466{
467 v4l2_device_unregister_subdev(sd);
468 media_entity_cleanup(ved->ent);
469 vimc_pads_cleanup(ved->pads);
470}
471EXPORT_SYMBOL_GPL(vimc_ent_sd_unregister);
472
473MODULE_DESCRIPTION("Virtual Media Controller Driver (VIMC) Common");
474MODULE_AUTHOR("Helen Koike <helen.fornazier@gmail.com>");
475MODULE_LICENSE("GPL");