Commit | Line | Data |
---|---|---|
971d62dd | 1 | // SPDX-License-Identifier: GPL-2.0+ |
96d8eab5 PO |
2 | /* |
3 | * A virtual v4l2-mem2mem example device. | |
4 | * | |
f068a6ce | 5 | * This is a virtual device driver for testing mem-to-mem vb2 framework. |
96d8eab5 | 6 | * It simulates a device that uses memory buffers for both source and |
144bd0ee HV |
7 | * destination, processes the data and issues an "irq" (simulated by a delayed |
8 | * workqueue). | |
96d8eab5 PO |
9 | * The device is capable of multi-instance, multi-buffer-per-transaction |
10 | * operation (via the mem2mem framework). | |
11 | * | |
12 | * Copyright (c) 2009-2010 Samsung Electronics Co., Ltd. | |
95072084 | 13 | * Pawel Osciak, <pawel@osciak.com> |
96d8eab5 | 14 | * Marek Szyprowski, <m.szyprowski@samsung.com> |
96d8eab5 PO |
15 | */ |
16 | #include <linux/module.h> | |
17 | #include <linux/delay.h> | |
18 | #include <linux/fs.h> | |
96d8eab5 | 19 | #include <linux/sched.h> |
6b46c397 | 20 | #include <linux/slab.h> |
96d8eab5 PO |
21 | |
22 | #include <linux/platform_device.h> | |
23 | #include <media/v4l2-mem2mem.h> | |
24 | #include <media/v4l2-device.h> | |
25 | #include <media/v4l2-ioctl.h> | |
d3dd59c2 | 26 | #include <media/v4l2-ctrls.h> |
97a3c902 | 27 | #include <media/v4l2-event.h> |
d80ee38c | 28 | #include <media/videobuf2-vmalloc.h> |
96d8eab5 | 29 | |
96d8eab5 | 30 | MODULE_DESCRIPTION("Virtual device for mem2mem framework testing"); |
95072084 | 31 | MODULE_AUTHOR("Pawel Osciak, <pawel@osciak.com>"); |
96d8eab5 | 32 | MODULE_LICENSE("GPL"); |
c310d1f9 | 33 | MODULE_VERSION("0.2"); |
1f923a42 | 34 | MODULE_ALIAS("mem2mem_testdev"); |
96d8eab5 | 35 | |
c310d1f9 | 36 | static unsigned int debug; |
d95d7c64 | 37 | module_param(debug, uint, 0644); |
de5c46ad | 38 | MODULE_PARM_DESC(debug, "debug level"); |
d95d7c64 | 39 | |
f0ef022c MCC |
40 | /* Default transaction time in msec */ |
41 | static unsigned int default_transtime = 40; /* Max 25 fps */ | |
42 | module_param(default_transtime, uint, 0644); | |
43 | MODULE_PARM_DESC(default_transtime, "default transaction time in ms"); | |
44 | ||
96d8eab5 PO |
45 | #define MIN_W 32 |
46 | #define MIN_H 32 | |
47 | #define MAX_W 640 | |
48 | #define MAX_H 480 | |
c8af44e1 MCC |
49 | |
50 | /* Pixel alignment for non-bayer formats */ | |
51 | #define WIDTH_ALIGN 2 | |
52 | #define HEIGHT_ALIGN 1 | |
53 | ||
54 | /* Pixel alignment for bayer formats */ | |
55 | #define BAYER_WIDTH_ALIGN 2 | |
56 | #define BAYER_HEIGHT_ALIGN 2 | |
96d8eab5 PO |
57 | |
58 | /* Flags that indicate a format can be used for capture/output */ | |
c310d1f9 MCC |
59 | #define MEM2MEM_CAPTURE BIT(0) |
60 | #define MEM2MEM_OUTPUT BIT(1) | |
96d8eab5 | 61 | |
1f923a42 | 62 | #define MEM2MEM_NAME "vim2m" |
96d8eab5 PO |
63 | |
64 | /* Per queue */ | |
65 | #define MEM2MEM_DEF_NUM_BUFS VIDEO_MAX_FRAME | |
66 | /* In bytes, per queue */ | |
67 | #define MEM2MEM_VID_MEM_LIMIT (16 * 1024 * 1024) | |
68 | ||
80072871 | 69 | /* Flags that indicate processing mode */ |
c310d1f9 MCC |
70 | #define MEM2MEM_HFLIP BIT(0) |
71 | #define MEM2MEM_VFLIP BIT(1) | |
80072871 | 72 | |
de5c46ad MCC |
73 | #define dprintk(dev, lvl, fmt, arg...) \ |
74 | v4l2_dbg(lvl, debug, &(dev)->v4l2_dev, "%s: " fmt, __func__, ## arg) | |
96d8eab5 | 75 | |
1f923a42 | 76 | static void vim2m_dev_release(struct device *dev) |
96d8eab5 PO |
77 | {} |
78 | ||
1f923a42 | 79 | static struct platform_device vim2m_pdev = { |
96d8eab5 | 80 | .name = MEM2MEM_NAME, |
1f923a42 | 81 | .dev.release = vim2m_dev_release, |
96d8eab5 PO |
82 | }; |
83 | ||
1f923a42 | 84 | struct vim2m_fmt { |
96d8eab5 PO |
85 | u32 fourcc; |
86 | int depth; | |
1875a7c8 MCC |
87 | /* Types the format can be used for */ |
88 | u32 types; | |
96d8eab5 PO |
89 | }; |
90 | ||
1f923a42 | 91 | static struct vim2m_fmt formats[] = { |
96d8eab5 | 92 | { |
8aa153f1 | 93 | .fourcc = V4L2_PIX_FMT_RGB565, /* rrrrrggg gggbbbbb */ |
96d8eab5 | 94 | .depth = 16, |
1875a7c8 | 95 | .types = MEM2MEM_CAPTURE | MEM2MEM_OUTPUT, |
8aa153f1 MCC |
96 | }, { |
97 | .fourcc = V4L2_PIX_FMT_RGB565X, /* gggbbbbb rrrrrggg */ | |
98 | .depth = 16, | |
1875a7c8 | 99 | .types = MEM2MEM_CAPTURE | MEM2MEM_OUTPUT, |
8aa153f1 MCC |
100 | }, { |
101 | .fourcc = V4L2_PIX_FMT_RGB24, | |
102 | .depth = 24, | |
1875a7c8 | 103 | .types = MEM2MEM_CAPTURE | MEM2MEM_OUTPUT, |
8aa153f1 MCC |
104 | }, { |
105 | .fourcc = V4L2_PIX_FMT_BGR24, | |
106 | .depth = 24, | |
1875a7c8 | 107 | .types = MEM2MEM_CAPTURE | MEM2MEM_OUTPUT, |
8aa153f1 | 108 | }, { |
96d8eab5 PO |
109 | .fourcc = V4L2_PIX_FMT_YUYV, |
110 | .depth = 16, | |
69d68a4e | 111 | .types = MEM2MEM_CAPTURE, |
1875a7c8 MCC |
112 | }, { |
113 | .fourcc = V4L2_PIX_FMT_SBGGR8, | |
114 | .depth = 8, | |
115 | .types = MEM2MEM_CAPTURE, | |
116 | }, { | |
117 | .fourcc = V4L2_PIX_FMT_SGBRG8, | |
118 | .depth = 8, | |
119 | .types = MEM2MEM_CAPTURE, | |
120 | }, { | |
121 | .fourcc = V4L2_PIX_FMT_SGRBG8, | |
122 | .depth = 8, | |
123 | .types = MEM2MEM_CAPTURE, | |
124 | }, { | |
125 | .fourcc = V4L2_PIX_FMT_SRGGB8, | |
126 | .depth = 8, | |
127 | .types = MEM2MEM_CAPTURE, | |
96d8eab5 PO |
128 | }, |
129 | }; | |
130 | ||
d3dd59c2 HV |
131 | #define NUM_FORMATS ARRAY_SIZE(formats) |
132 | ||
96d8eab5 | 133 | /* Per-queue, driver-specific private data */ |
1f923a42 | 134 | struct vim2m_q_data { |
96d8eab5 PO |
135 | unsigned int width; |
136 | unsigned int height; | |
137 | unsigned int sizeimage; | |
ca5f5fdb | 138 | unsigned int sequence; |
1f923a42 | 139 | struct vim2m_fmt *fmt; |
96d8eab5 PO |
140 | }; |
141 | ||
142 | enum { | |
143 | V4L2_M2M_SRC = 0, | |
144 | V4L2_M2M_DST = 1, | |
145 | }; | |
146 | ||
d3dd59c2 HV |
147 | #define V4L2_CID_TRANS_TIME_MSEC (V4L2_CID_USER_BASE + 0x1000) |
148 | #define V4L2_CID_TRANS_NUM_BUFS (V4L2_CID_USER_BASE + 0x1001) | |
96d8eab5 | 149 | |
9c9c396c | 150 | static struct vim2m_fmt *find_format(u32 fourcc) |
96d8eab5 | 151 | { |
1f923a42 | 152 | struct vim2m_fmt *fmt; |
96d8eab5 PO |
153 | unsigned int k; |
154 | ||
155 | for (k = 0; k < NUM_FORMATS; k++) { | |
156 | fmt = &formats[k]; | |
9c9c396c | 157 | if (fmt->fourcc == fourcc) |
96d8eab5 PO |
158 | break; |
159 | } | |
160 | ||
161 | if (k == NUM_FORMATS) | |
162 | return NULL; | |
163 | ||
164 | return &formats[k]; | |
165 | } | |
166 | ||
c8af44e1 MCC |
167 | static void get_alignment(u32 fourcc, |
168 | unsigned int *walign, unsigned int *halign) | |
169 | { | |
170 | switch (fourcc) { | |
171 | case V4L2_PIX_FMT_SBGGR8: | |
172 | case V4L2_PIX_FMT_SGBRG8: | |
173 | case V4L2_PIX_FMT_SGRBG8: | |
174 | case V4L2_PIX_FMT_SRGGB8: | |
175 | *walign = BAYER_WIDTH_ALIGN; | |
176 | *halign = BAYER_HEIGHT_ALIGN; | |
177 | return; | |
178 | default: | |
179 | *walign = WIDTH_ALIGN; | |
180 | *halign = HEIGHT_ALIGN; | |
181 | return; | |
182 | } | |
183 | } | |
184 | ||
1f923a42 | 185 | struct vim2m_dev { |
96d8eab5 | 186 | struct v4l2_device v4l2_dev; |
09365420 | 187 | struct video_device vfd; |
e35f7021 HV |
188 | #ifdef CONFIG_MEDIA_CONTROLLER |
189 | struct media_device mdev; | |
190 | #endif | |
96d8eab5 PO |
191 | |
192 | atomic_t num_inst; | |
193 | struct mutex dev_mutex; | |
96d8eab5 PO |
194 | |
195 | struct v4l2_m2m_dev *m2m_dev; | |
196 | }; | |
197 | ||
1f923a42 | 198 | struct vim2m_ctx { |
d3dd59c2 | 199 | struct v4l2_fh fh; |
1f923a42 | 200 | struct vim2m_dev *dev; |
96d8eab5 | 201 | |
d3dd59c2 HV |
202 | struct v4l2_ctrl_handler hdl; |
203 | ||
96d8eab5 PO |
204 | /* Processed buffers in this transaction */ |
205 | u8 num_processed; | |
206 | ||
207 | /* Transaction length (i.e. how many buffers per transaction) */ | |
208 | u32 translen; | |
209 | /* Transaction time (i.e. simulated processing time) in milliseconds */ | |
210 | u32 transtime; | |
211 | ||
b3e64e5b MCC |
212 | struct mutex vb_mutex; |
213 | struct delayed_work work_run; | |
b3e64e5b | 214 | |
96d8eab5 PO |
215 | /* Abort requested by m2m */ |
216 | int aborting; | |
217 | ||
80072871 TM |
218 | /* Processing mode */ |
219 | int mode; | |
220 | ||
47556ffa | 221 | enum v4l2_colorspace colorspace; |
9f8b3333 HV |
222 | enum v4l2_ycbcr_encoding ycbcr_enc; |
223 | enum v4l2_xfer_func xfer_func; | |
224 | enum v4l2_quantization quant; | |
47556ffa | 225 | |
9f4161a6 | 226 | /* Source and destination queue data */ |
1f923a42 | 227 | struct vim2m_q_data q_data[2]; |
96d8eab5 PO |
228 | }; |
229 | ||
1f923a42 | 230 | static inline struct vim2m_ctx *file2ctx(struct file *file) |
d3dd59c2 | 231 | { |
1f923a42 | 232 | return container_of(file->private_data, struct vim2m_ctx, fh); |
d3dd59c2 HV |
233 | } |
234 | ||
1f923a42 | 235 | static struct vim2m_q_data *get_q_data(struct vim2m_ctx *ctx, |
c310d1f9 | 236 | enum v4l2_buf_type type) |
9f4161a6 TM |
237 | { |
238 | switch (type) { | |
239 | case V4L2_BUF_TYPE_VIDEO_OUTPUT: | |
240 | return &ctx->q_data[V4L2_M2M_SRC]; | |
241 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: | |
242 | return &ctx->q_data[V4L2_M2M_DST]; | |
243 | default: | |
971d62dd | 244 | return NULL; |
9f4161a6 | 245 | } |
9f4161a6 TM |
246 | } |
247 | ||
de5c46ad MCC |
248 | static const char *type_name(enum v4l2_buf_type type) |
249 | { | |
250 | switch (type) { | |
251 | case V4L2_BUF_TYPE_VIDEO_OUTPUT: | |
252 | return "Output"; | |
253 | case V4L2_BUF_TYPE_VIDEO_CAPTURE: | |
254 | return "Capture"; | |
255 | default: | |
256 | return "Invalid"; | |
257 | } | |
258 | } | |
259 | ||
8aa153f1 MCC |
260 | #define CLIP(__color) \ |
261 | (u8)(((__color) > 0xff) ? 0xff : (((__color) < 0) ? 0 : (__color))) | |
9f4161a6 | 262 | |
5f78f7e7 MCC |
263 | static void copy_line(struct vim2m_q_data *q_data_out, |
264 | u8 *src, u8 *dst, bool reverse) | |
96d8eab5 | 265 | { |
5f78f7e7 | 266 | int x, depth = q_data_out->fmt->depth >> 3; |
96d8eab5 | 267 | |
24cc418b | 268 | if (!reverse) { |
5f78f7e7 MCC |
269 | memcpy(dst, src, q_data_out->width * depth); |
270 | } else { | |
271 | for (x = 0; x < q_data_out->width >> 1; x++) { | |
272 | memcpy(dst, src, depth); | |
273 | memcpy(dst + depth, src - depth, depth); | |
274 | src -= depth << 1; | |
275 | dst += depth << 1; | |
276 | } | |
0b390d0c | 277 | return; |
24cc418b | 278 | } |
24cc418b MCC |
279 | } |
280 | ||
281 | static void copy_two_pixels(struct vim2m_q_data *q_data_in, | |
282 | struct vim2m_q_data *q_data_out, | |
f9729920 | 283 | u8 *src[2], u8 **dst, int ypos, bool reverse) |
24cc418b MCC |
284 | { |
285 | struct vim2m_fmt *out = q_data_out->fmt; | |
286 | struct vim2m_fmt *in = q_data_in->fmt; | |
287 | u8 _r[2], _g[2], _b[2], *r, *g, *b; | |
f9729920 | 288 | int i; |
24cc418b | 289 | |
8aa153f1 | 290 | /* Step 1: read two consecutive pixels from src pointer */ |
96d8eab5 | 291 | |
8aa153f1 MCC |
292 | r = _r; |
293 | g = _g; | |
294 | b = _b; | |
d95d7c64 | 295 | |
8aa153f1 MCC |
296 | switch (in->fourcc) { |
297 | case V4L2_PIX_FMT_RGB565: /* rrrrrggg gggbbbbb */ | |
298 | for (i = 0; i < 2; i++) { | |
060162c1 | 299 | u16 pix = le16_to_cpu(*(__le16 *)(src[i])); |
8aa153f1 MCC |
300 | |
301 | *r++ = (u8)(((pix & 0xf800) >> 11) << 3) | 0x07; | |
302 | *g++ = (u8)((((pix & 0x07e0) >> 5)) << 2) | 0x03; | |
303 | *b++ = (u8)((pix & 0x1f) << 3) | 0x07; | |
80072871 TM |
304 | } |
305 | break; | |
8aa153f1 MCC |
306 | case V4L2_PIX_FMT_RGB565X: /* gggbbbbb rrrrrggg */ |
307 | for (i = 0; i < 2; i++) { | |
060162c1 | 308 | u16 pix = be16_to_cpu(*(__be16 *)(src[i])); |
80072871 | 309 | |
060162c1 MCC |
310 | *r++ = (u8)(((pix & 0xf800) >> 11) << 3) | 0x07; |
311 | *g++ = (u8)((((pix & 0x07e0) >> 5)) << 2) | 0x03; | |
312 | *b++ = (u8)((pix & 0x1f) << 3) | 0x07; | |
80072871 TM |
313 | } |
314 | break; | |
69d68a4e | 315 | default: |
8aa153f1 MCC |
316 | case V4L2_PIX_FMT_RGB24: |
317 | for (i = 0; i < 2; i++) { | |
f9729920 MCC |
318 | *r++ = src[i][0]; |
319 | *g++ = src[i][1]; | |
320 | *b++ = src[i][2]; | |
80072871 TM |
321 | } |
322 | break; | |
8aa153f1 MCC |
323 | case V4L2_PIX_FMT_BGR24: |
324 | for (i = 0; i < 2; i++) { | |
f9729920 MCC |
325 | *b++ = src[i][0]; |
326 | *g++ = src[i][1]; | |
327 | *r++ = src[i][2]; | |
8aa153f1 MCC |
328 | } |
329 | break; | |
8aa153f1 MCC |
330 | } |
331 | ||
332 | /* Step 2: store two consecutive points, reversing them if needed */ | |
333 | ||
334 | r = _r; | |
335 | g = _g; | |
336 | b = _b; | |
337 | ||
338 | switch (out->fourcc) { | |
339 | case V4L2_PIX_FMT_RGB565: /* rrrrrggg gggbbbbb */ | |
340 | for (i = 0; i < 2; i++) { | |
060162c1 MCC |
341 | u16 pix; |
342 | __le16 *dst_pix = (__le16 *)*dst; | |
8aa153f1 | 343 | |
060162c1 MCC |
344 | pix = ((*r << 8) & 0xf800) | ((*g << 3) & 0x07e0) | |
345 | (*b >> 3); | |
346 | ||
347 | *dst_pix = cpu_to_le16(pix); | |
8aa153f1 MCC |
348 | |
349 | *dst += 2; | |
350 | } | |
351 | return; | |
352 | case V4L2_PIX_FMT_RGB565X: /* gggbbbbb rrrrrggg */ | |
353 | for (i = 0; i < 2; i++) { | |
060162c1 MCC |
354 | u16 pix; |
355 | __be16 *dst_pix = (__be16 *)*dst; | |
356 | ||
357 | pix = ((*r << 8) & 0xf800) | ((*g << 3) & 0x07e0) | | |
358 | (*b >> 3); | |
8aa153f1 | 359 | |
060162c1 | 360 | *dst_pix = cpu_to_be16(pix); |
8aa153f1 MCC |
361 | |
362 | *dst += 2; | |
363 | } | |
364 | return; | |
365 | case V4L2_PIX_FMT_RGB24: | |
366 | for (i = 0; i < 2; i++) { | |
367 | *(*dst)++ = *r++; | |
368 | *(*dst)++ = *g++; | |
369 | *(*dst)++ = *b++; | |
370 | } | |
371 | return; | |
372 | case V4L2_PIX_FMT_BGR24: | |
373 | for (i = 0; i < 2; i++) { | |
374 | *(*dst)++ = *b++; | |
375 | *(*dst)++ = *g++; | |
376 | *(*dst)++ = *r++; | |
377 | } | |
378 | return; | |
1875a7c8 MCC |
379 | case V4L2_PIX_FMT_YUYV: |
380 | default: | |
8aa153f1 MCC |
381 | { |
382 | u8 y, y1, u, v; | |
383 | ||
384 | y = ((8453 * (*r) + 16594 * (*g) + 3223 * (*b) | |
385 | + 524288) >> 15); | |
386 | u = ((-4878 * (*r) - 9578 * (*g) + 14456 * (*b) | |
387 | + 4210688) >> 15); | |
388 | v = ((14456 * (*r++) - 12105 * (*g++) - 2351 * (*b++) | |
389 | + 4210688) >> 15); | |
390 | y1 = ((8453 * (*r) + 16594 * (*g) + 3223 * (*b) | |
391 | + 524288) >> 15); | |
392 | ||
393 | *(*dst)++ = y; | |
394 | *(*dst)++ = u; | |
395 | ||
396 | *(*dst)++ = y1; | |
397 | *(*dst)++ = v; | |
398 | return; | |
399 | } | |
1875a7c8 MCC |
400 | case V4L2_PIX_FMT_SBGGR8: |
401 | if (!(ypos & 1)) { | |
402 | *(*dst)++ = *b; | |
403 | *(*dst)++ = *++g; | |
404 | } else { | |
405 | *(*dst)++ = *g; | |
406 | *(*dst)++ = *++r; | |
407 | } | |
408 | return; | |
409 | case V4L2_PIX_FMT_SGBRG8: | |
410 | if (!(ypos & 1)) { | |
411 | *(*dst)++ = *g; | |
412 | *(*dst)++ = *++b; | |
413 | } else { | |
414 | *(*dst)++ = *r; | |
415 | *(*dst)++ = *++g; | |
416 | } | |
417 | return; | |
418 | case V4L2_PIX_FMT_SGRBG8: | |
419 | if (!(ypos & 1)) { | |
420 | *(*dst)++ = *g; | |
421 | *(*dst)++ = *++r; | |
422 | } else { | |
423 | *(*dst)++ = *b; | |
424 | *(*dst)++ = *++g; | |
425 | } | |
426 | return; | |
427 | case V4L2_PIX_FMT_SRGGB8: | |
428 | if (!(ypos & 1)) { | |
429 | *(*dst)++ = *r; | |
430 | *(*dst)++ = *++g; | |
431 | } else { | |
432 | *(*dst)++ = *g; | |
433 | *(*dst)++ = *++b; | |
434 | } | |
435 | return; | |
8aa153f1 MCC |
436 | } |
437 | } | |
438 | ||
439 | static int device_process(struct vim2m_ctx *ctx, | |
440 | struct vb2_v4l2_buffer *in_vb, | |
441 | struct vb2_v4l2_buffer *out_vb) | |
442 | { | |
443 | struct vim2m_dev *dev = ctx->dev; | |
444 | struct vim2m_q_data *q_data_in, *q_data_out; | |
f9729920 MCC |
445 | u8 *p_in, *p_line, *p_in_x[2], *p, *p_out; |
446 | unsigned int width, height, bytesperline, bytes_per_pixel; | |
447 | unsigned int x, y, y_in, y_out, x_int, x_fract, x_err, x_offset; | |
24cc418b | 448 | int start, end, step; |
8aa153f1 MCC |
449 | |
450 | q_data_in = get_q_data(ctx, V4L2_BUF_TYPE_VIDEO_OUTPUT); | |
971d62dd MCC |
451 | if (!q_data_in) |
452 | return 0; | |
8aa153f1 | 453 | bytesperline = (q_data_in->width * q_data_in->fmt->depth) >> 3; |
f9729920 | 454 | bytes_per_pixel = q_data_in->fmt->depth >> 3; |
8aa153f1 MCC |
455 | |
456 | q_data_out = get_q_data(ctx, V4L2_BUF_TYPE_VIDEO_CAPTURE); | |
971d62dd MCC |
457 | if (!q_data_out) |
458 | return 0; | |
24cc418b | 459 | |
f9729920 | 460 | /* As we're doing scaling, use the output dimensions here */ |
0b390d0c | 461 | height = q_data_out->height; |
f9729920 | 462 | width = q_data_out->width; |
8aa153f1 MCC |
463 | |
464 | p_in = vb2_plane_vaddr(&in_vb->vb2_buf, 0); | |
465 | p_out = vb2_plane_vaddr(&out_vb->vb2_buf, 0); | |
466 | if (!p_in || !p_out) { | |
467 | v4l2_err(&dev->v4l2_dev, | |
468 | "Acquiring kernel pointers to buffers failed\n"); | |
469 | return -EFAULT; | |
470 | } | |
471 | ||
971d62dd | 472 | out_vb->sequence = q_data_out->sequence++; |
8aa153f1 | 473 | in_vb->sequence = q_data_in->sequence++; |
a4d3d612 | 474 | v4l2_m2m_buf_copy_metadata(in_vb, out_vb, true); |
8aa153f1 MCC |
475 | |
476 | if (ctx->mode & MEM2MEM_VFLIP) { | |
477 | start = height - 1; | |
478 | end = -1; | |
479 | step = -1; | |
480 | } else { | |
481 | start = 0; | |
482 | end = height; | |
483 | step = 1; | |
484 | } | |
1875a7c8 | 485 | y_out = 0; |
0b390d0c | 486 | |
c310d1f9 MCC |
487 | /* |
488 | * When format and resolution are identical, | |
489 | * we can use a faster copy logic | |
490 | */ | |
0b390d0c MCC |
491 | if (q_data_in->fmt->fourcc == q_data_out->fmt->fourcc && |
492 | q_data_in->width == q_data_out->width && | |
493 | q_data_in->height == q_data_out->height) { | |
494 | for (y = start; y != end; y += step, y_out++) { | |
495 | p = p_in + (y * bytesperline); | |
496 | if (ctx->mode & MEM2MEM_HFLIP) | |
497 | p += bytesperline - (q_data_in->fmt->depth >> 3); | |
498 | ||
5f78f7e7 MCC |
499 | copy_line(q_data_out, p, p_out, |
500 | ctx->mode & MEM2MEM_HFLIP); | |
501 | ||
502 | p_out += bytesperline; | |
0b390d0c MCC |
503 | } |
504 | return 0; | |
505 | } | |
506 | ||
5f78f7e7 | 507 | /* Slower algorithm with format conversion, hflip, vflip and scaler */ |
f9729920 MCC |
508 | |
509 | /* To speed scaler up, use Bresenham for X dimension */ | |
510 | x_int = q_data_in->width / q_data_out->width; | |
511 | x_fract = q_data_in->width % q_data_out->width; | |
512 | ||
1875a7c8 | 513 | for (y = start; y != end; y += step, y_out++) { |
0b390d0c | 514 | y_in = (y * q_data_in->height) / q_data_out->height; |
f9729920 MCC |
515 | x_offset = 0; |
516 | x_err = 0; | |
0b390d0c | 517 | |
f9729920 | 518 | p_line = p_in + (y_in * bytesperline); |
8aa153f1 | 519 | if (ctx->mode & MEM2MEM_HFLIP) |
f9729920 MCC |
520 | p_line += bytesperline - (q_data_in->fmt->depth >> 3); |
521 | p_in_x[0] = p_line; | |
522 | ||
523 | for (x = 0; x < width >> 1; x++) { | |
524 | x_offset += x_int; | |
525 | x_err += x_fract; | |
526 | if (x_err > width) { | |
527 | x_offset++; | |
528 | x_err -= width; | |
529 | } | |
530 | ||
531 | if (ctx->mode & MEM2MEM_HFLIP) | |
532 | p_in_x[1] = p_line - x_offset * bytes_per_pixel; | |
533 | else | |
534 | p_in_x[1] = p_line + x_offset * bytes_per_pixel; | |
8aa153f1 | 535 | |
f9729920 MCC |
536 | copy_two_pixels(q_data_in, q_data_out, |
537 | p_in_x, &p_out, y_out, | |
8aa153f1 | 538 | ctx->mode & MEM2MEM_HFLIP); |
24cc418b | 539 | |
f9729920 MCC |
540 | /* Calculate the next p_in_x0 */ |
541 | x_offset += x_int; | |
542 | x_err += x_fract; | |
543 | if (x_err > width) { | |
544 | x_offset++; | |
545 | x_err -= width; | |
546 | } | |
547 | ||
548 | if (ctx->mode & MEM2MEM_HFLIP) | |
549 | p_in_x[0] = p_line - x_offset * bytes_per_pixel; | |
550 | else | |
551 | p_in_x[0] = p_line + x_offset * bytes_per_pixel; | |
552 | } | |
96d8eab5 PO |
553 | } |
554 | ||
555 | return 0; | |
556 | } | |
557 | ||
96d8eab5 PO |
558 | /* |
559 | * mem2mem callbacks | |
560 | */ | |
561 | ||
cba862dc | 562 | /* |
96d8eab5 PO |
563 | * job_ready() - check whether an instance is ready to be scheduled to run |
564 | */ | |
565 | static int job_ready(void *priv) | |
566 | { | |
1f923a42 | 567 | struct vim2m_ctx *ctx = priv; |
96d8eab5 | 568 | |
20702ebc SN |
569 | if (v4l2_m2m_num_src_bufs_ready(ctx->fh.m2m_ctx) < ctx->translen |
570 | || v4l2_m2m_num_dst_bufs_ready(ctx->fh.m2m_ctx) < ctx->translen) { | |
de5c46ad | 571 | dprintk(ctx->dev, 1, "Not enough buffers available\n"); |
96d8eab5 PO |
572 | return 0; |
573 | } | |
574 | ||
575 | return 1; | |
576 | } | |
577 | ||
578 | static void job_abort(void *priv) | |
579 | { | |
1f923a42 | 580 | struct vim2m_ctx *ctx = priv; |
96d8eab5 PO |
581 | |
582 | /* Will cancel the transaction in the next interrupt handler */ | |
583 | ctx->aborting = 1; | |
584 | } | |
585 | ||
586 | /* device_run() - prepares and starts the device | |
587 | * | |
588 | * This simulates all the immediate preparations required before starting | |
589 | * a device. This will be called by the framework when it decides to schedule | |
590 | * a particular instance. | |
591 | */ | |
592 | static void device_run(void *priv) | |
593 | { | |
1f923a42 | 594 | struct vim2m_ctx *ctx = priv; |
2d700715 | 595 | struct vb2_v4l2_buffer *src_buf, *dst_buf; |
96d8eab5 | 596 | |
20702ebc SN |
597 | src_buf = v4l2_m2m_next_src_buf(ctx->fh.m2m_ctx); |
598 | dst_buf = v4l2_m2m_next_dst_buf(ctx->fh.m2m_ctx); | |
96d8eab5 | 599 | |
86b93b2c HV |
600 | /* Apply request controls if any */ |
601 | v4l2_ctrl_request_setup(src_buf->vb2_buf.req_obj.req, | |
602 | &ctx->hdl); | |
603 | ||
96d8eab5 PO |
604 | device_process(ctx, src_buf, dst_buf); |
605 | ||
86b93b2c HV |
606 | /* Complete request controls if any */ |
607 | v4l2_ctrl_request_complete(src_buf->vb2_buf.req_obj.req, | |
608 | &ctx->hdl); | |
609 | ||
144bd0ee | 610 | /* Run delayed work, which simulates a hardware irq */ |
b3e64e5b | 611 | schedule_delayed_work(&ctx->work_run, msecs_to_jiffies(ctx->transtime)); |
96d8eab5 PO |
612 | } |
613 | ||
144bd0ee | 614 | static void device_work(struct work_struct *w) |
96d8eab5 | 615 | { |
1f923a42 | 616 | struct vim2m_ctx *curr_ctx; |
b3e64e5b | 617 | struct vim2m_dev *vim2m_dev; |
2d700715 | 618 | struct vb2_v4l2_buffer *src_vb, *dst_vb; |
96d8eab5 | 619 | |
b3e64e5b | 620 | curr_ctx = container_of(w, struct vim2m_ctx, work_run.work); |
96d8eab5 | 621 | |
22f05d64 MCC |
622 | vim2m_dev = curr_ctx->dev; |
623 | ||
20702ebc SN |
624 | src_vb = v4l2_m2m_src_buf_remove(curr_ctx->fh.m2m_ctx); |
625 | dst_vb = v4l2_m2m_dst_buf_remove(curr_ctx->fh.m2m_ctx); | |
d80ee38c | 626 | |
96d8eab5 PO |
627 | curr_ctx->num_processed++; |
628 | ||
d80ee38c MS |
629 | v4l2_m2m_buf_done(src_vb, VB2_BUF_STATE_DONE); |
630 | v4l2_m2m_buf_done(dst_vb, VB2_BUF_STATE_DONE); | |
d80ee38c | 631 | |
96d8eab5 PO |
632 | if (curr_ctx->num_processed == curr_ctx->translen |
633 | || curr_ctx->aborting) { | |
de5c46ad | 634 | dprintk(curr_ctx->dev, 2, "Finishing capture buffer fill\n"); |
96d8eab5 | 635 | curr_ctx->num_processed = 0; |
1f923a42 | 636 | v4l2_m2m_job_finish(vim2m_dev->m2m_dev, curr_ctx->fh.m2m_ctx); |
96d8eab5 | 637 | } else { |
96d8eab5 PO |
638 | device_run(curr_ctx); |
639 | } | |
640 | } | |
641 | ||
96d8eab5 PO |
642 | /* |
643 | * video ioctls | |
644 | */ | |
645 | static int vidioc_querycap(struct file *file, void *priv, | |
646 | struct v4l2_capability *cap) | |
647 | { | |
85709cbf MCC |
648 | strscpy(cap->driver, MEM2MEM_NAME, sizeof(cap->driver)); |
649 | strscpy(cap->card, MEM2MEM_NAME, sizeof(cap->card)); | |
72c2af6e | 650 | snprintf(cap->bus_info, sizeof(cap->bus_info), |
c310d1f9 | 651 | "platform:%s", MEM2MEM_NAME); |
96d8eab5 PO |
652 | return 0; |
653 | } | |
654 | ||
655 | static int enum_fmt(struct v4l2_fmtdesc *f, u32 type) | |
656 | { | |
1875a7c8 | 657 | int i, num; |
1f923a42 | 658 | struct vim2m_fmt *fmt; |
96d8eab5 | 659 | |
1875a7c8 MCC |
660 | num = 0; |
661 | ||
662 | for (i = 0; i < NUM_FORMATS; ++i) { | |
663 | if (formats[i].types & type) { | |
664 | /* index-th format of type type found ? */ | |
665 | if (num == f->index) | |
666 | break; | |
667 | /* | |
668 | * Correct type but haven't reached our index yet, | |
669 | * just increment per-type index | |
670 | */ | |
671 | ++num; | |
672 | } | |
673 | } | |
674 | ||
675 | if (i < NUM_FORMATS) { | |
96d8eab5 | 676 | /* Format found */ |
1875a7c8 | 677 | fmt = &formats[i]; |
96d8eab5 PO |
678 | f->pixelformat = fmt->fourcc; |
679 | return 0; | |
680 | } | |
681 | ||
682 | /* Format not found */ | |
683 | return -EINVAL; | |
684 | } | |
685 | ||
686 | static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, | |
687 | struct v4l2_fmtdesc *f) | |
688 | { | |
689 | return enum_fmt(f, MEM2MEM_CAPTURE); | |
690 | } | |
691 | ||
692 | static int vidioc_enum_fmt_vid_out(struct file *file, void *priv, | |
693 | struct v4l2_fmtdesc *f) | |
694 | { | |
695 | return enum_fmt(f, MEM2MEM_OUTPUT); | |
696 | } | |
697 | ||
9c9c396c MCC |
698 | static int vidioc_enum_framesizes(struct file *file, void *priv, |
699 | struct v4l2_frmsizeenum *fsize) | |
700 | { | |
701 | if (fsize->index != 0) | |
702 | return -EINVAL; | |
703 | ||
704 | if (!find_format(fsize->pixel_format)) | |
705 | return -EINVAL; | |
706 | ||
707 | fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; | |
708 | fsize->stepwise.min_width = MIN_W; | |
709 | fsize->stepwise.min_height = MIN_H; | |
710 | fsize->stepwise.max_width = MAX_W; | |
711 | fsize->stepwise.max_height = MAX_H; | |
c8af44e1 MCC |
712 | |
713 | get_alignment(fsize->pixel_format, | |
714 | &fsize->stepwise.step_width, | |
715 | &fsize->stepwise.step_height); | |
9c9c396c MCC |
716 | return 0; |
717 | } | |
718 | ||
1f923a42 | 719 | static int vidioc_g_fmt(struct vim2m_ctx *ctx, struct v4l2_format *f) |
96d8eab5 | 720 | { |
d80ee38c | 721 | struct vb2_queue *vq; |
1f923a42 | 722 | struct vim2m_q_data *q_data; |
96d8eab5 | 723 | |
20702ebc | 724 | vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type); |
96d8eab5 PO |
725 | if (!vq) |
726 | return -EINVAL; | |
727 | ||
9f4161a6 | 728 | q_data = get_q_data(ctx, f->type); |
971d62dd MCC |
729 | if (!q_data) |
730 | return -EINVAL; | |
96d8eab5 PO |
731 | |
732 | f->fmt.pix.width = q_data->width; | |
733 | f->fmt.pix.height = q_data->height; | |
d80ee38c | 734 | f->fmt.pix.field = V4L2_FIELD_NONE; |
96d8eab5 PO |
735 | f->fmt.pix.pixelformat = q_data->fmt->fourcc; |
736 | f->fmt.pix.bytesperline = (q_data->width * q_data->fmt->depth) >> 3; | |
737 | f->fmt.pix.sizeimage = q_data->sizeimage; | |
47556ffa | 738 | f->fmt.pix.colorspace = ctx->colorspace; |
9f8b3333 HV |
739 | f->fmt.pix.xfer_func = ctx->xfer_func; |
740 | f->fmt.pix.ycbcr_enc = ctx->ycbcr_enc; | |
741 | f->fmt.pix.quantization = ctx->quant; | |
96d8eab5 PO |
742 | |
743 | return 0; | |
744 | } | |
745 | ||
746 | static int vidioc_g_fmt_vid_out(struct file *file, void *priv, | |
747 | struct v4l2_format *f) | |
748 | { | |
d3dd59c2 | 749 | return vidioc_g_fmt(file2ctx(file), f); |
96d8eab5 PO |
750 | } |
751 | ||
752 | static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, | |
753 | struct v4l2_format *f) | |
754 | { | |
d3dd59c2 | 755 | return vidioc_g_fmt(file2ctx(file), f); |
96d8eab5 PO |
756 | } |
757 | ||
1f923a42 | 758 | static int vidioc_try_fmt(struct v4l2_format *f, struct vim2m_fmt *fmt) |
96d8eab5 | 759 | { |
c8af44e1 | 760 | int walign, halign; |
c310d1f9 MCC |
761 | /* |
762 | * V4L2 specification specifies the driver corrects the | |
763 | * format struct if any of the dimensions is unsupported | |
764 | */ | |
96d8eab5 PO |
765 | if (f->fmt.pix.height < MIN_H) |
766 | f->fmt.pix.height = MIN_H; | |
767 | else if (f->fmt.pix.height > MAX_H) | |
768 | f->fmt.pix.height = MAX_H; | |
769 | ||
770 | if (f->fmt.pix.width < MIN_W) | |
771 | f->fmt.pix.width = MIN_W; | |
772 | else if (f->fmt.pix.width > MAX_W) | |
773 | f->fmt.pix.width = MAX_W; | |
774 | ||
c8af44e1 MCC |
775 | get_alignment(f->fmt.pix.pixelformat, &walign, &halign); |
776 | f->fmt.pix.width &= ~(walign - 1); | |
777 | f->fmt.pix.height &= ~(halign - 1); | |
96d8eab5 PO |
778 | f->fmt.pix.bytesperline = (f->fmt.pix.width * fmt->depth) >> 3; |
779 | f->fmt.pix.sizeimage = f->fmt.pix.height * f->fmt.pix.bytesperline; | |
5c3112b5 | 780 | f->fmt.pix.field = V4L2_FIELD_NONE; |
96d8eab5 PO |
781 | |
782 | return 0; | |
783 | } | |
784 | ||
785 | static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, | |
786 | struct v4l2_format *f) | |
787 | { | |
1f923a42 HV |
788 | struct vim2m_fmt *fmt; |
789 | struct vim2m_ctx *ctx = file2ctx(file); | |
96d8eab5 | 790 | |
9c9c396c | 791 | fmt = find_format(f->fmt.pix.pixelformat); |
4e8ec0a4 HV |
792 | if (!fmt) { |
793 | f->fmt.pix.pixelformat = formats[0].fourcc; | |
9c9c396c | 794 | fmt = find_format(f->fmt.pix.pixelformat); |
4e8ec0a4 | 795 | } |
1875a7c8 MCC |
796 | if (!(fmt->types & MEM2MEM_CAPTURE)) { |
797 | v4l2_err(&ctx->dev->v4l2_dev, | |
798 | "Fourcc format (0x%08x) invalid.\n", | |
799 | f->fmt.pix.pixelformat); | |
800 | return -EINVAL; | |
801 | } | |
47556ffa | 802 | f->fmt.pix.colorspace = ctx->colorspace; |
9f8b3333 HV |
803 | f->fmt.pix.xfer_func = ctx->xfer_func; |
804 | f->fmt.pix.ycbcr_enc = ctx->ycbcr_enc; | |
805 | f->fmt.pix.quantization = ctx->quant; | |
96d8eab5 PO |
806 | |
807 | return vidioc_try_fmt(f, fmt); | |
808 | } | |
809 | ||
810 | static int vidioc_try_fmt_vid_out(struct file *file, void *priv, | |
811 | struct v4l2_format *f) | |
812 | { | |
1f923a42 | 813 | struct vim2m_fmt *fmt; |
1875a7c8 | 814 | struct vim2m_ctx *ctx = file2ctx(file); |
96d8eab5 | 815 | |
9c9c396c | 816 | fmt = find_format(f->fmt.pix.pixelformat); |
4e8ec0a4 HV |
817 | if (!fmt) { |
818 | f->fmt.pix.pixelformat = formats[0].fourcc; | |
9c9c396c | 819 | fmt = find_format(f->fmt.pix.pixelformat); |
4e8ec0a4 | 820 | } |
1875a7c8 MCC |
821 | if (!(fmt->types & MEM2MEM_OUTPUT)) { |
822 | v4l2_err(&ctx->dev->v4l2_dev, | |
823 | "Fourcc format (0x%08x) invalid.\n", | |
824 | f->fmt.pix.pixelformat); | |
825 | return -EINVAL; | |
826 | } | |
47556ffa HV |
827 | if (!f->fmt.pix.colorspace) |
828 | f->fmt.pix.colorspace = V4L2_COLORSPACE_REC709; | |
96d8eab5 PO |
829 | |
830 | return vidioc_try_fmt(f, fmt); | |
831 | } | |
832 | ||
1f923a42 | 833 | static int vidioc_s_fmt(struct vim2m_ctx *ctx, struct v4l2_format *f) |
96d8eab5 | 834 | { |
1f923a42 | 835 | struct vim2m_q_data *q_data; |
d80ee38c | 836 | struct vb2_queue *vq; |
96d8eab5 | 837 | |
20702ebc | 838 | vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type); |
96d8eab5 PO |
839 | if (!vq) |
840 | return -EINVAL; | |
841 | ||
9f4161a6 | 842 | q_data = get_q_data(ctx, f->type); |
96d8eab5 PO |
843 | if (!q_data) |
844 | return -EINVAL; | |
845 | ||
d80ee38c | 846 | if (vb2_is_busy(vq)) { |
96d8eab5 | 847 | v4l2_err(&ctx->dev->v4l2_dev, "%s queue busy\n", __func__); |
07e80305 | 848 | return -EBUSY; |
96d8eab5 PO |
849 | } |
850 | ||
9c9c396c | 851 | q_data->fmt = find_format(f->fmt.pix.pixelformat); |
96d8eab5 PO |
852 | q_data->width = f->fmt.pix.width; |
853 | q_data->height = f->fmt.pix.height; | |
854 | q_data->sizeimage = q_data->width * q_data->height | |
855 | * q_data->fmt->depth >> 3; | |
96d8eab5 | 856 | |
de5c46ad MCC |
857 | dprintk(ctx->dev, 1, |
858 | "Format for type %s: %dx%d (%d bpp), fmt: %c%c%c%c\n", | |
859 | type_name(f->type), q_data->width, q_data->height, | |
860 | q_data->fmt->depth, | |
861 | (q_data->fmt->fourcc & 0xff), | |
862 | (q_data->fmt->fourcc >> 8) & 0xff, | |
863 | (q_data->fmt->fourcc >> 16) & 0xff, | |
864 | (q_data->fmt->fourcc >> 24) & 0xff); | |
96d8eab5 | 865 | |
07e80305 | 866 | return 0; |
96d8eab5 PO |
867 | } |
868 | ||
869 | static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, | |
870 | struct v4l2_format *f) | |
871 | { | |
872 | int ret; | |
873 | ||
874 | ret = vidioc_try_fmt_vid_cap(file, priv, f); | |
875 | if (ret) | |
876 | return ret; | |
877 | ||
d3dd59c2 | 878 | return vidioc_s_fmt(file2ctx(file), f); |
96d8eab5 PO |
879 | } |
880 | ||
881 | static int vidioc_s_fmt_vid_out(struct file *file, void *priv, | |
882 | struct v4l2_format *f) | |
883 | { | |
1f923a42 | 884 | struct vim2m_ctx *ctx = file2ctx(file); |
96d8eab5 PO |
885 | int ret; |
886 | ||
887 | ret = vidioc_try_fmt_vid_out(file, priv, f); | |
888 | if (ret) | |
889 | return ret; | |
890 | ||
47556ffa | 891 | ret = vidioc_s_fmt(file2ctx(file), f); |
9f8b3333 | 892 | if (!ret) { |
47556ffa | 893 | ctx->colorspace = f->fmt.pix.colorspace; |
9f8b3333 HV |
894 | ctx->xfer_func = f->fmt.pix.xfer_func; |
895 | ctx->ycbcr_enc = f->fmt.pix.ycbcr_enc; | |
896 | ctx->quant = f->fmt.pix.quantization; | |
897 | } | |
47556ffa | 898 | return ret; |
96d8eab5 PO |
899 | } |
900 | ||
1f923a42 | 901 | static int vim2m_s_ctrl(struct v4l2_ctrl *ctrl) |
96d8eab5 | 902 | { |
1f923a42 HV |
903 | struct vim2m_ctx *ctx = |
904 | container_of(ctrl->handler, struct vim2m_ctx, hdl); | |
96d8eab5 PO |
905 | |
906 | switch (ctrl->id) { | |
80072871 | 907 | case V4L2_CID_HFLIP: |
d3dd59c2 | 908 | if (ctrl->val) |
80072871 TM |
909 | ctx->mode |= MEM2MEM_HFLIP; |
910 | else | |
911 | ctx->mode &= ~MEM2MEM_HFLIP; | |
912 | break; | |
913 | ||
914 | case V4L2_CID_VFLIP: | |
d3dd59c2 | 915 | if (ctrl->val) |
80072871 TM |
916 | ctx->mode |= MEM2MEM_VFLIP; |
917 | else | |
918 | ctx->mode &= ~MEM2MEM_VFLIP; | |
919 | break; | |
920 | ||
96d8eab5 | 921 | case V4L2_CID_TRANS_TIME_MSEC: |
d3dd59c2 | 922 | ctx->transtime = ctrl->val; |
f0ef022c MCC |
923 | if (ctx->transtime < 1) |
924 | ctx->transtime = 1; | |
96d8eab5 PO |
925 | break; |
926 | ||
927 | case V4L2_CID_TRANS_NUM_BUFS: | |
d3dd59c2 | 928 | ctx->translen = ctrl->val; |
96d8eab5 PO |
929 | break; |
930 | ||
931 | default: | |
932 | v4l2_err(&ctx->dev->v4l2_dev, "Invalid control\n"); | |
933 | return -EINVAL; | |
934 | } | |
935 | ||
936 | return 0; | |
937 | } | |
938 | ||
1f923a42 HV |
939 | static const struct v4l2_ctrl_ops vim2m_ctrl_ops = { |
940 | .s_ctrl = vim2m_s_ctrl, | |
d3dd59c2 HV |
941 | }; |
942 | ||
1f923a42 | 943 | static const struct v4l2_ioctl_ops vim2m_ioctl_ops = { |
96d8eab5 PO |
944 | .vidioc_querycap = vidioc_querycap, |
945 | ||
946 | .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, | |
9c9c396c | 947 | .vidioc_enum_framesizes = vidioc_enum_framesizes, |
96d8eab5 PO |
948 | .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, |
949 | .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, | |
950 | .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, | |
951 | ||
952 | .vidioc_enum_fmt_vid_out = vidioc_enum_fmt_vid_out, | |
953 | .vidioc_g_fmt_vid_out = vidioc_g_fmt_vid_out, | |
954 | .vidioc_try_fmt_vid_out = vidioc_try_fmt_vid_out, | |
955 | .vidioc_s_fmt_vid_out = vidioc_s_fmt_vid_out, | |
956 | ||
20702ebc SN |
957 | .vidioc_reqbufs = v4l2_m2m_ioctl_reqbufs, |
958 | .vidioc_querybuf = v4l2_m2m_ioctl_querybuf, | |
959 | .vidioc_qbuf = v4l2_m2m_ioctl_qbuf, | |
960 | .vidioc_dqbuf = v4l2_m2m_ioctl_dqbuf, | |
7bcff1c2 HV |
961 | .vidioc_prepare_buf = v4l2_m2m_ioctl_prepare_buf, |
962 | .vidioc_create_bufs = v4l2_m2m_ioctl_create_bufs, | |
f5294f45 | 963 | .vidioc_expbuf = v4l2_m2m_ioctl_expbuf, |
96d8eab5 | 964 | |
20702ebc SN |
965 | .vidioc_streamon = v4l2_m2m_ioctl_streamon, |
966 | .vidioc_streamoff = v4l2_m2m_ioctl_streamoff, | |
96d8eab5 | 967 | |
97a3c902 HV |
968 | .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, |
969 | .vidioc_unsubscribe_event = v4l2_event_unsubscribe, | |
96d8eab5 PO |
970 | }; |
971 | ||
96d8eab5 PO |
972 | /* |
973 | * Queue operations | |
974 | */ | |
975 | ||
1f923a42 | 976 | static int vim2m_queue_setup(struct vb2_queue *vq, |
c310d1f9 MCC |
977 | unsigned int *nbuffers, |
978 | unsigned int *nplanes, | |
979 | unsigned int sizes[], | |
980 | struct device *alloc_devs[]) | |
96d8eab5 | 981 | { |
1f923a42 HV |
982 | struct vim2m_ctx *ctx = vb2_get_drv_priv(vq); |
983 | struct vim2m_q_data *q_data; | |
d80ee38c | 984 | unsigned int size, count = *nbuffers; |
96d8eab5 | 985 | |
9f4161a6 | 986 | q_data = get_q_data(ctx, vq->type); |
971d62dd MCC |
987 | if (!q_data) |
988 | return -EINVAL; | |
96d8eab5 | 989 | |
d80ee38c MS |
990 | size = q_data->width * q_data->height * q_data->fmt->depth >> 3; |
991 | ||
992 | while (size * count > MEM2MEM_VID_MEM_LIMIT) | |
993 | (count)--; | |
df9ecb0c HV |
994 | *nbuffers = count; |
995 | ||
996 | if (*nplanes) | |
997 | return sizes[0] < size ? -EINVAL : 0; | |
96d8eab5 | 998 | |
d80ee38c | 999 | *nplanes = 1; |
d80ee38c | 1000 | sizes[0] = size; |
96d8eab5 | 1001 | |
de5c46ad MCC |
1002 | dprintk(ctx->dev, 1, "%s: get %d buffer(s) of size %d each.\n", |
1003 | type_name(vq->type), count, size); | |
96d8eab5 PO |
1004 | |
1005 | return 0; | |
1006 | } | |
1007 | ||
ab7afaf3 | 1008 | static int vim2m_buf_out_validate(struct vb2_buffer *vb) |
96d8eab5 | 1009 | { |
2d700715 | 1010 | struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); |
1f923a42 | 1011 | struct vim2m_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue); |
ab7afaf3 HV |
1012 | |
1013 | if (vbuf->field == V4L2_FIELD_ANY) | |
1014 | vbuf->field = V4L2_FIELD_NONE; | |
1015 | if (vbuf->field != V4L2_FIELD_NONE) { | |
de5c46ad | 1016 | dprintk(ctx->dev, 1, "%s field isn't supported\n", __func__); |
ab7afaf3 HV |
1017 | return -EINVAL; |
1018 | } | |
1019 | ||
1020 | return 0; | |
1021 | } | |
1022 | ||
1023 | static int vim2m_buf_prepare(struct vb2_buffer *vb) | |
1024 | { | |
1025 | struct vim2m_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue); | |
1f923a42 | 1026 | struct vim2m_q_data *q_data; |
96d8eab5 | 1027 | |
de5c46ad | 1028 | dprintk(ctx->dev, 2, "type: %s\n", type_name(vb->vb2_queue->type)); |
96d8eab5 | 1029 | |
9f4161a6 | 1030 | q_data = get_q_data(ctx, vb->vb2_queue->type); |
971d62dd MCC |
1031 | if (!q_data) |
1032 | return -EINVAL; | |
d80ee38c | 1033 | if (vb2_plane_size(vb, 0) < q_data->sizeimage) { |
de5c46ad MCC |
1034 | dprintk(ctx->dev, 1, |
1035 | "%s data will not fit into plane (%lu < %lu)\n", | |
1036 | __func__, vb2_plane_size(vb, 0), | |
1037 | (long)q_data->sizeimage); | |
96d8eab5 PO |
1038 | return -EINVAL; |
1039 | } | |
1040 | ||
d80ee38c | 1041 | vb2_set_plane_payload(vb, 0, q_data->sizeimage); |
96d8eab5 PO |
1042 | |
1043 | return 0; | |
96d8eab5 PO |
1044 | } |
1045 | ||
1f923a42 | 1046 | static void vim2m_buf_queue(struct vb2_buffer *vb) |
96d8eab5 | 1047 | { |
2d700715 | 1048 | struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); |
1f923a42 | 1049 | struct vim2m_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue); |
ca5f5fdb | 1050 | |
2d700715 | 1051 | v4l2_m2m_buf_queue(ctx->fh.m2m_ctx, vbuf); |
0f910bf0 MO |
1052 | } |
1053 | ||
c310d1f9 | 1054 | static int vim2m_start_streaming(struct vb2_queue *q, unsigned int count) |
ca5f5fdb | 1055 | { |
1f923a42 HV |
1056 | struct vim2m_ctx *ctx = vb2_get_drv_priv(q); |
1057 | struct vim2m_q_data *q_data = get_q_data(ctx, q->type); | |
ca5f5fdb | 1058 | |
971d62dd MCC |
1059 | if (!q_data) |
1060 | return -EINVAL; | |
1061 | ||
c362f77a JS |
1062 | if (V4L2_TYPE_IS_OUTPUT(q->type)) |
1063 | ctx->aborting = 0; | |
1064 | ||
ca5f5fdb HV |
1065 | q_data->sequence = 0; |
1066 | return 0; | |
1067 | } | |
1068 | ||
1f923a42 | 1069 | static void vim2m_stop_streaming(struct vb2_queue *q) |
a773632c | 1070 | { |
1f923a42 | 1071 | struct vim2m_ctx *ctx = vb2_get_drv_priv(q); |
2d700715 | 1072 | struct vb2_v4l2_buffer *vbuf; |
a773632c | 1073 | |
a8566d79 | 1074 | cancel_delayed_work_sync(&ctx->work_run); |
240809ef | 1075 | |
a773632c HV |
1076 | for (;;) { |
1077 | if (V4L2_TYPE_IS_OUTPUT(q->type)) | |
2d700715 | 1078 | vbuf = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx); |
a773632c | 1079 | else |
2d700715 | 1080 | vbuf = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx); |
c310d1f9 | 1081 | if (!vbuf) |
e37559b2 | 1082 | return; |
86b93b2c HV |
1083 | v4l2_ctrl_request_complete(vbuf->vb2_buf.req_obj.req, |
1084 | &ctx->hdl); | |
2d700715 | 1085 | v4l2_m2m_buf_done(vbuf, VB2_BUF_STATE_ERROR); |
a773632c | 1086 | } |
a773632c HV |
1087 | } |
1088 | ||
86b93b2c HV |
1089 | static void vim2m_buf_request_complete(struct vb2_buffer *vb) |
1090 | { | |
1091 | struct vim2m_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue); | |
1092 | ||
1093 | v4l2_ctrl_request_complete(vb->req_obj.req, &ctx->hdl); | |
1094 | } | |
1095 | ||
b7b361f0 | 1096 | static const struct vb2_ops vim2m_qops = { |
1f923a42 | 1097 | .queue_setup = vim2m_queue_setup, |
ab7afaf3 | 1098 | .buf_out_validate = vim2m_buf_out_validate, |
1f923a42 HV |
1099 | .buf_prepare = vim2m_buf_prepare, |
1100 | .buf_queue = vim2m_buf_queue, | |
1101 | .start_streaming = vim2m_start_streaming, | |
1102 | .stop_streaming = vim2m_stop_streaming, | |
20702ebc SN |
1103 | .wait_prepare = vb2_ops_wait_prepare, |
1104 | .wait_finish = vb2_ops_wait_finish, | |
86b93b2c | 1105 | .buf_request_complete = vim2m_buf_request_complete, |
96d8eab5 PO |
1106 | }; |
1107 | ||
c310d1f9 MCC |
1108 | static int queue_init(void *priv, struct vb2_queue *src_vq, |
1109 | struct vb2_queue *dst_vq) | |
96d8eab5 | 1110 | { |
1f923a42 | 1111 | struct vim2m_ctx *ctx = priv; |
d80ee38c | 1112 | int ret; |
96d8eab5 | 1113 | |
d80ee38c | 1114 | src_vq->type = V4L2_BUF_TYPE_VIDEO_OUTPUT; |
782f36ca | 1115 | src_vq->io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF; |
d80ee38c MS |
1116 | src_vq->drv_priv = ctx; |
1117 | src_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer); | |
1f923a42 | 1118 | src_vq->ops = &vim2m_qops; |
d80ee38c | 1119 | src_vq->mem_ops = &vb2_vmalloc_memops; |
ade48681 | 1120 | src_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY; |
b3e64e5b | 1121 | src_vq->lock = &ctx->vb_mutex; |
e5079cf1 | 1122 | src_vq->supports_requests = true; |
d80ee38c MS |
1123 | |
1124 | ret = vb2_queue_init(src_vq); | |
1125 | if (ret) | |
1126 | return ret; | |
96d8eab5 | 1127 | |
d80ee38c | 1128 | dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; |
782f36ca | 1129 | dst_vq->io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF; |
d80ee38c MS |
1130 | dst_vq->drv_priv = ctx; |
1131 | dst_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer); | |
1f923a42 | 1132 | dst_vq->ops = &vim2m_qops; |
d80ee38c | 1133 | dst_vq->mem_ops = &vb2_vmalloc_memops; |
ade48681 | 1134 | dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY; |
b3e64e5b | 1135 | dst_vq->lock = &ctx->vb_mutex; |
d80ee38c MS |
1136 | |
1137 | return vb2_queue_init(dst_vq); | |
1138 | } | |
96d8eab5 | 1139 | |
f0ef022c | 1140 | static struct v4l2_ctrl_config vim2m_ctrl_trans_time_msec = { |
1f923a42 | 1141 | .ops = &vim2m_ctrl_ops, |
d3dd59c2 HV |
1142 | .id = V4L2_CID_TRANS_TIME_MSEC, |
1143 | .name = "Transaction Time (msec)", | |
1144 | .type = V4L2_CTRL_TYPE_INTEGER, | |
d3dd59c2 HV |
1145 | .min = 1, |
1146 | .max = 10001, | |
43405831 | 1147 | .step = 1, |
d3dd59c2 HV |
1148 | }; |
1149 | ||
1f923a42 HV |
1150 | static const struct v4l2_ctrl_config vim2m_ctrl_trans_num_bufs = { |
1151 | .ops = &vim2m_ctrl_ops, | |
d3dd59c2 HV |
1152 | .id = V4L2_CID_TRANS_NUM_BUFS, |
1153 | .name = "Buffers Per Transaction", | |
1154 | .type = V4L2_CTRL_TYPE_INTEGER, | |
1155 | .def = 1, | |
1156 | .min = 1, | |
1157 | .max = MEM2MEM_DEF_NUM_BUFS, | |
1158 | .step = 1, | |
1159 | }; | |
1160 | ||
96d8eab5 PO |
1161 | /* |
1162 | * File operations | |
1163 | */ | |
1f923a42 | 1164 | static int vim2m_open(struct file *file) |
96d8eab5 | 1165 | { |
1f923a42 HV |
1166 | struct vim2m_dev *dev = video_drvdata(file); |
1167 | struct vim2m_ctx *ctx = NULL; | |
d3dd59c2 | 1168 | struct v4l2_ctrl_handler *hdl; |
f4694039 | 1169 | int rc = 0; |
96d8eab5 | 1170 | |
f4694039 HV |
1171 | if (mutex_lock_interruptible(&dev->dev_mutex)) |
1172 | return -ERESTARTSYS; | |
56ed221f | 1173 | ctx = kzalloc(sizeof(*ctx), GFP_KERNEL); |
f4694039 HV |
1174 | if (!ctx) { |
1175 | rc = -ENOMEM; | |
1176 | goto open_unlock; | |
1177 | } | |
96d8eab5 | 1178 | |
d3dd59c2 HV |
1179 | v4l2_fh_init(&ctx->fh, video_devdata(file)); |
1180 | file->private_data = &ctx->fh; | |
96d8eab5 | 1181 | ctx->dev = dev; |
d3dd59c2 HV |
1182 | hdl = &ctx->hdl; |
1183 | v4l2_ctrl_handler_init(hdl, 4); | |
1f923a42 HV |
1184 | v4l2_ctrl_new_std(hdl, &vim2m_ctrl_ops, V4L2_CID_HFLIP, 0, 1, 1, 0); |
1185 | v4l2_ctrl_new_std(hdl, &vim2m_ctrl_ops, V4L2_CID_VFLIP, 0, 1, 1, 0); | |
f0ef022c MCC |
1186 | |
1187 | vim2m_ctrl_trans_time_msec.def = default_transtime; | |
1f923a42 HV |
1188 | v4l2_ctrl_new_custom(hdl, &vim2m_ctrl_trans_time_msec, NULL); |
1189 | v4l2_ctrl_new_custom(hdl, &vim2m_ctrl_trans_num_bufs, NULL); | |
d3dd59c2 | 1190 | if (hdl->error) { |
a7bd7756 | 1191 | rc = hdl->error; |
d3dd59c2 | 1192 | v4l2_ctrl_handler_free(hdl); |
7c13a4d6 | 1193 | kfree(ctx); |
a7bd7756 | 1194 | goto open_unlock; |
d3dd59c2 HV |
1195 | } |
1196 | ctx->fh.ctrl_handler = hdl; | |
1197 | v4l2_ctrl_handler_setup(hdl); | |
96d8eab5 | 1198 | |
9f4161a6 | 1199 | ctx->q_data[V4L2_M2M_SRC].fmt = &formats[0]; |
47556ffa HV |
1200 | ctx->q_data[V4L2_M2M_SRC].width = 640; |
1201 | ctx->q_data[V4L2_M2M_SRC].height = 480; | |
1202 | ctx->q_data[V4L2_M2M_SRC].sizeimage = | |
1203 | ctx->q_data[V4L2_M2M_SRC].width * | |
1204 | ctx->q_data[V4L2_M2M_SRC].height * | |
1205 | (ctx->q_data[V4L2_M2M_SRC].fmt->depth >> 3); | |
1206 | ctx->q_data[V4L2_M2M_DST] = ctx->q_data[V4L2_M2M_SRC]; | |
1207 | ctx->colorspace = V4L2_COLORSPACE_REC709; | |
9f4161a6 | 1208 | |
20702ebc | 1209 | ctx->fh.m2m_ctx = v4l2_m2m_ctx_init(dev->m2m_dev, ctx, &queue_init); |
d80ee38c | 1210 | |
b3e64e5b | 1211 | mutex_init(&ctx->vb_mutex); |
b3e64e5b MCC |
1212 | INIT_DELAYED_WORK(&ctx->work_run, device_work); |
1213 | ||
20702ebc SN |
1214 | if (IS_ERR(ctx->fh.m2m_ctx)) { |
1215 | rc = PTR_ERR(ctx->fh.m2m_ctx); | |
16ee9bb1 | 1216 | |
d3dd59c2 | 1217 | v4l2_ctrl_handler_free(hdl); |
7c13a4d6 | 1218 | v4l2_fh_exit(&ctx->fh); |
96d8eab5 | 1219 | kfree(ctx); |
f4694039 | 1220 | goto open_unlock; |
96d8eab5 PO |
1221 | } |
1222 | ||
d3dd59c2 | 1223 | v4l2_fh_add(&ctx->fh); |
96d8eab5 PO |
1224 | atomic_inc(&dev->num_inst); |
1225 | ||
de5c46ad | 1226 | dprintk(dev, 1, "Created instance: %p, m2m_ctx: %p\n", |
20702ebc | 1227 | ctx, ctx->fh.m2m_ctx); |
96d8eab5 | 1228 | |
f4694039 HV |
1229 | open_unlock: |
1230 | mutex_unlock(&dev->dev_mutex); | |
a7bd7756 | 1231 | return rc; |
96d8eab5 PO |
1232 | } |
1233 | ||
1f923a42 | 1234 | static int vim2m_release(struct file *file) |
96d8eab5 | 1235 | { |
1f923a42 HV |
1236 | struct vim2m_dev *dev = video_drvdata(file); |
1237 | struct vim2m_ctx *ctx = file2ctx(file); | |
96d8eab5 | 1238 | |
de5c46ad | 1239 | dprintk(dev, 1, "Releasing instance %p\n", ctx); |
96d8eab5 | 1240 | |
d3dd59c2 HV |
1241 | v4l2_fh_del(&ctx->fh); |
1242 | v4l2_fh_exit(&ctx->fh); | |
1243 | v4l2_ctrl_handler_free(&ctx->hdl); | |
f4694039 | 1244 | mutex_lock(&dev->dev_mutex); |
20702ebc | 1245 | v4l2_m2m_ctx_release(ctx->fh.m2m_ctx); |
f4694039 | 1246 | mutex_unlock(&dev->dev_mutex); |
96d8eab5 PO |
1247 | kfree(ctx); |
1248 | ||
1249 | atomic_dec(&dev->num_inst); | |
1250 | ||
1251 | return 0; | |
1252 | } | |
1253 | ||
ea6c7e34 HV |
1254 | static void vim2m_device_release(struct video_device *vdev) |
1255 | { | |
1256 | struct vim2m_dev *dev = container_of(vdev, struct vim2m_dev, vfd); | |
1257 | ||
1258 | v4l2_device_unregister(&dev->v4l2_dev); | |
1259 | v4l2_m2m_release(dev->m2m_dev); | |
9f22e88a HV |
1260 | #ifdef CONFIG_MEDIA_CONTROLLER |
1261 | media_device_cleanup(&dev->mdev); | |
1262 | #endif | |
ea6c7e34 HV |
1263 | kfree(dev); |
1264 | } | |
1265 | ||
1f923a42 | 1266 | static const struct v4l2_file_operations vim2m_fops = { |
96d8eab5 | 1267 | .owner = THIS_MODULE, |
1f923a42 HV |
1268 | .open = vim2m_open, |
1269 | .release = vim2m_release, | |
20702ebc | 1270 | .poll = v4l2_m2m_fop_poll, |
07e80305 | 1271 | .unlocked_ioctl = video_ioctl2, |
20702ebc | 1272 | .mmap = v4l2_m2m_fop_mmap, |
96d8eab5 PO |
1273 | }; |
1274 | ||
5303135c | 1275 | static const struct video_device vim2m_videodev = { |
96d8eab5 | 1276 | .name = MEM2MEM_NAME, |
954f340f | 1277 | .vfl_dir = VFL_DIR_M2M, |
1f923a42 HV |
1278 | .fops = &vim2m_fops, |
1279 | .ioctl_ops = &vim2m_ioctl_ops, | |
96d8eab5 | 1280 | .minor = -1, |
ea6c7e34 | 1281 | .release = vim2m_device_release, |
47fc65fa | 1282 | .device_caps = V4L2_CAP_VIDEO_M2M | V4L2_CAP_STREAMING, |
96d8eab5 PO |
1283 | }; |
1284 | ||
86ab0b1c | 1285 | static const struct v4l2_m2m_ops m2m_ops = { |
96d8eab5 PO |
1286 | .device_run = device_run, |
1287 | .job_ready = job_ready, | |
1288 | .job_abort = job_abort, | |
1289 | }; | |
1290 | ||
86b93b2c HV |
1291 | static const struct media_device_ops m2m_media_ops = { |
1292 | .req_validate = vb2_request_validate, | |
ef86eaf9 | 1293 | .req_queue = v4l2_m2m_request_queue, |
86b93b2c HV |
1294 | }; |
1295 | ||
1f923a42 | 1296 | static int vim2m_probe(struct platform_device *pdev) |
96d8eab5 | 1297 | { |
1f923a42 | 1298 | struct vim2m_dev *dev; |
96d8eab5 PO |
1299 | struct video_device *vfd; |
1300 | int ret; | |
1301 | ||
ea6c7e34 | 1302 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
96d8eab5 PO |
1303 | if (!dev) |
1304 | return -ENOMEM; | |
1305 | ||
96d8eab5 PO |
1306 | ret = v4l2_device_register(&pdev->dev, &dev->v4l2_dev); |
1307 | if (ret) | |
ea6c7e34 | 1308 | goto error_free; |
96d8eab5 PO |
1309 | |
1310 | atomic_set(&dev->num_inst, 0); | |
1311 | mutex_init(&dev->dev_mutex); | |
1312 | ||
09365420 HV |
1313 | dev->vfd = vim2m_videodev; |
1314 | vfd = &dev->vfd; | |
07e80305 | 1315 | vfd->lock = &dev->dev_mutex; |
8f484d87 | 1316 | vfd->v4l2_dev = &dev->v4l2_dev; |
96d8eab5 | 1317 | |
96d8eab5 | 1318 | video_set_drvdata(vfd, dev); |
8f484d87 | 1319 | v4l2_info(&dev->v4l2_dev, |
c310d1f9 | 1320 | "Device registered as /dev/video%d\n", vfd->num); |
96d8eab5 | 1321 | |
96d8eab5 PO |
1322 | platform_set_drvdata(pdev, dev); |
1323 | ||
1324 | dev->m2m_dev = v4l2_m2m_init(&m2m_ops); | |
1325 | if (IS_ERR(dev->m2m_dev)) { | |
1326 | v4l2_err(&dev->v4l2_dev, "Failed to init mem2mem device\n"); | |
1327 | ret = PTR_ERR(dev->m2m_dev); | |
2455d417 | 1328 | dev->m2m_dev = NULL; |
ea6c7e34 | 1329 | goto error_dev; |
e35f7021 HV |
1330 | } |
1331 | ||
1332 | #ifdef CONFIG_MEDIA_CONTROLLER | |
1333 | dev->mdev.dev = &pdev->dev; | |
c0decac1 | 1334 | strscpy(dev->mdev.model, "vim2m", sizeof(dev->mdev.model)); |
281ae39b HV |
1335 | strscpy(dev->mdev.bus_info, "platform:vim2m", |
1336 | sizeof(dev->mdev.bus_info)); | |
e35f7021 | 1337 | media_device_init(&dev->mdev); |
86b93b2c | 1338 | dev->mdev.ops = &m2m_media_ops; |
e35f7021 | 1339 | dev->v4l2_dev.mdev = &dev->mdev; |
1a28dce2 | 1340 | #endif |
e35f7021 | 1341 | |
1a28dce2 HV |
1342 | ret = video_register_device(vfd, VFL_TYPE_VIDEO, 0); |
1343 | if (ret) { | |
1344 | v4l2_err(&dev->v4l2_dev, "Failed to register video device\n"); | |
1345 | goto error_m2m; | |
1346 | } | |
1347 | ||
1348 | #ifdef CONFIG_MEDIA_CONTROLLER | |
c310d1f9 MCC |
1349 | ret = v4l2_m2m_register_media_controller(dev->m2m_dev, vfd, |
1350 | MEDIA_ENT_F_PROC_VIDEO_SCALER); | |
e35f7021 HV |
1351 | if (ret) { |
1352 | v4l2_err(&dev->v4l2_dev, "Failed to init mem2mem media controller\n"); | |
cf7f3477 | 1353 | goto error_v4l2; |
96d8eab5 PO |
1354 | } |
1355 | ||
e35f7021 HV |
1356 | ret = media_device_register(&dev->mdev); |
1357 | if (ret) { | |
1358 | v4l2_err(&dev->v4l2_dev, "Failed to register mem2mem media device\n"); | |
ea6c7e34 | 1359 | goto error_m2m_mc; |
e35f7021 HV |
1360 | } |
1361 | #endif | |
96d8eab5 PO |
1362 | return 0; |
1363 | ||
e35f7021 | 1364 | #ifdef CONFIG_MEDIA_CONTROLLER |
ea6c7e34 | 1365 | error_m2m_mc: |
e35f7021 | 1366 | v4l2_m2m_unregister_media_controller(dev->m2m_dev); |
e35f7021 | 1367 | #endif |
cf7f3477 | 1368 | error_v4l2: |
e35f7021 | 1369 | video_unregister_device(&dev->vfd); |
20059cbb KW |
1370 | /* vim2m_device_release called by video_unregister_device to release various objects */ |
1371 | return ret; | |
cf7f3477 SA |
1372 | error_m2m: |
1373 | v4l2_m2m_release(dev->m2m_dev); | |
1374 | error_dev: | |
96d8eab5 | 1375 | v4l2_device_unregister(&dev->v4l2_dev); |
ea6c7e34 HV |
1376 | error_free: |
1377 | kfree(dev); | |
96d8eab5 PO |
1378 | |
1379 | return ret; | |
1380 | } | |
1381 | ||
1f923a42 | 1382 | static int vim2m_remove(struct platform_device *pdev) |
96d8eab5 | 1383 | { |
1f923a42 | 1384 | struct vim2m_dev *dev = platform_get_drvdata(pdev); |
96d8eab5 | 1385 | |
1f923a42 | 1386 | v4l2_info(&dev->v4l2_dev, "Removing " MEM2MEM_NAME); |
e35f7021 HV |
1387 | |
1388 | #ifdef CONFIG_MEDIA_CONTROLLER | |
1389 | media_device_unregister(&dev->mdev); | |
1390 | v4l2_m2m_unregister_media_controller(dev->m2m_dev); | |
e35f7021 | 1391 | #endif |
09365420 | 1392 | video_unregister_device(&dev->vfd); |
96d8eab5 PO |
1393 | |
1394 | return 0; | |
1395 | } | |
1396 | ||
1f923a42 HV |
1397 | static struct platform_driver vim2m_pdrv = { |
1398 | .probe = vim2m_probe, | |
1399 | .remove = vim2m_remove, | |
96d8eab5 PO |
1400 | .driver = { |
1401 | .name = MEM2MEM_NAME, | |
96d8eab5 PO |
1402 | }, |
1403 | }; | |
1404 | ||
1f923a42 | 1405 | static void __exit vim2m_exit(void) |
96d8eab5 | 1406 | { |
1f923a42 HV |
1407 | platform_driver_unregister(&vim2m_pdrv); |
1408 | platform_device_unregister(&vim2m_pdev); | |
96d8eab5 PO |
1409 | } |
1410 | ||
1f923a42 | 1411 | static int __init vim2m_init(void) |
96d8eab5 PO |
1412 | { |
1413 | int ret; | |
1414 | ||
1f923a42 | 1415 | ret = platform_device_register(&vim2m_pdev); |
96d8eab5 PO |
1416 | if (ret) |
1417 | return ret; | |
1418 | ||
1f923a42 | 1419 | ret = platform_driver_register(&vim2m_pdrv); |
96d8eab5 | 1420 | if (ret) |
1f923a42 | 1421 | platform_device_unregister(&vim2m_pdev); |
96d8eab5 | 1422 | |
b20b51f0 | 1423 | return ret; |
96d8eab5 PO |
1424 | } |
1425 | ||
1f923a42 HV |
1426 | module_init(vim2m_init); |
1427 | module_exit(vim2m_exit); |