1c1f3caffSMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0-or-later
2c1f3caffSMauro Carvalho Chehab /*
3c1f3caffSMauro Carvalho Chehab * Copyright (C) 2020 BayLibre, SAS
4c1f3caffSMauro Carvalho Chehab * Author: Neil Armstrong <narmstrong@baylibre.com>
5c1f3caffSMauro Carvalho Chehab */
6c1f3caffSMauro Carvalho Chehab
7c1f3caffSMauro Carvalho Chehab #include <linux/clk.h>
8c1f3caffSMauro Carvalho Chehab #include <linux/delay.h>
9c1f3caffSMauro Carvalho Chehab #include <linux/bitfield.h>
10c1f3caffSMauro Carvalho Chehab #include <linux/interrupt.h>
11c1f3caffSMauro Carvalho Chehab #include <linux/module.h>
12c1f3caffSMauro Carvalho Chehab #include <linux/of.h>
13c1f3caffSMauro Carvalho Chehab #include <linux/reset.h>
14c1f3caffSMauro Carvalho Chehab #include <linux/sched.h>
15c1f3caffSMauro Carvalho Chehab #include <linux/slab.h>
16c1f3caffSMauro Carvalho Chehab #include <linux/timer.h>
17c1f3caffSMauro Carvalho Chehab #include <linux/regmap.h>
18c1f3caffSMauro Carvalho Chehab
19c1f3caffSMauro Carvalho Chehab #include <linux/platform_device.h>
20c1f3caffSMauro Carvalho Chehab #include <media/v4l2-device.h>
21c1f3caffSMauro Carvalho Chehab #include <media/v4l2-event.h>
22c1f3caffSMauro Carvalho Chehab #include <media/v4l2-ioctl.h>
23c1f3caffSMauro Carvalho Chehab #include <media/v4l2-mem2mem.h>
24c1f3caffSMauro Carvalho Chehab #include <media/v4l2-ctrls.h>
25c1f3caffSMauro Carvalho Chehab #include <media/videobuf2-v4l2.h>
26c1f3caffSMauro Carvalho Chehab #include <media/videobuf2-dma-contig.h>
27c1f3caffSMauro Carvalho Chehab
28c1f3caffSMauro Carvalho Chehab #include "ge2d-regs.h"
29c1f3caffSMauro Carvalho Chehab
30c1f3caffSMauro Carvalho Chehab #define GE2D_NAME "meson-ge2d"
31c1f3caffSMauro Carvalho Chehab
32c1f3caffSMauro Carvalho Chehab #define DEFAULT_WIDTH 128
33c1f3caffSMauro Carvalho Chehab #define DEFAULT_HEIGHT 128
34c1f3caffSMauro Carvalho Chehab #define DEFAULT_STRIDE 512
35c1f3caffSMauro Carvalho Chehab
36c1f3caffSMauro Carvalho Chehab #define MAX_WIDTH 8191
37c1f3caffSMauro Carvalho Chehab #define MAX_HEIGHT 8191
38c1f3caffSMauro Carvalho Chehab
39c1f3caffSMauro Carvalho Chehab /*
40c1f3caffSMauro Carvalho Chehab * Missing features:
41c1f3caffSMauro Carvalho Chehab * - Scaling
42c1f3caffSMauro Carvalho Chehab * - Simple 1/2 vertical scaling
43c1f3caffSMauro Carvalho Chehab * - YUV input support
44c1f3caffSMauro Carvalho Chehab * - Source global alpha
45c1f3caffSMauro Carvalho Chehab * - Colorspace conversion
46c1f3caffSMauro Carvalho Chehab */
47c1f3caffSMauro Carvalho Chehab
48c1f3caffSMauro Carvalho Chehab struct ge2d_fmt {
49c1f3caffSMauro Carvalho Chehab u32 fourcc;
50c1f3caffSMauro Carvalho Chehab bool alpha;
51c1f3caffSMauro Carvalho Chehab bool le;
52c1f3caffSMauro Carvalho Chehab unsigned int depth;
53c1f3caffSMauro Carvalho Chehab unsigned int hw_fmt;
54c1f3caffSMauro Carvalho Chehab unsigned int hw_map;
55c1f3caffSMauro Carvalho Chehab };
56c1f3caffSMauro Carvalho Chehab
57c1f3caffSMauro Carvalho Chehab struct ge2d_frame {
58c1f3caffSMauro Carvalho Chehab struct vb2_v4l2_buffer *buf;
59c1f3caffSMauro Carvalho Chehab
60c1f3caffSMauro Carvalho Chehab /* Image Format */
61c1f3caffSMauro Carvalho Chehab struct v4l2_pix_format pix_fmt;
62c1f3caffSMauro Carvalho Chehab
63c1f3caffSMauro Carvalho Chehab /* Crop */
64c1f3caffSMauro Carvalho Chehab struct v4l2_rect crop;
65c1f3caffSMauro Carvalho Chehab
66c1f3caffSMauro Carvalho Chehab /* Image format */
67c1f3caffSMauro Carvalho Chehab const struct ge2d_fmt *fmt;
68c1f3caffSMauro Carvalho Chehab };
69c1f3caffSMauro Carvalho Chehab
70c1f3caffSMauro Carvalho Chehab struct ge2d_ctx {
71c1f3caffSMauro Carvalho Chehab struct v4l2_fh fh;
72c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d;
73c1f3caffSMauro Carvalho Chehab struct ge2d_frame in;
74c1f3caffSMauro Carvalho Chehab struct ge2d_frame out;
75c1f3caffSMauro Carvalho Chehab struct v4l2_ctrl_handler ctrl_handler;
76c1f3caffSMauro Carvalho Chehab
77c1f3caffSMauro Carvalho Chehab unsigned long sequence_out, sequence_cap;
78c1f3caffSMauro Carvalho Chehab
79c1f3caffSMauro Carvalho Chehab /* Control values */
80c1f3caffSMauro Carvalho Chehab u32 hflip;
81c1f3caffSMauro Carvalho Chehab u32 vflip;
82c1f3caffSMauro Carvalho Chehab u32 xy_swap;
83c1f3caffSMauro Carvalho Chehab };
84c1f3caffSMauro Carvalho Chehab
85c1f3caffSMauro Carvalho Chehab struct meson_ge2d {
86c1f3caffSMauro Carvalho Chehab struct v4l2_device v4l2_dev;
87c1f3caffSMauro Carvalho Chehab struct v4l2_m2m_dev *m2m_dev;
88c1f3caffSMauro Carvalho Chehab struct video_device *vfd;
89c1f3caffSMauro Carvalho Chehab
90c1f3caffSMauro Carvalho Chehab struct device *dev;
91c1f3caffSMauro Carvalho Chehab struct regmap *map;
92c1f3caffSMauro Carvalho Chehab struct clk *clk;
93c1f3caffSMauro Carvalho Chehab
94c1f3caffSMauro Carvalho Chehab /* vb2 queue lock */
95c1f3caffSMauro Carvalho Chehab struct mutex mutex;
96c1f3caffSMauro Carvalho Chehab
97c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *curr;
98c1f3caffSMauro Carvalho Chehab };
99c1f3caffSMauro Carvalho Chehab
100c1f3caffSMauro Carvalho Chehab #define FMT(_fourcc, _alpha, _depth, _map) \
101c1f3caffSMauro Carvalho Chehab { \
102c1f3caffSMauro Carvalho Chehab .fourcc = _fourcc, \
103c1f3caffSMauro Carvalho Chehab .alpha = (_alpha), \
104c1f3caffSMauro Carvalho Chehab .depth = (_depth), \
105c1f3caffSMauro Carvalho Chehab .hw_fmt = GE2D_FORMAT_ ## _depth ## BIT, \
106c1f3caffSMauro Carvalho Chehab .hw_map = GE2D_COLOR_MAP_ ## _map, \
107c1f3caffSMauro Carvalho Chehab }
108c1f3caffSMauro Carvalho Chehab
109c1f3caffSMauro Carvalho Chehab /* TOFIX Handle the YUV input formats */
110c1f3caffSMauro Carvalho Chehab static const struct ge2d_fmt formats[] = {
111c1f3caffSMauro Carvalho Chehab /* FOURCC Alpha HW FMT HW MAP */
112c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_XRGB32, false, 32, BGRA8888),
113c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGB32, true, 32, BGRA8888),
114c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_ARGB32, true, 32, BGRA8888),
115c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGBX32, false, 32, ABGR8888),
116c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGBA32, true, 32, ABGR8888),
117c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_BGRX32, false, 32, RGBA8888),
118c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_BGRA32, true, 32, RGBA8888),
119c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_BGR32, true, 32, ARGB8888),
120c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_ABGR32, true, 32, ARGB8888),
121c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_XBGR32, false, 32, ARGB8888),
122c1f3caffSMauro Carvalho Chehab
123c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGB24, false, 24, BGR888),
124c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_BGR24, false, 24, RGB888),
125c1f3caffSMauro Carvalho Chehab
126c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_XRGB555X, false, 16, ARGB1555),
127c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_ARGB555X, true, 16, ARGB1555),
128c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGB565, false, 16, RGB565),
129c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGBX444, false, 16, RGBA4444),
130c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_RGBA444, true, 16, RGBA4444),
131c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_XRGB444, false, 16, ARGB4444),
132c1f3caffSMauro Carvalho Chehab FMT(V4L2_PIX_FMT_ARGB444, true, 16, ARGB4444),
133c1f3caffSMauro Carvalho Chehab };
134c1f3caffSMauro Carvalho Chehab
135c1f3caffSMauro Carvalho Chehab #define NUM_FORMATS ARRAY_SIZE(formats)
136c1f3caffSMauro Carvalho Chehab
find_fmt(struct v4l2_format * f)137c1f3caffSMauro Carvalho Chehab static const struct ge2d_fmt *find_fmt(struct v4l2_format *f)
138c1f3caffSMauro Carvalho Chehab {
139c1f3caffSMauro Carvalho Chehab unsigned int i;
140c1f3caffSMauro Carvalho Chehab
141c1f3caffSMauro Carvalho Chehab for (i = 0; i < NUM_FORMATS; i++) {
142c1f3caffSMauro Carvalho Chehab if (formats[i].fourcc == f->fmt.pix.pixelformat)
143c1f3caffSMauro Carvalho Chehab return &formats[i];
144c1f3caffSMauro Carvalho Chehab }
145c1f3caffSMauro Carvalho Chehab
146c1f3caffSMauro Carvalho Chehab /*
147c1f3caffSMauro Carvalho Chehab * TRY_FMT/S_FMT should never return an error when the requested format
148c1f3caffSMauro Carvalho Chehab * is not supported. Drivers should always return a valid format,
149c1f3caffSMauro Carvalho Chehab * preferably a format that is as widely supported by applications as
150c1f3caffSMauro Carvalho Chehab * possible.
151c1f3caffSMauro Carvalho Chehab */
152c1f3caffSMauro Carvalho Chehab return &formats[0];
153c1f3caffSMauro Carvalho Chehab }
154c1f3caffSMauro Carvalho Chehab
get_frame(struct ge2d_ctx * ctx,enum v4l2_buf_type type)155c1f3caffSMauro Carvalho Chehab static struct ge2d_frame *get_frame(struct ge2d_ctx *ctx,
156c1f3caffSMauro Carvalho Chehab enum v4l2_buf_type type)
157c1f3caffSMauro Carvalho Chehab {
158c1f3caffSMauro Carvalho Chehab switch (type) {
159c1f3caffSMauro Carvalho Chehab case V4L2_BUF_TYPE_VIDEO_OUTPUT:
160c1f3caffSMauro Carvalho Chehab return &ctx->in;
161c1f3caffSMauro Carvalho Chehab case V4L2_BUF_TYPE_VIDEO_CAPTURE:
162c1f3caffSMauro Carvalho Chehab return &ctx->out;
163c1f3caffSMauro Carvalho Chehab default:
164c1f3caffSMauro Carvalho Chehab /* This should never happen, warn and return OUTPUT frame */
165c1f3caffSMauro Carvalho Chehab dev_warn(ctx->ge2d->dev, "%s: invalid buffer type\n", __func__);
166c1f3caffSMauro Carvalho Chehab return &ctx->in;
167c1f3caffSMauro Carvalho Chehab }
168c1f3caffSMauro Carvalho Chehab }
169c1f3caffSMauro Carvalho Chehab
ge2d_hw_start(struct meson_ge2d * ge2d)170c1f3caffSMauro Carvalho Chehab static void ge2d_hw_start(struct meson_ge2d *ge2d)
171c1f3caffSMauro Carvalho Chehab {
172c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = ge2d->curr;
173c1f3caffSMauro Carvalho Chehab u32 reg;
174c1f3caffSMauro Carvalho Chehab
175c1f3caffSMauro Carvalho Chehab /* Reset */
176c1f3caffSMauro Carvalho Chehab regmap_update_bits(ge2d->map, GE2D_GEN_CTRL1,
177c1f3caffSMauro Carvalho Chehab GE2D_SOFT_RST, GE2D_SOFT_RST);
178c1f3caffSMauro Carvalho Chehab regmap_update_bits(ge2d->map, GE2D_GEN_CTRL1,
179c1f3caffSMauro Carvalho Chehab GE2D_SOFT_RST, 0);
180c1f3caffSMauro Carvalho Chehab
181c1f3caffSMauro Carvalho Chehab usleep_range(100, 200);
182c1f3caffSMauro Carvalho Chehab
183c1f3caffSMauro Carvalho Chehab /* Implement CANVAS for non-AXG */
184c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC1_BADDR_CTRL,
185c1f3caffSMauro Carvalho Chehab (vb2_dma_contig_plane_dma_addr(&ctx->in.buf->vb2_buf, 0) + 7) >> 3);
186c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC1_STRIDE_CTRL,
187c1f3caffSMauro Carvalho Chehab (ctx->in.pix_fmt.bytesperline + 7) >> 3);
188c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC2_BADDR_CTRL,
189c1f3caffSMauro Carvalho Chehab (vb2_dma_contig_plane_dma_addr(&ctx->out.buf->vb2_buf, 0) + 7) >> 3);
190c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC2_STRIDE_CTRL,
191c1f3caffSMauro Carvalho Chehab (ctx->out.pix_fmt.bytesperline + 7) >> 3);
192c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_DST1_BADDR_CTRL,
193c1f3caffSMauro Carvalho Chehab (vb2_dma_contig_plane_dma_addr(&ctx->out.buf->vb2_buf, 0) + 7) >> 3);
194c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_DST1_STRIDE_CTRL,
195c1f3caffSMauro Carvalho Chehab (ctx->out.pix_fmt.bytesperline + 7) >> 3);
196c1f3caffSMauro Carvalho Chehab
197c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_GEN_CTRL0, 0);
198c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_GEN_CTRL1,
199c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_INTERRUPT_CTRL, 2) |
200c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_SRC2_BURST_SIZE_CTRL, 3) |
201c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_SRC1_BURST_SIZE_CTRL, 0x3f));
202c1f3caffSMauro Carvalho Chehab
203c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_GEN_CTRL2,
204c1f3caffSMauro Carvalho Chehab GE2D_SRC1_LITTLE_ENDIAN |
205c1f3caffSMauro Carvalho Chehab GE2D_SRC2_LITTLE_ENDIAN |
206c1f3caffSMauro Carvalho Chehab GE2D_DST_LITTLE_ENDIAN |
207c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_DST1_COLOR_MAP, ctx->out.fmt->hw_map) |
208c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_DST1_FORMAT, ctx->out.fmt->hw_fmt) |
209c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_SRC2_COLOR_MAP, ctx->out.fmt->hw_map) |
210c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_SRC2_FORMAT, ctx->out.fmt->hw_fmt) |
211c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_SRC1_COLOR_MAP, ctx->in.fmt->hw_map) |
212c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_SRC1_FORMAT, ctx->in.fmt->hw_fmt));
213c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_GEN_CTRL3,
214c1f3caffSMauro Carvalho Chehab GE2D_DST1_ENABLE);
215c1f3caffSMauro Carvalho Chehab
216c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC1_CLIPY_START_END,
217c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_START, ctx->in.crop.top) |
218c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->in.crop.top + ctx->in.crop.height - 1));
219c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC1_CLIPX_START_END,
220c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_START, ctx->in.crop.left) |
221c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->in.crop.left + ctx->in.crop.width - 1));
222c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC2_CLIPY_START_END,
223c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_START, ctx->out.crop.top) |
224c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.crop.top + ctx->out.crop.height - 1));
225c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC2_CLIPX_START_END,
226c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_START, ctx->out.crop.left) |
227c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.crop.left + ctx->out.crop.width - 1));
228c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_DST_CLIPY_START_END,
229c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_START, ctx->out.crop.top) |
230c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.crop.top + ctx->out.crop.height - 1));
231c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_DST_CLIPX_START_END,
232c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_START, ctx->out.crop.left) |
233c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.crop.left + ctx->out.crop.width - 1));
234c1f3caffSMauro Carvalho Chehab
235c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC1_Y_START_END,
236c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->in.pix_fmt.height - 1));
237c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC1_X_START_END,
238c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->in.pix_fmt.width - 1));
239c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC2_Y_START_END,
240c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.pix_fmt.height - 1));
241c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_SRC2_X_START_END,
242c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.pix_fmt.width - 1));
243c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_DST_Y_START_END,
244c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.pix_fmt.height - 1));
245c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_DST_X_START_END,
246c1f3caffSMauro Carvalho Chehab FIELD_PREP(GE2D_END, ctx->out.pix_fmt.width - 1));
247c1f3caffSMauro Carvalho Chehab
248c1f3caffSMauro Carvalho Chehab /* Color, no blend, use source color */
249c1f3caffSMauro Carvalho Chehab reg = GE2D_ALU_DO_COLOR_OPERATION_LOGIC(LOGIC_OPERATION_COPY,
250c1f3caffSMauro Carvalho Chehab COLOR_FACTOR_SRC_COLOR);
251c1f3caffSMauro Carvalho Chehab
252c1f3caffSMauro Carvalho Chehab if (ctx->in.fmt->alpha && ctx->out.fmt->alpha)
253c1f3caffSMauro Carvalho Chehab /* Take source alpha */
254c1f3caffSMauro Carvalho Chehab reg |= GE2D_ALU_DO_ALPHA_OPERATION_LOGIC(LOGIC_OPERATION_COPY,
255c1f3caffSMauro Carvalho Chehab COLOR_FACTOR_SRC_ALPHA);
256c1f3caffSMauro Carvalho Chehab else if (!ctx->out.fmt->alpha)
257c1f3caffSMauro Carvalho Chehab /* Set alpha to 0 */
258c1f3caffSMauro Carvalho Chehab reg |= GE2D_ALU_DO_ALPHA_OPERATION_LOGIC(LOGIC_OPERATION_SET,
259c1f3caffSMauro Carvalho Chehab COLOR_FACTOR_ZERO);
260c1f3caffSMauro Carvalho Chehab else
261c1f3caffSMauro Carvalho Chehab /* Keep original alpha */
262c1f3caffSMauro Carvalho Chehab reg |= GE2D_ALU_DO_ALPHA_OPERATION_LOGIC(LOGIC_OPERATION_COPY,
263c1f3caffSMauro Carvalho Chehab COLOR_FACTOR_DST_ALPHA);
264c1f3caffSMauro Carvalho Chehab
265c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_ALU_OP_CTRL, reg);
266c1f3caffSMauro Carvalho Chehab
267c1f3caffSMauro Carvalho Chehab /* Start */
268c1f3caffSMauro Carvalho Chehab regmap_write(ge2d->map, GE2D_CMD_CTRL,
269c1f3caffSMauro Carvalho Chehab (ctx->xy_swap ? GE2D_DST_XY_SWAP : 0) |
270c1f3caffSMauro Carvalho Chehab (ctx->hflip ? GE2D_SRC1_Y_REV : 0) |
271c1f3caffSMauro Carvalho Chehab (ctx->vflip ? GE2D_SRC1_X_REV : 0) |
272c1f3caffSMauro Carvalho Chehab GE2D_CBUS_CMD_WR);
273c1f3caffSMauro Carvalho Chehab }
274c1f3caffSMauro Carvalho Chehab
device_run(void * priv)275c1f3caffSMauro Carvalho Chehab static void device_run(void *priv)
276c1f3caffSMauro Carvalho Chehab {
277c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
278c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = ctx->ge2d;
279c1f3caffSMauro Carvalho Chehab
280c1f3caffSMauro Carvalho Chehab ge2d->curr = ctx;
281c1f3caffSMauro Carvalho Chehab
282c1f3caffSMauro Carvalho Chehab ctx->in.buf = v4l2_m2m_next_src_buf(ctx->fh.m2m_ctx);
283c1f3caffSMauro Carvalho Chehab ctx->out.buf = v4l2_m2m_next_dst_buf(ctx->fh.m2m_ctx);
284c1f3caffSMauro Carvalho Chehab
285c1f3caffSMauro Carvalho Chehab ge2d_hw_start(ge2d);
286c1f3caffSMauro Carvalho Chehab }
287c1f3caffSMauro Carvalho Chehab
ge2d_isr(int irq,void * priv)288c1f3caffSMauro Carvalho Chehab static irqreturn_t ge2d_isr(int irq, void *priv)
289c1f3caffSMauro Carvalho Chehab {
290c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = priv;
291c1f3caffSMauro Carvalho Chehab u32 intr;
292c1f3caffSMauro Carvalho Chehab
293c1f3caffSMauro Carvalho Chehab regmap_read(ge2d->map, GE2D_STATUS0, &intr);
294c1f3caffSMauro Carvalho Chehab
295c1f3caffSMauro Carvalho Chehab if (!(intr & GE2D_GE2D_BUSY)) {
296c1f3caffSMauro Carvalho Chehab struct vb2_v4l2_buffer *src, *dst;
297c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = ge2d->curr;
298c1f3caffSMauro Carvalho Chehab
299c1f3caffSMauro Carvalho Chehab ge2d->curr = NULL;
300c1f3caffSMauro Carvalho Chehab
301c1f3caffSMauro Carvalho Chehab src = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
302c1f3caffSMauro Carvalho Chehab dst = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx);
303c1f3caffSMauro Carvalho Chehab
304c1f3caffSMauro Carvalho Chehab src->sequence = ctx->sequence_out++;
305c1f3caffSMauro Carvalho Chehab dst->sequence = ctx->sequence_cap++;
306c1f3caffSMauro Carvalho Chehab
307c1f3caffSMauro Carvalho Chehab dst->timecode = src->timecode;
308c1f3caffSMauro Carvalho Chehab dst->vb2_buf.timestamp = src->vb2_buf.timestamp;
309c1f3caffSMauro Carvalho Chehab dst->flags = src->flags;
310c1f3caffSMauro Carvalho Chehab
311c1f3caffSMauro Carvalho Chehab v4l2_m2m_buf_done(src, VB2_BUF_STATE_DONE);
312c1f3caffSMauro Carvalho Chehab v4l2_m2m_buf_done(dst, VB2_BUF_STATE_DONE);
313c1f3caffSMauro Carvalho Chehab v4l2_m2m_job_finish(ge2d->m2m_dev, ctx->fh.m2m_ctx);
314c1f3caffSMauro Carvalho Chehab }
315c1f3caffSMauro Carvalho Chehab
316c1f3caffSMauro Carvalho Chehab return IRQ_HANDLED;
317c1f3caffSMauro Carvalho Chehab }
318c1f3caffSMauro Carvalho Chehab
319c1f3caffSMauro Carvalho Chehab static const struct v4l2_m2m_ops ge2d_m2m_ops = {
320c1f3caffSMauro Carvalho Chehab .device_run = device_run,
321c1f3caffSMauro Carvalho Chehab };
322c1f3caffSMauro Carvalho Chehab
ge2d_queue_setup(struct vb2_queue * vq,unsigned int * nbuffers,unsigned int * nplanes,unsigned int sizes[],struct device * alloc_devs[])323c1f3caffSMauro Carvalho Chehab static int ge2d_queue_setup(struct vb2_queue *vq,
324c1f3caffSMauro Carvalho Chehab unsigned int *nbuffers, unsigned int *nplanes,
325c1f3caffSMauro Carvalho Chehab unsigned int sizes[], struct device *alloc_devs[])
326c1f3caffSMauro Carvalho Chehab {
327c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = vb2_get_drv_priv(vq);
328c1f3caffSMauro Carvalho Chehab struct ge2d_frame *f = get_frame(ctx, vq->type);
329c1f3caffSMauro Carvalho Chehab
330c1f3caffSMauro Carvalho Chehab if (*nplanes)
331c1f3caffSMauro Carvalho Chehab return sizes[0] < f->pix_fmt.sizeimage ? -EINVAL : 0;
332c1f3caffSMauro Carvalho Chehab
333c1f3caffSMauro Carvalho Chehab sizes[0] = f->pix_fmt.sizeimage;
334c1f3caffSMauro Carvalho Chehab *nplanes = 1;
335c1f3caffSMauro Carvalho Chehab
336c1f3caffSMauro Carvalho Chehab return 0;
337c1f3caffSMauro Carvalho Chehab }
338c1f3caffSMauro Carvalho Chehab
ge2d_buf_prepare(struct vb2_buffer * vb)339c1f3caffSMauro Carvalho Chehab static int ge2d_buf_prepare(struct vb2_buffer *vb)
340c1f3caffSMauro Carvalho Chehab {
341c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
342c1f3caffSMauro Carvalho Chehab struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
343c1f3caffSMauro Carvalho Chehab struct ge2d_frame *f = get_frame(ctx, vb->vb2_queue->type);
344c1f3caffSMauro Carvalho Chehab
345c1f3caffSMauro Carvalho Chehab vbuf->field = V4L2_FIELD_NONE;
346c1f3caffSMauro Carvalho Chehab
347c1f3caffSMauro Carvalho Chehab vb2_set_plane_payload(vb, 0, f->pix_fmt.sizeimage);
348c1f3caffSMauro Carvalho Chehab
349c1f3caffSMauro Carvalho Chehab return 0;
350c1f3caffSMauro Carvalho Chehab }
351c1f3caffSMauro Carvalho Chehab
ge2d_buf_queue(struct vb2_buffer * vb)352c1f3caffSMauro Carvalho Chehab static void ge2d_buf_queue(struct vb2_buffer *vb)
353c1f3caffSMauro Carvalho Chehab {
354c1f3caffSMauro Carvalho Chehab struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
355c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
356c1f3caffSMauro Carvalho Chehab
357c1f3caffSMauro Carvalho Chehab v4l2_m2m_buf_queue(ctx->fh.m2m_ctx, vbuf);
358c1f3caffSMauro Carvalho Chehab }
359c1f3caffSMauro Carvalho Chehab
ge2d_start_streaming(struct vb2_queue * vq,unsigned int count)360c1f3caffSMauro Carvalho Chehab static int ge2d_start_streaming(struct vb2_queue *vq, unsigned int count)
361c1f3caffSMauro Carvalho Chehab {
362c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = vb2_get_drv_priv(vq);
363c1f3caffSMauro Carvalho Chehab
364c1f3caffSMauro Carvalho Chehab if (V4L2_TYPE_IS_OUTPUT(vq->type))
365c1f3caffSMauro Carvalho Chehab ctx->sequence_out = 0;
366c1f3caffSMauro Carvalho Chehab else
367c1f3caffSMauro Carvalho Chehab ctx->sequence_cap = 0;
368c1f3caffSMauro Carvalho Chehab
369c1f3caffSMauro Carvalho Chehab return 0;
370c1f3caffSMauro Carvalho Chehab }
371c1f3caffSMauro Carvalho Chehab
ge2d_stop_streaming(struct vb2_queue * vq)372c1f3caffSMauro Carvalho Chehab static void ge2d_stop_streaming(struct vb2_queue *vq)
373c1f3caffSMauro Carvalho Chehab {
374c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = vb2_get_drv_priv(vq);
375c1f3caffSMauro Carvalho Chehab struct vb2_v4l2_buffer *vbuf;
376c1f3caffSMauro Carvalho Chehab
377c1f3caffSMauro Carvalho Chehab for (;;) {
378c1f3caffSMauro Carvalho Chehab if (V4L2_TYPE_IS_OUTPUT(vq->type))
379c1f3caffSMauro Carvalho Chehab vbuf = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
380c1f3caffSMauro Carvalho Chehab else
381c1f3caffSMauro Carvalho Chehab vbuf = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx);
382c1f3caffSMauro Carvalho Chehab if (!vbuf)
383c1f3caffSMauro Carvalho Chehab break;
384c1f3caffSMauro Carvalho Chehab v4l2_m2m_buf_done(vbuf, VB2_BUF_STATE_ERROR);
385c1f3caffSMauro Carvalho Chehab }
386c1f3caffSMauro Carvalho Chehab }
387c1f3caffSMauro Carvalho Chehab
388c1f3caffSMauro Carvalho Chehab static const struct vb2_ops ge2d_qops = {
389c1f3caffSMauro Carvalho Chehab .queue_setup = ge2d_queue_setup,
390c1f3caffSMauro Carvalho Chehab .buf_prepare = ge2d_buf_prepare,
391c1f3caffSMauro Carvalho Chehab .buf_queue = ge2d_buf_queue,
392c1f3caffSMauro Carvalho Chehab .start_streaming = ge2d_start_streaming,
393c1f3caffSMauro Carvalho Chehab .stop_streaming = ge2d_stop_streaming,
394c1f3caffSMauro Carvalho Chehab .wait_prepare = vb2_ops_wait_prepare,
395c1f3caffSMauro Carvalho Chehab .wait_finish = vb2_ops_wait_finish,
396c1f3caffSMauro Carvalho Chehab };
397c1f3caffSMauro Carvalho Chehab
398c1f3caffSMauro Carvalho Chehab static int
queue_init(void * priv,struct vb2_queue * src_vq,struct vb2_queue * dst_vq)399c1f3caffSMauro Carvalho Chehab queue_init(void *priv, struct vb2_queue *src_vq, struct vb2_queue *dst_vq)
400c1f3caffSMauro Carvalho Chehab {
401c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
402c1f3caffSMauro Carvalho Chehab int ret;
403c1f3caffSMauro Carvalho Chehab
404c1f3caffSMauro Carvalho Chehab src_vq->type = V4L2_BUF_TYPE_VIDEO_OUTPUT;
405c1f3caffSMauro Carvalho Chehab src_vq->io_modes = VB2_MMAP | VB2_DMABUF;
406c1f3caffSMauro Carvalho Chehab src_vq->drv_priv = ctx;
407c1f3caffSMauro Carvalho Chehab src_vq->ops = &ge2d_qops;
408c1f3caffSMauro Carvalho Chehab src_vq->mem_ops = &vb2_dma_contig_memops;
409c1f3caffSMauro Carvalho Chehab src_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer);
410c1f3caffSMauro Carvalho Chehab src_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
411c1f3caffSMauro Carvalho Chehab src_vq->lock = &ctx->ge2d->mutex;
412c1f3caffSMauro Carvalho Chehab src_vq->dev = ctx->ge2d->v4l2_dev.dev;
413c1f3caffSMauro Carvalho Chehab
414c1f3caffSMauro Carvalho Chehab ret = vb2_queue_init(src_vq);
415c1f3caffSMauro Carvalho Chehab if (ret)
416c1f3caffSMauro Carvalho Chehab return ret;
417c1f3caffSMauro Carvalho Chehab
418c1f3caffSMauro Carvalho Chehab dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
419c1f3caffSMauro Carvalho Chehab dst_vq->io_modes = VB2_MMAP | VB2_DMABUF;
420c1f3caffSMauro Carvalho Chehab dst_vq->drv_priv = ctx;
421c1f3caffSMauro Carvalho Chehab dst_vq->ops = &ge2d_qops;
422c1f3caffSMauro Carvalho Chehab dst_vq->mem_ops = &vb2_dma_contig_memops;
423c1f3caffSMauro Carvalho Chehab dst_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer);
424c1f3caffSMauro Carvalho Chehab dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
425c1f3caffSMauro Carvalho Chehab dst_vq->lock = &ctx->ge2d->mutex;
426c1f3caffSMauro Carvalho Chehab dst_vq->dev = ctx->ge2d->v4l2_dev.dev;
427c1f3caffSMauro Carvalho Chehab
428c1f3caffSMauro Carvalho Chehab return vb2_queue_init(dst_vq);
429c1f3caffSMauro Carvalho Chehab }
430c1f3caffSMauro Carvalho Chehab
431c1f3caffSMauro Carvalho Chehab static int
vidioc_querycap(struct file * file,void * priv,struct v4l2_capability * cap)432c1f3caffSMauro Carvalho Chehab vidioc_querycap(struct file *file, void *priv, struct v4l2_capability *cap)
433c1f3caffSMauro Carvalho Chehab {
434c1f3caffSMauro Carvalho Chehab strscpy(cap->driver, GE2D_NAME, sizeof(cap->driver));
435c1f3caffSMauro Carvalho Chehab strscpy(cap->card, GE2D_NAME, sizeof(cap->card));
436c1f3caffSMauro Carvalho Chehab strscpy(cap->bus_info, "platform:" GE2D_NAME, sizeof(cap->bus_info));
437c1f3caffSMauro Carvalho Chehab
438c1f3caffSMauro Carvalho Chehab return 0;
439c1f3caffSMauro Carvalho Chehab }
440c1f3caffSMauro Carvalho Chehab
vidioc_enum_fmt(struct file * file,void * priv,struct v4l2_fmtdesc * f)441c1f3caffSMauro Carvalho Chehab static int vidioc_enum_fmt(struct file *file, void *priv, struct v4l2_fmtdesc *f)
442c1f3caffSMauro Carvalho Chehab {
443c1f3caffSMauro Carvalho Chehab const struct ge2d_fmt *fmt;
444c1f3caffSMauro Carvalho Chehab
445c1f3caffSMauro Carvalho Chehab if (f->index >= NUM_FORMATS)
446c1f3caffSMauro Carvalho Chehab return -EINVAL;
447c1f3caffSMauro Carvalho Chehab
448c1f3caffSMauro Carvalho Chehab fmt = &formats[f->index];
449c1f3caffSMauro Carvalho Chehab f->pixelformat = fmt->fourcc;
450c1f3caffSMauro Carvalho Chehab
451c1f3caffSMauro Carvalho Chehab return 0;
452c1f3caffSMauro Carvalho Chehab }
453c1f3caffSMauro Carvalho Chehab
vidioc_g_selection(struct file * file,void * priv,struct v4l2_selection * s)454c1f3caffSMauro Carvalho Chehab static int vidioc_g_selection(struct file *file, void *priv,
455c1f3caffSMauro Carvalho Chehab struct v4l2_selection *s)
456c1f3caffSMauro Carvalho Chehab {
457c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
458c1f3caffSMauro Carvalho Chehab struct ge2d_frame *f;
459c1f3caffSMauro Carvalho Chehab bool use_frame = false;
460c1f3caffSMauro Carvalho Chehab
461c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_OUTPUT &&
462c1f3caffSMauro Carvalho Chehab s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
463c1f3caffSMauro Carvalho Chehab return -EINVAL;
464c1f3caffSMauro Carvalho Chehab
465c1f3caffSMauro Carvalho Chehab f = get_frame(ctx, s->type);
466c1f3caffSMauro Carvalho Chehab
467c1f3caffSMauro Carvalho Chehab switch (s->target) {
468c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_COMPOSE_DEFAULT:
469c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_COMPOSE_BOUNDS:
470c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
471c1f3caffSMauro Carvalho Chehab return -EINVAL;
472c1f3caffSMauro Carvalho Chehab break;
473c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_CROP_DEFAULT:
474c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_CROP_BOUNDS:
475c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_OUTPUT)
476c1f3caffSMauro Carvalho Chehab return -EINVAL;
477c1f3caffSMauro Carvalho Chehab break;
478c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_COMPOSE:
479c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
480c1f3caffSMauro Carvalho Chehab return -EINVAL;
481c1f3caffSMauro Carvalho Chehab use_frame = true;
482c1f3caffSMauro Carvalho Chehab break;
483c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_CROP:
484c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_OUTPUT)
485c1f3caffSMauro Carvalho Chehab return -EINVAL;
486c1f3caffSMauro Carvalho Chehab use_frame = true;
487c1f3caffSMauro Carvalho Chehab break;
488c1f3caffSMauro Carvalho Chehab default:
489c1f3caffSMauro Carvalho Chehab return -EINVAL;
490c1f3caffSMauro Carvalho Chehab }
491c1f3caffSMauro Carvalho Chehab
492c1f3caffSMauro Carvalho Chehab if (use_frame) {
493c1f3caffSMauro Carvalho Chehab s->r = f->crop;
494c1f3caffSMauro Carvalho Chehab } else {
495c1f3caffSMauro Carvalho Chehab s->r.left = 0;
496c1f3caffSMauro Carvalho Chehab s->r.top = 0;
497c1f3caffSMauro Carvalho Chehab s->r.width = f->pix_fmt.width;
498c1f3caffSMauro Carvalho Chehab s->r.height = f->pix_fmt.height;
499c1f3caffSMauro Carvalho Chehab }
500c1f3caffSMauro Carvalho Chehab
501c1f3caffSMauro Carvalho Chehab return 0;
502c1f3caffSMauro Carvalho Chehab }
503c1f3caffSMauro Carvalho Chehab
vidioc_s_selection(struct file * file,void * priv,struct v4l2_selection * s)504c1f3caffSMauro Carvalho Chehab static int vidioc_s_selection(struct file *file, void *priv,
505c1f3caffSMauro Carvalho Chehab struct v4l2_selection *s)
506c1f3caffSMauro Carvalho Chehab {
507c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
508c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = ctx->ge2d;
509c1f3caffSMauro Carvalho Chehab struct ge2d_frame *f;
510c1f3caffSMauro Carvalho Chehab int ret = 0;
511c1f3caffSMauro Carvalho Chehab
512c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_OUTPUT &&
513c1f3caffSMauro Carvalho Chehab s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
514c1f3caffSMauro Carvalho Chehab return -EINVAL;
515c1f3caffSMauro Carvalho Chehab
516c1f3caffSMauro Carvalho Chehab f = get_frame(ctx, s->type);
517c1f3caffSMauro Carvalho Chehab
518c1f3caffSMauro Carvalho Chehab switch (s->target) {
519c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_COMPOSE:
520c1f3caffSMauro Carvalho Chehab /*
521c1f3caffSMauro Carvalho Chehab * COMPOSE target is only valid for capture buffer type, return
522c1f3caffSMauro Carvalho Chehab * error for output buffer type
523c1f3caffSMauro Carvalho Chehab */
524c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
525c1f3caffSMauro Carvalho Chehab return -EINVAL;
526c1f3caffSMauro Carvalho Chehab break;
527c1f3caffSMauro Carvalho Chehab case V4L2_SEL_TGT_CROP:
528c1f3caffSMauro Carvalho Chehab /*
529c1f3caffSMauro Carvalho Chehab * CROP target is only valid for output buffer type, return
530c1f3caffSMauro Carvalho Chehab * error for capture buffer type
531c1f3caffSMauro Carvalho Chehab */
532c1f3caffSMauro Carvalho Chehab if (s->type != V4L2_BUF_TYPE_VIDEO_OUTPUT)
533c1f3caffSMauro Carvalho Chehab return -EINVAL;
534c1f3caffSMauro Carvalho Chehab break;
535c1f3caffSMauro Carvalho Chehab /*
536c1f3caffSMauro Carvalho Chehab * bound and default crop/compose targets are invalid targets to
537c1f3caffSMauro Carvalho Chehab * try/set
538c1f3caffSMauro Carvalho Chehab */
539c1f3caffSMauro Carvalho Chehab default:
540c1f3caffSMauro Carvalho Chehab return -EINVAL;
541c1f3caffSMauro Carvalho Chehab }
542c1f3caffSMauro Carvalho Chehab
543c1f3caffSMauro Carvalho Chehab if (s->r.top < 0 || s->r.left < 0) {
544c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev,
545c1f3caffSMauro Carvalho Chehab "doesn't support negative values for top & left.\n");
546c1f3caffSMauro Carvalho Chehab return -EINVAL;
547c1f3caffSMauro Carvalho Chehab }
548c1f3caffSMauro Carvalho Chehab
549c1f3caffSMauro Carvalho Chehab if (s->r.left + s->r.width > f->pix_fmt.width ||
550c1f3caffSMauro Carvalho Chehab s->r.top + s->r.height > f->pix_fmt.height) {
551c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "unsupported rectangle value.\n");
552c1f3caffSMauro Carvalho Chehab return -EINVAL;
553c1f3caffSMauro Carvalho Chehab }
554c1f3caffSMauro Carvalho Chehab
555c1f3caffSMauro Carvalho Chehab f->crop = s->r;
556c1f3caffSMauro Carvalho Chehab
557c1f3caffSMauro Carvalho Chehab return ret;
558c1f3caffSMauro Carvalho Chehab }
559c1f3caffSMauro Carvalho Chehab
vidioc_setup_cap_fmt(struct ge2d_ctx * ctx,struct v4l2_pix_format * f)560c1f3caffSMauro Carvalho Chehab static void vidioc_setup_cap_fmt(struct ge2d_ctx *ctx, struct v4l2_pix_format *f)
561c1f3caffSMauro Carvalho Chehab {
562c1f3caffSMauro Carvalho Chehab struct ge2d_frame *frm_out = get_frame(ctx, V4L2_BUF_TYPE_VIDEO_OUTPUT);
563c1f3caffSMauro Carvalho Chehab
564c1f3caffSMauro Carvalho Chehab *f = frm_out->pix_fmt;
565c1f3caffSMauro Carvalho Chehab
566c1f3caffSMauro Carvalho Chehab if (ctx->xy_swap) {
567c1f3caffSMauro Carvalho Chehab f->width = frm_out->pix_fmt.height;
568c1f3caffSMauro Carvalho Chehab f->height = frm_out->pix_fmt.width;
569c1f3caffSMauro Carvalho Chehab }
570c1f3caffSMauro Carvalho Chehab }
571c1f3caffSMauro Carvalho Chehab
vidioc_try_fmt_cap(struct file * file,void * priv,struct v4l2_format * f)572c1f3caffSMauro Carvalho Chehab static int vidioc_try_fmt_cap(struct file *file, void *priv, struct v4l2_format *f)
573c1f3caffSMauro Carvalho Chehab {
574c1f3caffSMauro Carvalho Chehab const struct ge2d_fmt *fmt = find_fmt(f);
575c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
576c1f3caffSMauro Carvalho Chehab struct v4l2_pix_format fmt_cap;
577c1f3caffSMauro Carvalho Chehab
578c1f3caffSMauro Carvalho Chehab vidioc_setup_cap_fmt(ctx, &fmt_cap);
579c1f3caffSMauro Carvalho Chehab
580c1f3caffSMauro Carvalho Chehab fmt_cap.pixelformat = fmt->fourcc;
581c1f3caffSMauro Carvalho Chehab
582c1f3caffSMauro Carvalho Chehab fmt_cap.bytesperline = max(f->fmt.pix.bytesperline,
583c1f3caffSMauro Carvalho Chehab ALIGN((fmt_cap.width * fmt->depth) >> 3, 8));
584c1f3caffSMauro Carvalho Chehab
585c1f3caffSMauro Carvalho Chehab fmt_cap.sizeimage = max(f->fmt.pix.sizeimage,
586c1f3caffSMauro Carvalho Chehab fmt_cap.height * fmt_cap.bytesperline);
587c1f3caffSMauro Carvalho Chehab
588c1f3caffSMauro Carvalho Chehab f->fmt.pix = fmt_cap;
589c1f3caffSMauro Carvalho Chehab
590c1f3caffSMauro Carvalho Chehab return 0;
591c1f3caffSMauro Carvalho Chehab }
592c1f3caffSMauro Carvalho Chehab
vidioc_s_fmt_cap(struct file * file,void * priv,struct v4l2_format * f)593c1f3caffSMauro Carvalho Chehab static int vidioc_s_fmt_cap(struct file *file, void *priv, struct v4l2_format *f)
594c1f3caffSMauro Carvalho Chehab {
595c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
596c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = ctx->ge2d;
597c1f3caffSMauro Carvalho Chehab struct vb2_queue *vq;
598c1f3caffSMauro Carvalho Chehab struct ge2d_frame *frm;
599c1f3caffSMauro Carvalho Chehab int ret = 0;
600c1f3caffSMauro Carvalho Chehab
601c1f3caffSMauro Carvalho Chehab /* Adjust all values accordingly to the hardware capabilities
602c1f3caffSMauro Carvalho Chehab * and chosen format.
603c1f3caffSMauro Carvalho Chehab */
604c1f3caffSMauro Carvalho Chehab ret = vidioc_try_fmt_cap(file, priv, f);
605c1f3caffSMauro Carvalho Chehab if (ret)
606c1f3caffSMauro Carvalho Chehab return ret;
607c1f3caffSMauro Carvalho Chehab
608c1f3caffSMauro Carvalho Chehab vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type);
609c1f3caffSMauro Carvalho Chehab if (vb2_is_busy(vq)) {
610c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "queue (%d) bust\n", f->type);
611c1f3caffSMauro Carvalho Chehab return -EBUSY;
612c1f3caffSMauro Carvalho Chehab }
613c1f3caffSMauro Carvalho Chehab
614c1f3caffSMauro Carvalho Chehab frm = get_frame(ctx, V4L2_BUF_TYPE_VIDEO_CAPTURE);
615c1f3caffSMauro Carvalho Chehab
616c1f3caffSMauro Carvalho Chehab frm->pix_fmt = f->fmt.pix;
617c1f3caffSMauro Carvalho Chehab frm->fmt = find_fmt(f);
618c1f3caffSMauro Carvalho Chehab f->fmt.pix.pixelformat = frm->fmt->fourcc;
619c1f3caffSMauro Carvalho Chehab
620c1f3caffSMauro Carvalho Chehab /* Reset crop settings */
621c1f3caffSMauro Carvalho Chehab frm->crop.left = 0;
622c1f3caffSMauro Carvalho Chehab frm->crop.top = 0;
623c1f3caffSMauro Carvalho Chehab frm->crop.width = frm->pix_fmt.width;
624c1f3caffSMauro Carvalho Chehab frm->crop.height = frm->pix_fmt.height;
625c1f3caffSMauro Carvalho Chehab
626c1f3caffSMauro Carvalho Chehab return 0;
627c1f3caffSMauro Carvalho Chehab }
628c1f3caffSMauro Carvalho Chehab
vidioc_g_fmt(struct file * file,void * priv,struct v4l2_format * f)629c1f3caffSMauro Carvalho Chehab static int vidioc_g_fmt(struct file *file, void *priv, struct v4l2_format *f)
630c1f3caffSMauro Carvalho Chehab {
631c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
632c1f3caffSMauro Carvalho Chehab struct vb2_queue *vq;
633c1f3caffSMauro Carvalho Chehab struct ge2d_frame *frm;
634c1f3caffSMauro Carvalho Chehab
635c1f3caffSMauro Carvalho Chehab vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type);
636c1f3caffSMauro Carvalho Chehab if (!vq)
637c1f3caffSMauro Carvalho Chehab return -EINVAL;
638c1f3caffSMauro Carvalho Chehab
639c1f3caffSMauro Carvalho Chehab frm = get_frame(ctx, f->type);
640c1f3caffSMauro Carvalho Chehab
641c1f3caffSMauro Carvalho Chehab f->fmt.pix = frm->pix_fmt;
642c1f3caffSMauro Carvalho Chehab f->fmt.pix.pixelformat = frm->fmt->fourcc;
643c1f3caffSMauro Carvalho Chehab
644c1f3caffSMauro Carvalho Chehab return 0;
645c1f3caffSMauro Carvalho Chehab }
646c1f3caffSMauro Carvalho Chehab
vidioc_try_fmt_out(struct file * file,void * priv,struct v4l2_format * f)647c1f3caffSMauro Carvalho Chehab static int vidioc_try_fmt_out(struct file *file, void *priv, struct v4l2_format *f)
648c1f3caffSMauro Carvalho Chehab {
649c1f3caffSMauro Carvalho Chehab const struct ge2d_fmt *fmt = find_fmt(f);
650c1f3caffSMauro Carvalho Chehab
651c1f3caffSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE;
652c1f3caffSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc;
653c1f3caffSMauro Carvalho Chehab
654c1f3caffSMauro Carvalho Chehab if (f->fmt.pix.width > MAX_WIDTH)
655c1f3caffSMauro Carvalho Chehab f->fmt.pix.width = MAX_WIDTH;
656c1f3caffSMauro Carvalho Chehab if (f->fmt.pix.height > MAX_HEIGHT)
657c1f3caffSMauro Carvalho Chehab f->fmt.pix.height = MAX_HEIGHT;
658c1f3caffSMauro Carvalho Chehab
659c1f3caffSMauro Carvalho Chehab f->fmt.pix.bytesperline = max(f->fmt.pix.bytesperline,
660c1f3caffSMauro Carvalho Chehab ALIGN((f->fmt.pix.width * fmt->depth) >> 3, 8));
661c1f3caffSMauro Carvalho Chehab
662c1f3caffSMauro Carvalho Chehab f->fmt.pix.sizeimage = max(f->fmt.pix.sizeimage,
663c1f3caffSMauro Carvalho Chehab f->fmt.pix.height * f->fmt.pix.bytesperline);
664c1f3caffSMauro Carvalho Chehab
665c1f3caffSMauro Carvalho Chehab return 0;
666c1f3caffSMauro Carvalho Chehab }
667c1f3caffSMauro Carvalho Chehab
vidioc_s_fmt_out(struct file * file,void * priv,struct v4l2_format * f)668c1f3caffSMauro Carvalho Chehab static int vidioc_s_fmt_out(struct file *file, void *priv, struct v4l2_format *f)
669c1f3caffSMauro Carvalho Chehab {
670c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = priv;
671c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = ctx->ge2d;
672c1f3caffSMauro Carvalho Chehab struct vb2_queue *vq;
673c1f3caffSMauro Carvalho Chehab struct ge2d_frame *frm, *frm_cap;
674c1f3caffSMauro Carvalho Chehab int ret = 0;
675c1f3caffSMauro Carvalho Chehab
676c1f3caffSMauro Carvalho Chehab /* Adjust all values accordingly to the hardware capabilities
677c1f3caffSMauro Carvalho Chehab * and chosen format.
678c1f3caffSMauro Carvalho Chehab */
679c1f3caffSMauro Carvalho Chehab ret = vidioc_try_fmt_out(file, priv, f);
680c1f3caffSMauro Carvalho Chehab if (ret)
681c1f3caffSMauro Carvalho Chehab return ret;
682c1f3caffSMauro Carvalho Chehab
683c1f3caffSMauro Carvalho Chehab vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, f->type);
684c1f3caffSMauro Carvalho Chehab if (vb2_is_busy(vq)) {
685c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "queue (%d) bust\n", f->type);
686c1f3caffSMauro Carvalho Chehab return -EBUSY;
687c1f3caffSMauro Carvalho Chehab }
688c1f3caffSMauro Carvalho Chehab
689c1f3caffSMauro Carvalho Chehab frm = get_frame(ctx, V4L2_BUF_TYPE_VIDEO_OUTPUT);
690c1f3caffSMauro Carvalho Chehab frm_cap = get_frame(ctx, V4L2_BUF_TYPE_VIDEO_CAPTURE);
691c1f3caffSMauro Carvalho Chehab
692c1f3caffSMauro Carvalho Chehab frm->pix_fmt = f->fmt.pix;
693c1f3caffSMauro Carvalho Chehab frm->fmt = find_fmt(f);
694c1f3caffSMauro Carvalho Chehab f->fmt.pix.pixelformat = frm->fmt->fourcc;
695c1f3caffSMauro Carvalho Chehab
696c1f3caffSMauro Carvalho Chehab /* Reset crop settings */
697c1f3caffSMauro Carvalho Chehab frm->crop.left = 0;
698c1f3caffSMauro Carvalho Chehab frm->crop.top = 0;
699c1f3caffSMauro Carvalho Chehab frm->crop.width = frm->pix_fmt.width;
700c1f3caffSMauro Carvalho Chehab frm->crop.height = frm->pix_fmt.height;
701c1f3caffSMauro Carvalho Chehab
702c1f3caffSMauro Carvalho Chehab /* Propagate settings to capture */
703c1f3caffSMauro Carvalho Chehab vidioc_setup_cap_fmt(ctx, &frm_cap->pix_fmt);
704c1f3caffSMauro Carvalho Chehab
705c1f3caffSMauro Carvalho Chehab return 0;
706c1f3caffSMauro Carvalho Chehab }
707c1f3caffSMauro Carvalho Chehab
708c1f3caffSMauro Carvalho Chehab static const struct v4l2_ioctl_ops ge2d_ioctl_ops = {
709c1f3caffSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap,
710c1f3caffSMauro Carvalho Chehab
711c1f3caffSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt,
712c1f3caffSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt,
713c1f3caffSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_cap,
714c1f3caffSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_cap,
715c1f3caffSMauro Carvalho Chehab
716c1f3caffSMauro Carvalho Chehab .vidioc_enum_fmt_vid_out = vidioc_enum_fmt,
717c1f3caffSMauro Carvalho Chehab .vidioc_g_fmt_vid_out = vidioc_g_fmt,
718c1f3caffSMauro Carvalho Chehab .vidioc_try_fmt_vid_out = vidioc_try_fmt_out,
719c1f3caffSMauro Carvalho Chehab .vidioc_s_fmt_vid_out = vidioc_s_fmt_out,
720c1f3caffSMauro Carvalho Chehab
721c1f3caffSMauro Carvalho Chehab .vidioc_reqbufs = v4l2_m2m_ioctl_reqbufs,
722c1f3caffSMauro Carvalho Chehab .vidioc_querybuf = v4l2_m2m_ioctl_querybuf,
723c1f3caffSMauro Carvalho Chehab .vidioc_qbuf = v4l2_m2m_ioctl_qbuf,
724c1f3caffSMauro Carvalho Chehab .vidioc_dqbuf = v4l2_m2m_ioctl_dqbuf,
725c1f3caffSMauro Carvalho Chehab .vidioc_prepare_buf = v4l2_m2m_ioctl_prepare_buf,
726c1f3caffSMauro Carvalho Chehab .vidioc_create_bufs = v4l2_m2m_ioctl_create_bufs,
727c1f3caffSMauro Carvalho Chehab .vidioc_expbuf = v4l2_m2m_ioctl_expbuf,
728c1f3caffSMauro Carvalho Chehab
729c1f3caffSMauro Carvalho Chehab .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
730c1f3caffSMauro Carvalho Chehab .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
731c1f3caffSMauro Carvalho Chehab
732c1f3caffSMauro Carvalho Chehab .vidioc_streamon = v4l2_m2m_ioctl_streamon,
733c1f3caffSMauro Carvalho Chehab .vidioc_streamoff = v4l2_m2m_ioctl_streamoff,
734c1f3caffSMauro Carvalho Chehab
735c1f3caffSMauro Carvalho Chehab .vidioc_g_selection = vidioc_g_selection,
736c1f3caffSMauro Carvalho Chehab .vidioc_s_selection = vidioc_s_selection,
737c1f3caffSMauro Carvalho Chehab };
738c1f3caffSMauro Carvalho Chehab
ge2d_s_ctrl(struct v4l2_ctrl * ctrl)739c1f3caffSMauro Carvalho Chehab static int ge2d_s_ctrl(struct v4l2_ctrl *ctrl)
740c1f3caffSMauro Carvalho Chehab {
741c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = container_of(ctrl->handler, struct ge2d_ctx,
742c1f3caffSMauro Carvalho Chehab ctrl_handler);
743c1f3caffSMauro Carvalho Chehab struct v4l2_pix_format fmt;
744c1f3caffSMauro Carvalho Chehab struct vb2_queue *vq;
745c1f3caffSMauro Carvalho Chehab
746c1f3caffSMauro Carvalho Chehab switch (ctrl->id) {
747c1f3caffSMauro Carvalho Chehab case V4L2_CID_HFLIP:
748c1f3caffSMauro Carvalho Chehab ctx->hflip = ctrl->val;
749c1f3caffSMauro Carvalho Chehab break;
750c1f3caffSMauro Carvalho Chehab case V4L2_CID_VFLIP:
751c1f3caffSMauro Carvalho Chehab ctx->vflip = ctrl->val;
752c1f3caffSMauro Carvalho Chehab break;
753c1f3caffSMauro Carvalho Chehab case V4L2_CID_ROTATE:
754c1f3caffSMauro Carvalho Chehab vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx, V4L2_BUF_TYPE_VIDEO_CAPTURE);
755c1f3caffSMauro Carvalho Chehab if (vb2_is_busy(vq))
756c1f3caffSMauro Carvalho Chehab return -EBUSY;
757c1f3caffSMauro Carvalho Chehab
758c1f3caffSMauro Carvalho Chehab if (ctrl->val == 90) {
759c1f3caffSMauro Carvalho Chehab ctx->hflip = 0;
760c1f3caffSMauro Carvalho Chehab ctx->vflip = 1;
761c1f3caffSMauro Carvalho Chehab ctx->xy_swap = 1;
762c1f3caffSMauro Carvalho Chehab } else if (ctrl->val == 180) {
763c1f3caffSMauro Carvalho Chehab ctx->hflip = 1;
764c1f3caffSMauro Carvalho Chehab ctx->vflip = 1;
765c1f3caffSMauro Carvalho Chehab ctx->xy_swap = 0;
766c1f3caffSMauro Carvalho Chehab } else if (ctrl->val == 270) {
767c1f3caffSMauro Carvalho Chehab ctx->hflip = 1;
768c1f3caffSMauro Carvalho Chehab ctx->vflip = 0;
769c1f3caffSMauro Carvalho Chehab ctx->xy_swap = 1;
770c1f3caffSMauro Carvalho Chehab } else {
771c1f3caffSMauro Carvalho Chehab ctx->hflip = 0;
772c1f3caffSMauro Carvalho Chehab ctx->vflip = 0;
773c1f3caffSMauro Carvalho Chehab ctx->xy_swap = 0;
774c1f3caffSMauro Carvalho Chehab }
775c1f3caffSMauro Carvalho Chehab
776c1f3caffSMauro Carvalho Chehab vidioc_setup_cap_fmt(ctx, &fmt);
777c1f3caffSMauro Carvalho Chehab
778c1f3caffSMauro Carvalho Chehab /*
779c1f3caffSMauro Carvalho Chehab * If the rotation parameter changes the OUTPUT frames
780c1f3caffSMauro Carvalho Chehab * parameters, take them in account
781c1f3caffSMauro Carvalho Chehab */
782c1f3caffSMauro Carvalho Chehab ctx->out.pix_fmt = fmt;
783c1f3caffSMauro Carvalho Chehab
784c1f3caffSMauro Carvalho Chehab break;
785c1f3caffSMauro Carvalho Chehab }
786c1f3caffSMauro Carvalho Chehab
787c1f3caffSMauro Carvalho Chehab return 0;
788c1f3caffSMauro Carvalho Chehab }
789c1f3caffSMauro Carvalho Chehab
790c1f3caffSMauro Carvalho Chehab static const struct v4l2_ctrl_ops ge2d_ctrl_ops = {
791c1f3caffSMauro Carvalho Chehab .s_ctrl = ge2d_s_ctrl,
792c1f3caffSMauro Carvalho Chehab };
793c1f3caffSMauro Carvalho Chehab
ge2d_setup_ctrls(struct ge2d_ctx * ctx)794c1f3caffSMauro Carvalho Chehab static int ge2d_setup_ctrls(struct ge2d_ctx *ctx)
795c1f3caffSMauro Carvalho Chehab {
796c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = ctx->ge2d;
797c1f3caffSMauro Carvalho Chehab
798c1f3caffSMauro Carvalho Chehab v4l2_ctrl_handler_init(&ctx->ctrl_handler, 4);
799c1f3caffSMauro Carvalho Chehab
800c1f3caffSMauro Carvalho Chehab v4l2_ctrl_new_std(&ctx->ctrl_handler, &ge2d_ctrl_ops,
801c1f3caffSMauro Carvalho Chehab V4L2_CID_HFLIP, 0, 1, 1, 0);
802c1f3caffSMauro Carvalho Chehab
803c1f3caffSMauro Carvalho Chehab v4l2_ctrl_new_std(&ctx->ctrl_handler, &ge2d_ctrl_ops,
804c1f3caffSMauro Carvalho Chehab V4L2_CID_VFLIP, 0, 1, 1, 0);
805c1f3caffSMauro Carvalho Chehab
806c1f3caffSMauro Carvalho Chehab v4l2_ctrl_new_std(&ctx->ctrl_handler, &ge2d_ctrl_ops,
807c1f3caffSMauro Carvalho Chehab V4L2_CID_ROTATE, 0, 270, 90, 0);
808c1f3caffSMauro Carvalho Chehab
809c1f3caffSMauro Carvalho Chehab if (ctx->ctrl_handler.error) {
810c1f3caffSMauro Carvalho Chehab int err = ctx->ctrl_handler.error;
811c1f3caffSMauro Carvalho Chehab
812c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "%s failed\n", __func__);
813c1f3caffSMauro Carvalho Chehab v4l2_ctrl_handler_free(&ctx->ctrl_handler);
814c1f3caffSMauro Carvalho Chehab return err;
815c1f3caffSMauro Carvalho Chehab }
816c1f3caffSMauro Carvalho Chehab
817c1f3caffSMauro Carvalho Chehab return 0;
818c1f3caffSMauro Carvalho Chehab }
819c1f3caffSMauro Carvalho Chehab
820c1f3caffSMauro Carvalho Chehab static const struct ge2d_frame def_frame = {
821c1f3caffSMauro Carvalho Chehab .pix_fmt = {
822c1f3caffSMauro Carvalho Chehab .width = DEFAULT_WIDTH,
823c1f3caffSMauro Carvalho Chehab .height = DEFAULT_HEIGHT,
824c1f3caffSMauro Carvalho Chehab .bytesperline = DEFAULT_STRIDE,
825c1f3caffSMauro Carvalho Chehab .sizeimage = DEFAULT_STRIDE * DEFAULT_HEIGHT,
826c1f3caffSMauro Carvalho Chehab .field = V4L2_FIELD_NONE,
827c1f3caffSMauro Carvalho Chehab },
828c1f3caffSMauro Carvalho Chehab .crop.width = DEFAULT_WIDTH,
829c1f3caffSMauro Carvalho Chehab .crop.height = DEFAULT_HEIGHT,
830c1f3caffSMauro Carvalho Chehab .fmt = &formats[0],
831c1f3caffSMauro Carvalho Chehab };
832c1f3caffSMauro Carvalho Chehab
ge2d_open(struct file * file)833c1f3caffSMauro Carvalho Chehab static int ge2d_open(struct file *file)
834c1f3caffSMauro Carvalho Chehab {
835c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = video_drvdata(file);
836c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx = NULL;
837c1f3caffSMauro Carvalho Chehab int ret = 0;
838c1f3caffSMauro Carvalho Chehab
839c1f3caffSMauro Carvalho Chehab ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
840c1f3caffSMauro Carvalho Chehab if (!ctx)
841c1f3caffSMauro Carvalho Chehab return -ENOMEM;
842c1f3caffSMauro Carvalho Chehab ctx->ge2d = ge2d;
843c1f3caffSMauro Carvalho Chehab
844c1f3caffSMauro Carvalho Chehab /* Set default formats */
845c1f3caffSMauro Carvalho Chehab ctx->in = def_frame;
846c1f3caffSMauro Carvalho Chehab ctx->out = def_frame;
847c1f3caffSMauro Carvalho Chehab
848c1f3caffSMauro Carvalho Chehab if (mutex_lock_interruptible(&ge2d->mutex)) {
849c1f3caffSMauro Carvalho Chehab kfree(ctx);
850c1f3caffSMauro Carvalho Chehab return -ERESTARTSYS;
851c1f3caffSMauro Carvalho Chehab }
852c1f3caffSMauro Carvalho Chehab ctx->fh.m2m_ctx = v4l2_m2m_ctx_init(ge2d->m2m_dev, ctx, &queue_init);
853c1f3caffSMauro Carvalho Chehab if (IS_ERR(ctx->fh.m2m_ctx)) {
854c1f3caffSMauro Carvalho Chehab ret = PTR_ERR(ctx->fh.m2m_ctx);
855c1f3caffSMauro Carvalho Chehab mutex_unlock(&ge2d->mutex);
856c1f3caffSMauro Carvalho Chehab kfree(ctx);
857c1f3caffSMauro Carvalho Chehab return ret;
858c1f3caffSMauro Carvalho Chehab }
859c1f3caffSMauro Carvalho Chehab v4l2_fh_init(&ctx->fh, video_devdata(file));
860c1f3caffSMauro Carvalho Chehab file->private_data = &ctx->fh;
861c1f3caffSMauro Carvalho Chehab v4l2_fh_add(&ctx->fh);
862c1f3caffSMauro Carvalho Chehab
863c1f3caffSMauro Carvalho Chehab ge2d_setup_ctrls(ctx);
864c1f3caffSMauro Carvalho Chehab
865c1f3caffSMauro Carvalho Chehab /* Write the default values to the ctx struct */
866c1f3caffSMauro Carvalho Chehab v4l2_ctrl_handler_setup(&ctx->ctrl_handler);
867c1f3caffSMauro Carvalho Chehab
868c1f3caffSMauro Carvalho Chehab ctx->fh.ctrl_handler = &ctx->ctrl_handler;
869c1f3caffSMauro Carvalho Chehab mutex_unlock(&ge2d->mutex);
870c1f3caffSMauro Carvalho Chehab
871c1f3caffSMauro Carvalho Chehab return 0;
872c1f3caffSMauro Carvalho Chehab }
873c1f3caffSMauro Carvalho Chehab
ge2d_release(struct file * file)874c1f3caffSMauro Carvalho Chehab static int ge2d_release(struct file *file)
875c1f3caffSMauro Carvalho Chehab {
876c1f3caffSMauro Carvalho Chehab struct ge2d_ctx *ctx =
877c1f3caffSMauro Carvalho Chehab container_of(file->private_data, struct ge2d_ctx, fh);
878c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = ctx->ge2d;
879c1f3caffSMauro Carvalho Chehab
880c1f3caffSMauro Carvalho Chehab mutex_lock(&ge2d->mutex);
881c1f3caffSMauro Carvalho Chehab
882c1f3caffSMauro Carvalho Chehab v4l2_m2m_ctx_release(ctx->fh.m2m_ctx);
883c1f3caffSMauro Carvalho Chehab
884c1f3caffSMauro Carvalho Chehab v4l2_ctrl_handler_free(&ctx->ctrl_handler);
885c1f3caffSMauro Carvalho Chehab v4l2_fh_del(&ctx->fh);
886c1f3caffSMauro Carvalho Chehab v4l2_fh_exit(&ctx->fh);
887c1f3caffSMauro Carvalho Chehab kfree(ctx);
888c1f3caffSMauro Carvalho Chehab
889c1f3caffSMauro Carvalho Chehab mutex_unlock(&ge2d->mutex);
890c1f3caffSMauro Carvalho Chehab
891c1f3caffSMauro Carvalho Chehab return 0;
892c1f3caffSMauro Carvalho Chehab }
893c1f3caffSMauro Carvalho Chehab
894c1f3caffSMauro Carvalho Chehab static const struct v4l2_file_operations ge2d_fops = {
895c1f3caffSMauro Carvalho Chehab .owner = THIS_MODULE,
896c1f3caffSMauro Carvalho Chehab .open = ge2d_open,
897c1f3caffSMauro Carvalho Chehab .release = ge2d_release,
898c1f3caffSMauro Carvalho Chehab .poll = v4l2_m2m_fop_poll,
899c1f3caffSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2,
900c1f3caffSMauro Carvalho Chehab .mmap = v4l2_m2m_fop_mmap,
901c1f3caffSMauro Carvalho Chehab };
902c1f3caffSMauro Carvalho Chehab
903c1f3caffSMauro Carvalho Chehab static const struct video_device ge2d_videodev = {
904c1f3caffSMauro Carvalho Chehab .name = "meson-ge2d",
905c1f3caffSMauro Carvalho Chehab .fops = &ge2d_fops,
906c1f3caffSMauro Carvalho Chehab .ioctl_ops = &ge2d_ioctl_ops,
907c1f3caffSMauro Carvalho Chehab .minor = -1,
908c1f3caffSMauro Carvalho Chehab .release = video_device_release,
909c1f3caffSMauro Carvalho Chehab .vfl_dir = VFL_DIR_M2M,
910c1f3caffSMauro Carvalho Chehab .device_caps = V4L2_CAP_VIDEO_M2M | V4L2_CAP_STREAMING,
911c1f3caffSMauro Carvalho Chehab };
912c1f3caffSMauro Carvalho Chehab
913c1f3caffSMauro Carvalho Chehab static const struct regmap_config meson_ge2d_regmap_conf = {
914c1f3caffSMauro Carvalho Chehab .reg_bits = 8,
915c1f3caffSMauro Carvalho Chehab .val_bits = 32,
916c1f3caffSMauro Carvalho Chehab .reg_stride = 4,
917c1f3caffSMauro Carvalho Chehab .max_register = GE2D_SRC2_STRIDE_CTRL,
918c1f3caffSMauro Carvalho Chehab };
919c1f3caffSMauro Carvalho Chehab
ge2d_probe(struct platform_device * pdev)920c1f3caffSMauro Carvalho Chehab static int ge2d_probe(struct platform_device *pdev)
921c1f3caffSMauro Carvalho Chehab {
922c1f3caffSMauro Carvalho Chehab struct reset_control *rst;
923c1f3caffSMauro Carvalho Chehab struct video_device *vfd;
924c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d;
925c1f3caffSMauro Carvalho Chehab void __iomem *regs;
926c1f3caffSMauro Carvalho Chehab int ret = 0;
927c1f3caffSMauro Carvalho Chehab int irq;
928c1f3caffSMauro Carvalho Chehab
929c1f3caffSMauro Carvalho Chehab if (!pdev->dev.of_node)
930c1f3caffSMauro Carvalho Chehab return -ENODEV;
931c1f3caffSMauro Carvalho Chehab
932c1f3caffSMauro Carvalho Chehab ge2d = devm_kzalloc(&pdev->dev, sizeof(*ge2d), GFP_KERNEL);
933c1f3caffSMauro Carvalho Chehab if (!ge2d)
934c1f3caffSMauro Carvalho Chehab return -ENOMEM;
935c1f3caffSMauro Carvalho Chehab
936c1f3caffSMauro Carvalho Chehab ge2d->dev = &pdev->dev;
937c1f3caffSMauro Carvalho Chehab mutex_init(&ge2d->mutex);
938c1f3caffSMauro Carvalho Chehab
939c1f3caffSMauro Carvalho Chehab regs = devm_platform_ioremap_resource(pdev, 0);
940c1f3caffSMauro Carvalho Chehab if (IS_ERR(regs))
941c1f3caffSMauro Carvalho Chehab return PTR_ERR(regs);
942c1f3caffSMauro Carvalho Chehab
943c1f3caffSMauro Carvalho Chehab ge2d->map = devm_regmap_init_mmio(ge2d->dev, regs,
944c1f3caffSMauro Carvalho Chehab &meson_ge2d_regmap_conf);
945c1f3caffSMauro Carvalho Chehab if (IS_ERR(ge2d->map))
946c1f3caffSMauro Carvalho Chehab return PTR_ERR(ge2d->map);
947c1f3caffSMauro Carvalho Chehab
948c1f3caffSMauro Carvalho Chehab irq = platform_get_irq(pdev, 0);
949c1f3caffSMauro Carvalho Chehab ret = devm_request_irq(ge2d->dev, irq, ge2d_isr, 0,
950c1f3caffSMauro Carvalho Chehab dev_name(ge2d->dev), ge2d);
951c1f3caffSMauro Carvalho Chehab if (ret < 0) {
952c1f3caffSMauro Carvalho Chehab dev_err(ge2d->dev, "failed to request irq\n");
953c1f3caffSMauro Carvalho Chehab return ret;
954c1f3caffSMauro Carvalho Chehab }
955c1f3caffSMauro Carvalho Chehab
956c1f3caffSMauro Carvalho Chehab rst = devm_reset_control_get(ge2d->dev, NULL);
957c1f3caffSMauro Carvalho Chehab if (IS_ERR(rst)) {
958c1f3caffSMauro Carvalho Chehab dev_err(ge2d->dev, "failed to get core reset controller\n");
959c1f3caffSMauro Carvalho Chehab return PTR_ERR(rst);
960c1f3caffSMauro Carvalho Chehab }
961c1f3caffSMauro Carvalho Chehab
962c1f3caffSMauro Carvalho Chehab ge2d->clk = devm_clk_get(ge2d->dev, NULL);
963c1f3caffSMauro Carvalho Chehab if (IS_ERR(ge2d->clk)) {
964c1f3caffSMauro Carvalho Chehab dev_err(ge2d->dev, "failed to get clock\n");
965c1f3caffSMauro Carvalho Chehab return PTR_ERR(ge2d->clk);
966c1f3caffSMauro Carvalho Chehab }
967c1f3caffSMauro Carvalho Chehab
968c1f3caffSMauro Carvalho Chehab reset_control_assert(rst);
969c1f3caffSMauro Carvalho Chehab udelay(1);
970c1f3caffSMauro Carvalho Chehab reset_control_deassert(rst);
971c1f3caffSMauro Carvalho Chehab
972c1f3caffSMauro Carvalho Chehab ret = clk_prepare_enable(ge2d->clk);
973c1f3caffSMauro Carvalho Chehab if (ret) {
974c1f3caffSMauro Carvalho Chehab dev_err(ge2d->dev, "Cannot enable ge2d sclk: %d\n", ret);
975c1f3caffSMauro Carvalho Chehab return ret;
976c1f3caffSMauro Carvalho Chehab }
977c1f3caffSMauro Carvalho Chehab
978c1f3caffSMauro Carvalho Chehab ret = v4l2_device_register(&pdev->dev, &ge2d->v4l2_dev);
979c1f3caffSMauro Carvalho Chehab if (ret)
980c1f3caffSMauro Carvalho Chehab goto disable_clks;
981c1f3caffSMauro Carvalho Chehab
982c1f3caffSMauro Carvalho Chehab vfd = video_device_alloc();
983c1f3caffSMauro Carvalho Chehab if (!vfd) {
984c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "Failed to allocate video device\n");
985c1f3caffSMauro Carvalho Chehab ret = -ENOMEM;
986c1f3caffSMauro Carvalho Chehab goto unreg_v4l2_dev;
987c1f3caffSMauro Carvalho Chehab }
988c1f3caffSMauro Carvalho Chehab
989c1f3caffSMauro Carvalho Chehab *vfd = ge2d_videodev;
990c1f3caffSMauro Carvalho Chehab vfd->lock = &ge2d->mutex;
991c1f3caffSMauro Carvalho Chehab vfd->v4l2_dev = &ge2d->v4l2_dev;
992c1f3caffSMauro Carvalho Chehab
993c1f3caffSMauro Carvalho Chehab video_set_drvdata(vfd, ge2d);
994c1f3caffSMauro Carvalho Chehab ge2d->vfd = vfd;
995c1f3caffSMauro Carvalho Chehab
996c1f3caffSMauro Carvalho Chehab platform_set_drvdata(pdev, ge2d);
997c1f3caffSMauro Carvalho Chehab ge2d->m2m_dev = v4l2_m2m_init(&ge2d_m2m_ops);
998c1f3caffSMauro Carvalho Chehab if (IS_ERR(ge2d->m2m_dev)) {
999c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "Failed to init mem2mem device\n");
1000c1f3caffSMauro Carvalho Chehab ret = PTR_ERR(ge2d->m2m_dev);
1001c1f3caffSMauro Carvalho Chehab goto rel_vdev;
1002c1f3caffSMauro Carvalho Chehab }
1003c1f3caffSMauro Carvalho Chehab
1004c1f3caffSMauro Carvalho Chehab ret = video_register_device(vfd, VFL_TYPE_VIDEO, -1);
1005c1f3caffSMauro Carvalho Chehab if (ret) {
1006c1f3caffSMauro Carvalho Chehab v4l2_err(&ge2d->v4l2_dev, "Failed to register video device\n");
1007c1f3caffSMauro Carvalho Chehab goto rel_m2m;
1008c1f3caffSMauro Carvalho Chehab }
1009c1f3caffSMauro Carvalho Chehab
1010c1f3caffSMauro Carvalho Chehab v4l2_info(&ge2d->v4l2_dev, "Registered %s as /dev/%s\n",
1011c1f3caffSMauro Carvalho Chehab vfd->name, video_device_node_name(vfd));
1012c1f3caffSMauro Carvalho Chehab
1013c1f3caffSMauro Carvalho Chehab return 0;
1014c1f3caffSMauro Carvalho Chehab
1015c1f3caffSMauro Carvalho Chehab rel_m2m:
1016c1f3caffSMauro Carvalho Chehab v4l2_m2m_release(ge2d->m2m_dev);
1017c1f3caffSMauro Carvalho Chehab rel_vdev:
1018c1f3caffSMauro Carvalho Chehab video_device_release(ge2d->vfd);
1019c1f3caffSMauro Carvalho Chehab unreg_v4l2_dev:
1020c1f3caffSMauro Carvalho Chehab v4l2_device_unregister(&ge2d->v4l2_dev);
1021c1f3caffSMauro Carvalho Chehab disable_clks:
1022c1f3caffSMauro Carvalho Chehab clk_disable_unprepare(ge2d->clk);
1023c1f3caffSMauro Carvalho Chehab
1024c1f3caffSMauro Carvalho Chehab return ret;
1025c1f3caffSMauro Carvalho Chehab }
1026c1f3caffSMauro Carvalho Chehab
ge2d_remove(struct platform_device * pdev)1027*06fc46caSUwe Kleine-König static void ge2d_remove(struct platform_device *pdev)
1028c1f3caffSMauro Carvalho Chehab {
1029c1f3caffSMauro Carvalho Chehab struct meson_ge2d *ge2d = platform_get_drvdata(pdev);
1030c1f3caffSMauro Carvalho Chehab
1031c1f3caffSMauro Carvalho Chehab video_unregister_device(ge2d->vfd);
1032c1f3caffSMauro Carvalho Chehab v4l2_m2m_release(ge2d->m2m_dev);
1033c1f3caffSMauro Carvalho Chehab v4l2_device_unregister(&ge2d->v4l2_dev);
1034c1f3caffSMauro Carvalho Chehab clk_disable_unprepare(ge2d->clk);
1035c1f3caffSMauro Carvalho Chehab }
1036c1f3caffSMauro Carvalho Chehab
1037c1f3caffSMauro Carvalho Chehab static const struct of_device_id meson_ge2d_match[] = {
1038c1f3caffSMauro Carvalho Chehab {
1039c1f3caffSMauro Carvalho Chehab .compatible = "amlogic,axg-ge2d",
1040c1f3caffSMauro Carvalho Chehab },
1041c1f3caffSMauro Carvalho Chehab {},
1042c1f3caffSMauro Carvalho Chehab };
1043c1f3caffSMauro Carvalho Chehab
1044c1f3caffSMauro Carvalho Chehab MODULE_DEVICE_TABLE(of, meson_ge2d_match);
1045c1f3caffSMauro Carvalho Chehab
1046c1f3caffSMauro Carvalho Chehab static struct platform_driver ge2d_drv = {
1047c1f3caffSMauro Carvalho Chehab .probe = ge2d_probe,
1048*06fc46caSUwe Kleine-König .remove_new = ge2d_remove,
1049c1f3caffSMauro Carvalho Chehab .driver = {
1050c1f3caffSMauro Carvalho Chehab .name = "meson-ge2d",
1051c1f3caffSMauro Carvalho Chehab .of_match_table = meson_ge2d_match,
1052c1f3caffSMauro Carvalho Chehab },
1053c1f3caffSMauro Carvalho Chehab };
1054c1f3caffSMauro Carvalho Chehab
1055c1f3caffSMauro Carvalho Chehab module_platform_driver(ge2d_drv);
1056c1f3caffSMauro Carvalho Chehab
1057c1f3caffSMauro Carvalho Chehab MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
1058c1f3caffSMauro Carvalho Chehab MODULE_DESCRIPTION("Amlogic 2D Graphic Acceleration Unit");
1059c1f3caffSMauro Carvalho Chehab MODULE_LICENSE("GPL");
1060