1 // SPDX-License-Identifier: GPL-2.0
3 * sh-mobile VEU mem2mem driver
5 * Copyright (C) 2012 Renesas Electronics Corporation
6 * Author: Guennadi Liakhovetski, <g.liakhovetski@gmx.de>
7 * Copyright (C) 2008 Magnus Damm
10 #include <linux/err.h>
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/interrupt.h>
16 #include <linux/platform_device.h>
17 #include <linux/pm_runtime.h>
18 #include <linux/slab.h>
19 #include <linux/types.h>
20 #include <linux/videodev2.h>
22 #include <media/v4l2-dev.h>
23 #include <media/v4l2-device.h>
24 #include <media/v4l2-ioctl.h>
25 #include <media/v4l2-mem2mem.h>
26 #include <media/v4l2-image-sizes.h>
27 #include <media/videobuf2-dma-contig.h>
29 #define VEU_STR 0x00 /* start register */
30 #define VEU_SWR 0x10 /* src: line length */
31 #define VEU_SSR 0x14 /* src: image size */
32 #define VEU_SAYR 0x18 /* src: y/rgb plane address */
33 #define VEU_SACR 0x1c /* src: c plane address */
34 #define VEU_BSSR 0x20 /* bundle mode register */
35 #define VEU_EDWR 0x30 /* dst: line length */
36 #define VEU_DAYR 0x34 /* dst: y/rgb plane address */
37 #define VEU_DACR 0x38 /* dst: c plane address */
38 #define VEU_TRCR 0x50 /* transform control */
39 #define VEU_RFCR 0x54 /* resize scale */
40 #define VEU_RFSR 0x58 /* resize clip */
41 #define VEU_ENHR 0x5c /* enhance */
42 #define VEU_FMCR 0x70 /* filter mode */
43 #define VEU_VTCR 0x74 /* lowpass vertical */
44 #define VEU_HTCR 0x78 /* lowpass horizontal */
45 #define VEU_APCR 0x80 /* color match */
46 #define VEU_ECCR 0x84 /* color replace */
47 #define VEU_AFXR 0x90 /* fixed mode */
48 #define VEU_SWPR 0x94 /* swap */
49 #define VEU_EIER 0xa0 /* interrupt mask */
50 #define VEU_EVTR 0xa4 /* interrupt event */
51 #define VEU_STAR 0xb0 /* status */
52 #define VEU_BSRR 0xb4 /* reset */
54 #define VEU_MCR00 0x200 /* color conversion matrix coefficient 00 */
55 #define VEU_MCR01 0x204 /* color conversion matrix coefficient 01 */
56 #define VEU_MCR02 0x208 /* color conversion matrix coefficient 02 */
57 #define VEU_MCR10 0x20c /* color conversion matrix coefficient 10 */
58 #define VEU_MCR11 0x210 /* color conversion matrix coefficient 11 */
59 #define VEU_MCR12 0x214 /* color conversion matrix coefficient 12 */
60 #define VEU_MCR20 0x218 /* color conversion matrix coefficient 20 */
61 #define VEU_MCR21 0x21c /* color conversion matrix coefficient 21 */
62 #define VEU_MCR22 0x220 /* color conversion matrix coefficient 22 */
63 #define VEU_COFFR 0x224 /* color conversion offset */
64 #define VEU_CBR 0x228 /* color conversion clip */
67 * 4092x4092 max size is the normal case. In some cases it can be reduced to
68 * 2048x2048, in other cases it can be 4092x8188 or even 8188x8188.
76 /* 3 buffers of 2048 x 1536 - 3 megapixels @ 16bpp */
77 #define VIDEO_MEM_LIMIT ALIGN(2048 * 1536 * 2 * 3, 1024 * 1024)
79 #define MEM2MEM_DEF_TRANSLEN 1
84 struct sh_veu_dev
*veu_dev
;
88 struct sh_veu_format
{
95 /* video data format */
97 /* Replace with v4l2_rect */
98 struct v4l2_rect frame
;
99 unsigned int bytesperline
;
100 unsigned int offset_y
;
101 unsigned int offset_c
;
102 const struct sh_veu_format
*fmt
;
106 struct v4l2_device v4l2_dev
;
107 struct video_device vdev
;
108 struct v4l2_m2m_dev
*m2m_dev
;
110 struct v4l2_m2m_ctx
*m2m_ctx
;
111 struct sh_veu_vfmt vfmt_out
;
112 struct sh_veu_vfmt vfmt_in
;
113 /* Only single user per direction so far */
114 struct sh_veu_file
*capture
;
115 struct sh_veu_file
*output
;
116 struct mutex fop_lock
;
120 unsigned int xaction
;
124 enum sh_veu_fmt_idx
{
135 #define DEFAULT_IN_WIDTH VGA_WIDTH
136 #define DEFAULT_IN_HEIGHT VGA_HEIGHT
137 #define DEFAULT_IN_FMTIDX SH_VEU_FMT_NV12
138 #define DEFAULT_OUT_WIDTH VGA_WIDTH
139 #define DEFAULT_OUT_HEIGHT VGA_HEIGHT
140 #define DEFAULT_OUT_FMTIDX SH_VEU_FMT_RGB565
143 * Alignment: Y-plane should be 4-byte aligned for NV12 and NV16, and 8-byte
146 static const struct sh_veu_format sh_veu_fmt
[] = {
147 [SH_VEU_FMT_NV12
] = { .ydepth
= 8, .depth
= 12, .name
= "NV12", .fourcc
= V4L2_PIX_FMT_NV12
},
148 [SH_VEU_FMT_NV16
] = { .ydepth
= 8, .depth
= 16, .name
= "NV16", .fourcc
= V4L2_PIX_FMT_NV16
},
149 [SH_VEU_FMT_NV24
] = { .ydepth
= 8, .depth
= 24, .name
= "NV24", .fourcc
= V4L2_PIX_FMT_NV24
},
150 [SH_VEU_FMT_RGB332
] = { .ydepth
= 8, .depth
= 8, .name
= "RGB332", .fourcc
= V4L2_PIX_FMT_RGB332
},
151 [SH_VEU_FMT_RGB444
] = { .ydepth
= 16, .depth
= 16, .name
= "RGB444", .fourcc
= V4L2_PIX_FMT_RGB444
},
152 [SH_VEU_FMT_RGB565
] = { .ydepth
= 16, .depth
= 16, .name
= "RGB565", .fourcc
= V4L2_PIX_FMT_RGB565
},
153 [SH_VEU_FMT_RGB666
] = { .ydepth
= 32, .depth
= 32, .name
= "BGR666", .fourcc
= V4L2_PIX_FMT_BGR666
},
154 [SH_VEU_FMT_RGB24
] = { .ydepth
= 24, .depth
= 24, .name
= "RGB24", .fourcc
= V4L2_PIX_FMT_RGB24
},
157 #define DEFAULT_IN_VFMT (struct sh_veu_vfmt){ \
159 .width = VGA_WIDTH, \
160 .height = VGA_HEIGHT, \
162 .bytesperline = (VGA_WIDTH * sh_veu_fmt[DEFAULT_IN_FMTIDX].ydepth) >> 3, \
163 .fmt = &sh_veu_fmt[DEFAULT_IN_FMTIDX], \
166 #define DEFAULT_OUT_VFMT (struct sh_veu_vfmt){ \
168 .width = VGA_WIDTH, \
169 .height = VGA_HEIGHT, \
171 .bytesperline = (VGA_WIDTH * sh_veu_fmt[DEFAULT_OUT_FMTIDX].ydepth) >> 3, \
172 .fmt = &sh_veu_fmt[DEFAULT_OUT_FMTIDX], \
176 * TODO: add support for further output formats:
186 static const int sh_veu_fmt_out
[] = {
191 * TODO: add support for further input formats:
198 static const int sh_veu_fmt_in
[] = {
202 static enum v4l2_colorspace
sh_veu_4cc2cspace(u32 fourcc
)
207 case V4L2_PIX_FMT_NV12
:
208 case V4L2_PIX_FMT_NV16
:
209 case V4L2_PIX_FMT_NV24
:
210 return V4L2_COLORSPACE_SMPTE170M
;
211 case V4L2_PIX_FMT_RGB332
:
212 case V4L2_PIX_FMT_RGB444
:
213 case V4L2_PIX_FMT_RGB565
:
214 case V4L2_PIX_FMT_BGR666
:
215 case V4L2_PIX_FMT_RGB24
:
216 return V4L2_COLORSPACE_SRGB
;
220 static u32
sh_veu_reg_read(struct sh_veu_dev
*veu
, unsigned int reg
)
222 return ioread32(veu
->base
+ reg
);
225 static void sh_veu_reg_write(struct sh_veu_dev
*veu
, unsigned int reg
,
228 iowrite32(value
, veu
->base
+ reg
);
231 /* ========== mem2mem callbacks ========== */
233 static void sh_veu_job_abort(void *priv
)
235 struct sh_veu_dev
*veu
= priv
;
237 /* Will cancel the transaction in the next interrupt handler */
238 veu
->aborting
= true;
241 static void sh_veu_process(struct sh_veu_dev
*veu
,
242 struct vb2_buffer
*src_buf
,
243 struct vb2_buffer
*dst_buf
)
245 dma_addr_t addr
= vb2_dma_contig_plane_dma_addr(dst_buf
, 0);
247 sh_veu_reg_write(veu
, VEU_DAYR
, addr
+ veu
->vfmt_out
.offset_y
);
248 sh_veu_reg_write(veu
, VEU_DACR
, veu
->vfmt_out
.offset_c
?
249 addr
+ veu
->vfmt_out
.offset_c
: 0);
250 dev_dbg(veu
->dev
, "%s(): dst base %lx, y: %x, c: %x\n", __func__
,
252 veu
->vfmt_out
.offset_y
, veu
->vfmt_out
.offset_c
);
254 addr
= vb2_dma_contig_plane_dma_addr(src_buf
, 0);
255 sh_veu_reg_write(veu
, VEU_SAYR
, addr
+ veu
->vfmt_in
.offset_y
);
256 sh_veu_reg_write(veu
, VEU_SACR
, veu
->vfmt_in
.offset_c
?
257 addr
+ veu
->vfmt_in
.offset_c
: 0);
258 dev_dbg(veu
->dev
, "%s(): src base %lx, y: %x, c: %x\n", __func__
,
260 veu
->vfmt_in
.offset_y
, veu
->vfmt_in
.offset_c
);
262 sh_veu_reg_write(veu
, VEU_STR
, 1);
264 sh_veu_reg_write(veu
, VEU_EIER
, 1); /* enable interrupt in VEU */
268 * sh_veu_device_run() - prepares and starts the device
270 * This will be called by the framework when it decides to schedule a particular
273 static void sh_veu_device_run(void *priv
)
275 struct sh_veu_dev
*veu
= priv
;
276 struct vb2_buffer
*src_buf
, *dst_buf
;
278 src_buf
= v4l2_m2m_next_src_buf(veu
->m2m_ctx
);
279 dst_buf
= v4l2_m2m_next_dst_buf(veu
->m2m_ctx
);
281 if (src_buf
&& dst_buf
)
282 sh_veu_process(veu
, src_buf
, dst_buf
);
285 /* ========== video ioctls ========== */
287 static bool sh_veu_is_streamer(struct sh_veu_dev
*veu
, struct sh_veu_file
*veu_file
,
288 enum v4l2_buf_type type
)
290 return (type
== V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
291 veu_file
== veu
->capture
) ||
292 (type
== V4L2_BUF_TYPE_VIDEO_OUTPUT
&&
293 veu_file
== veu
->output
);
296 static int sh_veu_queue_init(void *priv
, struct vb2_queue
*src_vq
,
297 struct vb2_queue
*dst_vq
);
300 * It is not unusual to have video nodes open()ed multiple times. While some
301 * V4L2 operations are non-intrusive, like querying formats and various
302 * parameters, others, like setting formats, starting and stopping streaming,
303 * queuing and dequeuing buffers, directly affect hardware configuration and /
304 * or execution. This function verifies availability of the requested interface
305 * and, if available, reserves it for the requesting user.
307 static int sh_veu_stream_init(struct sh_veu_dev
*veu
, struct sh_veu_file
*veu_file
,
308 enum v4l2_buf_type type
)
310 struct sh_veu_file
**stream
;
313 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
314 stream
= &veu
->capture
;
316 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
317 stream
= &veu
->output
;
323 if (*stream
== veu_file
)
334 static int sh_veu_context_init(struct sh_veu_dev
*veu
)
339 veu
->m2m_ctx
= v4l2_m2m_ctx_init(veu
->m2m_dev
, veu
,
342 return PTR_ERR_OR_ZERO(veu
->m2m_ctx
);
345 static int sh_veu_querycap(struct file
*file
, void *priv
,
346 struct v4l2_capability
*cap
)
348 strlcpy(cap
->driver
, "sh-veu", sizeof(cap
->driver
));
349 strlcpy(cap
->card
, "sh-mobile VEU", sizeof(cap
->card
));
350 strlcpy(cap
->bus_info
, "platform:sh-veu", sizeof(cap
->bus_info
));
351 cap
->device_caps
= V4L2_CAP_VIDEO_M2M
| V4L2_CAP_STREAMING
;
352 cap
->capabilities
= cap
->device_caps
| V4L2_CAP_DEVICE_CAPS
;
357 static int sh_veu_enum_fmt(struct v4l2_fmtdesc
*f
, const int *fmt
, int fmt_num
)
359 if (f
->index
>= fmt_num
)
362 strlcpy(f
->description
, sh_veu_fmt
[fmt
[f
->index
]].name
, sizeof(f
->description
));
363 f
->pixelformat
= sh_veu_fmt
[fmt
[f
->index
]].fourcc
;
367 static int sh_veu_enum_fmt_vid_cap(struct file
*file
, void *priv
,
368 struct v4l2_fmtdesc
*f
)
370 return sh_veu_enum_fmt(f
, sh_veu_fmt_out
, ARRAY_SIZE(sh_veu_fmt_out
));
373 static int sh_veu_enum_fmt_vid_out(struct file
*file
, void *priv
,
374 struct v4l2_fmtdesc
*f
)
376 return sh_veu_enum_fmt(f
, sh_veu_fmt_in
, ARRAY_SIZE(sh_veu_fmt_in
));
379 static struct sh_veu_vfmt
*sh_veu_get_vfmt(struct sh_veu_dev
*veu
,
380 enum v4l2_buf_type type
)
383 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
384 return &veu
->vfmt_out
;
385 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
386 return &veu
->vfmt_in
;
392 static int sh_veu_g_fmt(struct sh_veu_file
*veu_file
, struct v4l2_format
*f
)
394 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
395 struct sh_veu_dev
*veu
= veu_file
->veu_dev
;
396 struct sh_veu_vfmt
*vfmt
;
398 vfmt
= sh_veu_get_vfmt(veu
, f
->type
);
400 pix
->width
= vfmt
->frame
.width
;
401 pix
->height
= vfmt
->frame
.height
;
402 pix
->field
= V4L2_FIELD_NONE
;
403 pix
->pixelformat
= vfmt
->fmt
->fourcc
;
404 pix
->colorspace
= sh_veu_4cc2cspace(pix
->pixelformat
);
405 pix
->bytesperline
= vfmt
->bytesperline
;
406 pix
->sizeimage
= vfmt
->bytesperline
* pix
->height
*
407 vfmt
->fmt
->depth
/ vfmt
->fmt
->ydepth
;
408 dev_dbg(veu
->dev
, "%s(): type: %d, size %u @ %ux%u, fmt %x\n", __func__
,
409 f
->type
, pix
->sizeimage
, pix
->width
, pix
->height
, pix
->pixelformat
);
414 static int sh_veu_g_fmt_vid_out(struct file
*file
, void *priv
,
415 struct v4l2_format
*f
)
417 return sh_veu_g_fmt(priv
, f
);
420 static int sh_veu_g_fmt_vid_cap(struct file
*file
, void *priv
,
421 struct v4l2_format
*f
)
423 return sh_veu_g_fmt(priv
, f
);
426 static int sh_veu_try_fmt(struct v4l2_format
*f
, const struct sh_veu_format
*fmt
)
428 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
429 unsigned int y_bytes_used
;
432 * V4L2 specification suggests, that the driver should correct the
433 * format struct if any of the dimensions is unsupported
435 switch (pix
->field
) {
438 pix
->field
= V4L2_FIELD_NONE
;
439 /* fall through: continue handling V4L2_FIELD_NONE */
440 case V4L2_FIELD_NONE
:
444 v4l_bound_align_image(&pix
->width
, MIN_W
, MAX_W
, ALIGN_W
,
445 &pix
->height
, MIN_H
, MAX_H
, 0, 0);
447 y_bytes_used
= (pix
->width
* fmt
->ydepth
) >> 3;
449 if (pix
->bytesperline
< y_bytes_used
)
450 pix
->bytesperline
= y_bytes_used
;
451 pix
->sizeimage
= pix
->height
* pix
->bytesperline
* fmt
->depth
/ fmt
->ydepth
;
453 pix
->pixelformat
= fmt
->fourcc
;
454 pix
->colorspace
= sh_veu_4cc2cspace(pix
->pixelformat
);
456 pr_debug("%s(): type: %d, size %u\n", __func__
, f
->type
, pix
->sizeimage
);
461 static const struct sh_veu_format
*sh_veu_find_fmt(const struct v4l2_format
*f
)
466 pr_debug("%s(%d;%d)\n", __func__
, f
->type
, f
->fmt
.pix
.field
);
469 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
470 fmt
= sh_veu_fmt_out
;
471 n
= ARRAY_SIZE(sh_veu_fmt_out
);
472 dflt
= DEFAULT_OUT_FMTIDX
;
474 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
477 n
= ARRAY_SIZE(sh_veu_fmt_in
);
478 dflt
= DEFAULT_IN_FMTIDX
;
482 for (i
= 0; i
< n
; i
++)
483 if (sh_veu_fmt
[fmt
[i
]].fourcc
== f
->fmt
.pix
.pixelformat
)
484 return &sh_veu_fmt
[fmt
[i
]];
486 return &sh_veu_fmt
[dflt
];
489 static int sh_veu_try_fmt_vid_cap(struct file
*file
, void *priv
,
490 struct v4l2_format
*f
)
492 const struct sh_veu_format
*fmt
;
494 fmt
= sh_veu_find_fmt(f
);
496 /* wrong buffer type */
499 return sh_veu_try_fmt(f
, fmt
);
502 static int sh_veu_try_fmt_vid_out(struct file
*file
, void *priv
,
503 struct v4l2_format
*f
)
505 const struct sh_veu_format
*fmt
;
507 fmt
= sh_veu_find_fmt(f
);
509 /* wrong buffer type */
512 return sh_veu_try_fmt(f
, fmt
);
515 static void sh_veu_colour_offset(struct sh_veu_dev
*veu
, struct sh_veu_vfmt
*vfmt
)
517 /* dst_left and dst_top validity will be verified in CROP / COMPOSE */
518 unsigned int left
= vfmt
->frame
.left
& ~0x03;
519 unsigned int top
= vfmt
->frame
.top
;
520 dma_addr_t offset
= (dma_addr_t
)top
* veu
->vfmt_out
.bytesperline
+
521 (((dma_addr_t
)left
* veu
->vfmt_out
.fmt
->depth
) >> 3);
524 vfmt
->offset_y
= offset
;
526 switch (vfmt
->fmt
->fourcc
) {
527 case V4L2_PIX_FMT_NV12
:
528 case V4L2_PIX_FMT_NV16
:
529 case V4L2_PIX_FMT_NV24
:
530 y_line
= ALIGN(vfmt
->frame
.width
, 16);
531 vfmt
->offset_c
= offset
+ y_line
* vfmt
->frame
.height
;
533 case V4L2_PIX_FMT_RGB332
:
534 case V4L2_PIX_FMT_RGB444
:
535 case V4L2_PIX_FMT_RGB565
:
536 case V4L2_PIX_FMT_BGR666
:
537 case V4L2_PIX_FMT_RGB24
:
545 static int sh_veu_s_fmt(struct sh_veu_file
*veu_file
, struct v4l2_format
*f
)
547 struct v4l2_pix_format
*pix
= &f
->fmt
.pix
;
548 struct sh_veu_dev
*veu
= veu_file
->veu_dev
;
549 struct sh_veu_vfmt
*vfmt
;
550 struct vb2_queue
*vq
;
551 int ret
= sh_veu_context_init(veu
);
555 vq
= v4l2_m2m_get_vq(veu
->m2m_ctx
, f
->type
);
559 if (vb2_is_busy(vq
)) {
560 v4l2_err(&veu_file
->veu_dev
->v4l2_dev
, "%s queue busy\n", __func__
);
564 vfmt
= sh_veu_get_vfmt(veu
, f
->type
);
565 /* called after try_fmt(), hence vfmt != NULL. Implicit BUG_ON() below */
567 vfmt
->fmt
= sh_veu_find_fmt(f
);
568 /* vfmt->fmt != NULL following the same argument as above */
569 vfmt
->frame
.width
= pix
->width
;
570 vfmt
->frame
.height
= pix
->height
;
571 vfmt
->bytesperline
= pix
->bytesperline
;
573 sh_veu_colour_offset(veu
, vfmt
);
576 * We could also verify and require configuration only if any parameters
577 * actually have changed, but it is unlikely, that the user requests the
578 * same configuration several times without closing the device.
580 veu_file
->cfg_needed
= true;
583 "Setting format for type %d, wxh: %dx%d, fmt: %x\n",
584 f
->type
, pix
->width
, pix
->height
, vfmt
->fmt
->fourcc
);
589 static int sh_veu_s_fmt_vid_cap(struct file
*file
, void *priv
,
590 struct v4l2_format
*f
)
592 int ret
= sh_veu_try_fmt_vid_cap(file
, priv
, f
);
596 return sh_veu_s_fmt(priv
, f
);
599 static int sh_veu_s_fmt_vid_out(struct file
*file
, void *priv
,
600 struct v4l2_format
*f
)
602 int ret
= sh_veu_try_fmt_vid_out(file
, priv
, f
);
606 return sh_veu_s_fmt(priv
, f
);
609 static int sh_veu_reqbufs(struct file
*file
, void *priv
,
610 struct v4l2_requestbuffers
*reqbufs
)
612 struct sh_veu_file
*veu_file
= priv
;
613 struct sh_veu_dev
*veu
= veu_file
->veu_dev
;
614 int ret
= sh_veu_context_init(veu
);
618 ret
= sh_veu_stream_init(veu
, veu_file
, reqbufs
->type
);
622 return v4l2_m2m_reqbufs(file
, veu
->m2m_ctx
, reqbufs
);
625 static int sh_veu_querybuf(struct file
*file
, void *priv
,
626 struct v4l2_buffer
*buf
)
628 struct sh_veu_file
*veu_file
= priv
;
630 if (!sh_veu_is_streamer(veu_file
->veu_dev
, veu_file
, buf
->type
))
633 return v4l2_m2m_querybuf(file
, veu_file
->veu_dev
->m2m_ctx
, buf
);
636 static int sh_veu_qbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*buf
)
638 struct sh_veu_file
*veu_file
= priv
;
640 dev_dbg(veu_file
->veu_dev
->dev
, "%s(%d)\n", __func__
, buf
->type
);
641 if (!sh_veu_is_streamer(veu_file
->veu_dev
, veu_file
, buf
->type
))
644 return v4l2_m2m_qbuf(file
, veu_file
->veu_dev
->m2m_ctx
, buf
);
647 static int sh_veu_dqbuf(struct file
*file
, void *priv
, struct v4l2_buffer
*buf
)
649 struct sh_veu_file
*veu_file
= priv
;
651 dev_dbg(veu_file
->veu_dev
->dev
, "%s(%d)\n", __func__
, buf
->type
);
652 if (!sh_veu_is_streamer(veu_file
->veu_dev
, veu_file
, buf
->type
))
655 return v4l2_m2m_dqbuf(file
, veu_file
->veu_dev
->m2m_ctx
, buf
);
658 static void sh_veu_calc_scale(struct sh_veu_dev
*veu
,
659 int size_in
, int size_out
, int crop_out
,
660 u32
*mant
, u32
*frac
, u32
*rep
)
664 /* calculate FRAC and MANT */
665 *rep
= *mant
= *frac
= 0;
667 if (size_in
== size_out
) {
668 if (crop_out
!= size_out
)
669 *mant
= 1; /* needed for cropping */
673 /* VEU2H special upscale */
674 if (veu
->is_2h
&& size_out
> size_in
) {
675 u32 fixpoint
= (4096 * size_in
) / size_out
;
676 *mant
= fixpoint
/ 4096;
677 *frac
= (fixpoint
- (*mant
* 4096)) & ~0x07;
694 fixpoint
= (4096 * (size_in
- 1)) / (size_out
+ 1);
695 *mant
= fixpoint
/ 4096;
696 *frac
= fixpoint
- (*mant
* 4096);
700 * FIXME: do we really have to round down twice in the
704 if (size_out
> size_in
)
705 *frac
-= 8; /* round down if scaling up */
707 *frac
+= 8; /* round up if scaling down */
711 static unsigned long sh_veu_scale_v(struct sh_veu_dev
*veu
,
712 int size_in
, int size_out
, int crop_out
)
714 u32 mant
, frac
, value
, rep
;
716 sh_veu_calc_scale(veu
, size_in
, size_out
, crop_out
, &mant
, &frac
, &rep
);
719 value
= (sh_veu_reg_read(veu
, VEU_RFCR
) & ~0xffff0000) |
720 (((mant
<< 12) | frac
) << 16);
722 sh_veu_reg_write(veu
, VEU_RFCR
, value
);
725 value
= (sh_veu_reg_read(veu
, VEU_RFSR
) & ~0xffff0000) |
726 (((rep
<< 12) | crop_out
) << 16);
728 sh_veu_reg_write(veu
, VEU_RFSR
, value
);
730 return ALIGN((size_in
* crop_out
) / size_out
, 4);
733 static unsigned long sh_veu_scale_h(struct sh_veu_dev
*veu
,
734 int size_in
, int size_out
, int crop_out
)
736 u32 mant
, frac
, value
, rep
;
738 sh_veu_calc_scale(veu
, size_in
, size_out
, crop_out
, &mant
, &frac
, &rep
);
741 value
= (sh_veu_reg_read(veu
, VEU_RFCR
) & ~0xffff) |
744 sh_veu_reg_write(veu
, VEU_RFCR
, value
);
747 value
= (sh_veu_reg_read(veu
, VEU_RFSR
) & ~0xffff) |
748 (rep
<< 12) | crop_out
;
750 sh_veu_reg_write(veu
, VEU_RFSR
, value
);
752 return ALIGN((size_in
* crop_out
) / size_out
, 4);
755 static void sh_veu_configure(struct sh_veu_dev
*veu
)
757 u32 src_width
, src_stride
, src_height
;
758 u32 dst_width
, dst_stride
, dst_height
;
762 sh_veu_reg_write(veu
, VEU_BSRR
, 0x100);
764 src_width
= veu
->vfmt_in
.frame
.width
;
765 src_height
= veu
->vfmt_in
.frame
.height
;
766 src_stride
= ALIGN(veu
->vfmt_in
.frame
.width
, 16);
768 dst_width
= real_w
= veu
->vfmt_out
.frame
.width
;
769 dst_height
= real_h
= veu
->vfmt_out
.frame
.height
;
770 /* Datasheet is unclear - whether it's always number of bytes or not */
771 dst_stride
= veu
->vfmt_out
.bytesperline
;
774 * So far real_w == dst_width && real_h == dst_height, but it wasn't
775 * necessarily the case in the original vidix driver, so, it may change
776 * here in the future too.
778 src_width
= sh_veu_scale_h(veu
, src_width
, real_w
, dst_width
);
779 src_height
= sh_veu_scale_v(veu
, src_height
, real_h
, dst_height
);
781 sh_veu_reg_write(veu
, VEU_SWR
, src_stride
);
782 sh_veu_reg_write(veu
, VEU_SSR
, src_width
| (src_height
<< 16));
783 sh_veu_reg_write(veu
, VEU_BSSR
, 0); /* not using bundle mode */
785 sh_veu_reg_write(veu
, VEU_EDWR
, dst_stride
);
786 sh_veu_reg_write(veu
, VEU_DACR
, 0); /* unused for RGB */
788 sh_veu_reg_write(veu
, VEU_SWPR
, 0x67);
789 sh_veu_reg_write(veu
, VEU_TRCR
, (6 << 16) | (0 << 14) | 2 | 4);
792 sh_veu_reg_write(veu
, VEU_MCR00
, 0x0cc5);
793 sh_veu_reg_write(veu
, VEU_MCR01
, 0x0950);
794 sh_veu_reg_write(veu
, VEU_MCR02
, 0x0000);
796 sh_veu_reg_write(veu
, VEU_MCR10
, 0x397f);
797 sh_veu_reg_write(veu
, VEU_MCR11
, 0x0950);
798 sh_veu_reg_write(veu
, VEU_MCR12
, 0x3ccd);
800 sh_veu_reg_write(veu
, VEU_MCR20
, 0x0000);
801 sh_veu_reg_write(veu
, VEU_MCR21
, 0x0950);
802 sh_veu_reg_write(veu
, VEU_MCR22
, 0x1023);
804 sh_veu_reg_write(veu
, VEU_COFFR
, 0x00800010);
808 static int sh_veu_streamon(struct file
*file
, void *priv
,
809 enum v4l2_buf_type type
)
811 struct sh_veu_file
*veu_file
= priv
;
813 if (!sh_veu_is_streamer(veu_file
->veu_dev
, veu_file
, type
))
816 if (veu_file
->cfg_needed
) {
817 struct sh_veu_dev
*veu
= veu_file
->veu_dev
;
818 veu_file
->cfg_needed
= false;
819 sh_veu_configure(veu_file
->veu_dev
);
821 veu
->aborting
= false;
824 return v4l2_m2m_streamon(file
, veu_file
->veu_dev
->m2m_ctx
, type
);
827 static int sh_veu_streamoff(struct file
*file
, void *priv
,
828 enum v4l2_buf_type type
)
830 struct sh_veu_file
*veu_file
= priv
;
832 if (!sh_veu_is_streamer(veu_file
->veu_dev
, veu_file
, type
))
835 return v4l2_m2m_streamoff(file
, veu_file
->veu_dev
->m2m_ctx
, type
);
838 static const struct v4l2_ioctl_ops sh_veu_ioctl_ops
= {
839 .vidioc_querycap
= sh_veu_querycap
,
841 .vidioc_enum_fmt_vid_cap
= sh_veu_enum_fmt_vid_cap
,
842 .vidioc_g_fmt_vid_cap
= sh_veu_g_fmt_vid_cap
,
843 .vidioc_try_fmt_vid_cap
= sh_veu_try_fmt_vid_cap
,
844 .vidioc_s_fmt_vid_cap
= sh_veu_s_fmt_vid_cap
,
846 .vidioc_enum_fmt_vid_out
= sh_veu_enum_fmt_vid_out
,
847 .vidioc_g_fmt_vid_out
= sh_veu_g_fmt_vid_out
,
848 .vidioc_try_fmt_vid_out
= sh_veu_try_fmt_vid_out
,
849 .vidioc_s_fmt_vid_out
= sh_veu_s_fmt_vid_out
,
851 .vidioc_reqbufs
= sh_veu_reqbufs
,
852 .vidioc_querybuf
= sh_veu_querybuf
,
854 .vidioc_qbuf
= sh_veu_qbuf
,
855 .vidioc_dqbuf
= sh_veu_dqbuf
,
857 .vidioc_streamon
= sh_veu_streamon
,
858 .vidioc_streamoff
= sh_veu_streamoff
,
861 /* ========== Queue operations ========== */
863 static int sh_veu_queue_setup(struct vb2_queue
*vq
,
864 unsigned int *nbuffers
, unsigned int *nplanes
,
865 unsigned int sizes
[], struct device
*alloc_devs
[])
867 struct sh_veu_dev
*veu
= vb2_get_drv_priv(vq
);
868 struct sh_veu_vfmt
*vfmt
= sh_veu_get_vfmt(veu
, vq
->type
);
869 unsigned int count
= *nbuffers
;
870 unsigned int size
= vfmt
->bytesperline
* vfmt
->frame
.height
*
871 vfmt
->fmt
->depth
/ vfmt
->fmt
->ydepth
;
874 *nbuffers
= count
= 2;
876 if (size
* count
> VIDEO_MEM_LIMIT
) {
877 count
= VIDEO_MEM_LIMIT
/ size
;
882 return sizes
[0] < size
? -EINVAL
: 0;
887 dev_dbg(veu
->dev
, "get %d buffer(s) of size %d each.\n", count
, size
);
892 static int sh_veu_buf_prepare(struct vb2_buffer
*vb
)
894 struct sh_veu_dev
*veu
= vb2_get_drv_priv(vb
->vb2_queue
);
895 struct sh_veu_vfmt
*vfmt
;
896 unsigned int sizeimage
;
898 vfmt
= sh_veu_get_vfmt(veu
, vb
->vb2_queue
->type
);
899 sizeimage
= vfmt
->bytesperline
* vfmt
->frame
.height
*
900 vfmt
->fmt
->depth
/ vfmt
->fmt
->ydepth
;
902 if (vb2_plane_size(vb
, 0) < sizeimage
) {
903 dev_dbg(veu
->dev
, "%s data will not fit into plane (%lu < %u)\n",
904 __func__
, vb2_plane_size(vb
, 0), sizeimage
);
908 vb2_set_plane_payload(vb
, 0, sizeimage
);
913 static void sh_veu_buf_queue(struct vb2_buffer
*vb
)
915 struct vb2_v4l2_buffer
*vbuf
= to_vb2_v4l2_buffer(vb
);
916 struct sh_veu_dev
*veu
= vb2_get_drv_priv(vb
->vb2_queue
);
917 dev_dbg(veu
->dev
, "%s(%d)\n", __func__
, vb
->type
);
918 v4l2_m2m_buf_queue(veu
->m2m_ctx
, vbuf
);
921 static const struct vb2_ops sh_veu_qops
= {
922 .queue_setup
= sh_veu_queue_setup
,
923 .buf_prepare
= sh_veu_buf_prepare
,
924 .buf_queue
= sh_veu_buf_queue
,
925 .wait_prepare
= vb2_ops_wait_prepare
,
926 .wait_finish
= vb2_ops_wait_finish
,
929 static int sh_veu_queue_init(void *priv
, struct vb2_queue
*src_vq
,
930 struct vb2_queue
*dst_vq
)
932 struct sh_veu_dev
*veu
= priv
;
935 memset(src_vq
, 0, sizeof(*src_vq
));
936 src_vq
->type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
937 src_vq
->io_modes
= VB2_MMAP
| VB2_USERPTR
;
938 src_vq
->drv_priv
= veu
;
939 src_vq
->buf_struct_size
= sizeof(struct v4l2_m2m_buffer
);
940 src_vq
->ops
= &sh_veu_qops
;
941 src_vq
->mem_ops
= &vb2_dma_contig_memops
;
942 src_vq
->lock
= &veu
->fop_lock
;
943 src_vq
->timestamp_flags
= V4L2_BUF_FLAG_TIMESTAMP_COPY
;
944 src_vq
->dev
= veu
->v4l2_dev
.dev
;
946 ret
= vb2_queue_init(src_vq
);
950 memset(dst_vq
, 0, sizeof(*dst_vq
));
951 dst_vq
->type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
952 dst_vq
->io_modes
= VB2_MMAP
| VB2_USERPTR
;
953 dst_vq
->drv_priv
= veu
;
954 dst_vq
->buf_struct_size
= sizeof(struct v4l2_m2m_buffer
);
955 dst_vq
->ops
= &sh_veu_qops
;
956 dst_vq
->mem_ops
= &vb2_dma_contig_memops
;
957 dst_vq
->lock
= &veu
->fop_lock
;
958 dst_vq
->timestamp_flags
= V4L2_BUF_FLAG_TIMESTAMP_COPY
;
959 dst_vq
->dev
= veu
->v4l2_dev
.dev
;
961 return vb2_queue_init(dst_vq
);
964 /* ========== File operations ========== */
966 static int sh_veu_open(struct file
*file
)
968 struct sh_veu_dev
*veu
= video_drvdata(file
);
969 struct sh_veu_file
*veu_file
;
971 veu_file
= kzalloc(sizeof(*veu_file
), GFP_KERNEL
);
975 veu_file
->veu_dev
= veu
;
976 veu_file
->cfg_needed
= true;
978 file
->private_data
= veu_file
;
980 pm_runtime_get_sync(veu
->dev
);
982 dev_dbg(veu
->dev
, "Created instance %p\n", veu_file
);
987 static int sh_veu_release(struct file
*file
)
989 struct sh_veu_dev
*veu
= video_drvdata(file
);
990 struct sh_veu_file
*veu_file
= file
->private_data
;
992 dev_dbg(veu
->dev
, "Releasing instance %p\n", veu_file
);
994 if (veu_file
== veu
->capture
) {
996 vb2_queue_release(v4l2_m2m_get_vq(veu
->m2m_ctx
, V4L2_BUF_TYPE_VIDEO_CAPTURE
));
999 if (veu_file
== veu
->output
) {
1001 vb2_queue_release(v4l2_m2m_get_vq(veu
->m2m_ctx
, V4L2_BUF_TYPE_VIDEO_OUTPUT
));
1004 if (!veu
->output
&& !veu
->capture
&& veu
->m2m_ctx
) {
1005 v4l2_m2m_ctx_release(veu
->m2m_ctx
);
1006 veu
->m2m_ctx
= NULL
;
1009 pm_runtime_put(veu
->dev
);
1016 static __poll_t
sh_veu_poll(struct file
*file
,
1017 struct poll_table_struct
*wait
)
1019 struct sh_veu_file
*veu_file
= file
->private_data
;
1021 return v4l2_m2m_poll(file
, veu_file
->veu_dev
->m2m_ctx
, wait
);
1024 static int sh_veu_mmap(struct file
*file
, struct vm_area_struct
*vma
)
1026 struct sh_veu_file
*veu_file
= file
->private_data
;
1028 return v4l2_m2m_mmap(file
, veu_file
->veu_dev
->m2m_ctx
, vma
);
1031 static const struct v4l2_file_operations sh_veu_fops
= {
1032 .owner
= THIS_MODULE
,
1033 .open
= sh_veu_open
,
1034 .release
= sh_veu_release
,
1035 .poll
= sh_veu_poll
,
1036 .unlocked_ioctl
= video_ioctl2
,
1037 .mmap
= sh_veu_mmap
,
1040 static const struct video_device sh_veu_videodev
= {
1042 .fops
= &sh_veu_fops
,
1043 .ioctl_ops
= &sh_veu_ioctl_ops
,
1045 .release
= video_device_release_empty
,
1046 .vfl_dir
= VFL_DIR_M2M
,
1049 static const struct v4l2_m2m_ops sh_veu_m2m_ops
= {
1050 .device_run
= sh_veu_device_run
,
1051 .job_abort
= sh_veu_job_abort
,
1054 static irqreturn_t
sh_veu_bh(int irq
, void *dev_id
)
1056 struct sh_veu_dev
*veu
= dev_id
;
1058 if (veu
->xaction
== MEM2MEM_DEF_TRANSLEN
|| veu
->aborting
) {
1059 v4l2_m2m_job_finish(veu
->m2m_dev
, veu
->m2m_ctx
);
1062 sh_veu_device_run(veu
);
1068 static irqreturn_t
sh_veu_isr(int irq
, void *dev_id
)
1070 struct sh_veu_dev
*veu
= dev_id
;
1071 struct vb2_v4l2_buffer
*dst
;
1072 struct vb2_v4l2_buffer
*src
;
1073 u32 status
= sh_veu_reg_read(veu
, VEU_EVTR
);
1075 /* bundle read mode not used */
1079 /* disable interrupt in VEU */
1080 sh_veu_reg_write(veu
, VEU_EIER
, 0);
1081 /* halt operation */
1082 sh_veu_reg_write(veu
, VEU_STR
, 0);
1083 /* ack int, write 0 to clear bits */
1084 sh_veu_reg_write(veu
, VEU_EVTR
, status
& ~1);
1086 /* conversion completed */
1087 dst
= v4l2_m2m_dst_buf_remove(veu
->m2m_ctx
);
1088 src
= v4l2_m2m_src_buf_remove(veu
->m2m_ctx
);
1092 dst
->vb2_buf
.timestamp
= src
->vb2_buf
.timestamp
;
1093 dst
->flags
&= ~V4L2_BUF_FLAG_TSTAMP_SRC_MASK
;
1095 src
->flags
& V4L2_BUF_FLAG_TSTAMP_SRC_MASK
;
1096 dst
->timecode
= src
->timecode
;
1098 spin_lock(&veu
->lock
);
1099 v4l2_m2m_buf_done(src
, VB2_BUF_STATE_DONE
);
1100 v4l2_m2m_buf_done(dst
, VB2_BUF_STATE_DONE
);
1101 spin_unlock(&veu
->lock
);
1105 return IRQ_WAKE_THREAD
;
1108 static int sh_veu_probe(struct platform_device
*pdev
)
1110 struct sh_veu_dev
*veu
;
1111 struct resource
*reg_res
;
1112 struct video_device
*vdev
;
1115 reg_res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1116 irq
= platform_get_irq(pdev
, 0);
1118 if (!reg_res
|| irq
<= 0) {
1119 dev_err(&pdev
->dev
, "Insufficient VEU platform information.\n");
1123 veu
= devm_kzalloc(&pdev
->dev
, sizeof(*veu
), GFP_KERNEL
);
1127 veu
->is_2h
= resource_size(reg_res
) == 0x22c;
1129 veu
->base
= devm_ioremap_resource(&pdev
->dev
, reg_res
);
1130 if (IS_ERR(veu
->base
))
1131 return PTR_ERR(veu
->base
);
1133 ret
= devm_request_threaded_irq(&pdev
->dev
, irq
, sh_veu_isr
, sh_veu_bh
,
1138 ret
= v4l2_device_register(&pdev
->dev
, &veu
->v4l2_dev
);
1140 dev_err(&pdev
->dev
, "Error registering v4l2 device\n");
1146 *vdev
= sh_veu_videodev
;
1147 vdev
->v4l2_dev
= &veu
->v4l2_dev
;
1148 spin_lock_init(&veu
->lock
);
1149 mutex_init(&veu
->fop_lock
);
1150 vdev
->lock
= &veu
->fop_lock
;
1152 video_set_drvdata(vdev
, veu
);
1154 veu
->dev
= &pdev
->dev
;
1155 veu
->vfmt_out
= DEFAULT_OUT_VFMT
;
1156 veu
->vfmt_in
= DEFAULT_IN_VFMT
;
1158 veu
->m2m_dev
= v4l2_m2m_init(&sh_veu_m2m_ops
);
1159 if (IS_ERR(veu
->m2m_dev
)) {
1160 ret
= PTR_ERR(veu
->m2m_dev
);
1161 v4l2_err(&veu
->v4l2_dev
, "Failed to init mem2mem device: %d\n", ret
);
1165 pm_runtime_enable(&pdev
->dev
);
1166 pm_runtime_resume(&pdev
->dev
);
1168 ret
= video_register_device(vdev
, VFL_TYPE_GRABBER
, -1);
1169 pm_runtime_suspend(&pdev
->dev
);
1176 pm_runtime_disable(&pdev
->dev
);
1177 v4l2_m2m_release(veu
->m2m_dev
);
1179 v4l2_device_unregister(&veu
->v4l2_dev
);
1183 static int sh_veu_remove(struct platform_device
*pdev
)
1185 struct v4l2_device
*v4l2_dev
= platform_get_drvdata(pdev
);
1186 struct sh_veu_dev
*veu
= container_of(v4l2_dev
,
1187 struct sh_veu_dev
, v4l2_dev
);
1189 video_unregister_device(&veu
->vdev
);
1190 pm_runtime_disable(&pdev
->dev
);
1191 v4l2_m2m_release(veu
->m2m_dev
);
1192 v4l2_device_unregister(&veu
->v4l2_dev
);
1197 static struct platform_driver __refdata sh_veu_pdrv
= {
1198 .remove
= sh_veu_remove
,
1204 module_platform_driver_probe(sh_veu_pdrv
, sh_veu_probe
);
1206 MODULE_DESCRIPTION("sh-mobile VEU mem2mem driver");
1207 MODULE_AUTHOR("Guennadi Liakhovetski, <g.liakhovetski@gmx.de>");
1208 MODULE_LICENSE("GPL v2");