1cd33c830SBoris Brezillon // SPDX-License-Identifier: GPL-2.0
2cd33c830SBoris Brezillon /*
3cd33c830SBoris Brezillon * Rockchip Video Decoder driver
4cd33c830SBoris Brezillon *
5cd33c830SBoris Brezillon * Copyright (C) 2019 Collabora, Ltd.
6cd33c830SBoris Brezillon *
7cd33c830SBoris Brezillon * Based on rkvdec driver by Google LLC. (Tomasz Figa <tfiga@chromium.org>)
8cd33c830SBoris Brezillon * Based on s5p-mfc driver by Samsung Electronics Co., Ltd.
9cd33c830SBoris Brezillon * Copyright (C) 2011 Samsung Electronics Co., Ltd.
10cd33c830SBoris Brezillon */
11cd33c830SBoris Brezillon
12cd33c830SBoris Brezillon #include <linux/clk.h>
13cd33c830SBoris Brezillon #include <linux/interrupt.h>
14cd33c830SBoris Brezillon #include <linux/module.h>
15cd33c830SBoris Brezillon #include <linux/of.h>
16cd33c830SBoris Brezillon #include <linux/platform_device.h>
17cd33c830SBoris Brezillon #include <linux/pm.h>
18cd33c830SBoris Brezillon #include <linux/pm_runtime.h>
19cd33c830SBoris Brezillon #include <linux/slab.h>
20cd33c830SBoris Brezillon #include <linux/videodev2.h>
21cd33c830SBoris Brezillon #include <linux/workqueue.h>
22cd33c830SBoris Brezillon #include <media/v4l2-event.h>
23cd33c830SBoris Brezillon #include <media/v4l2-mem2mem.h>
24cd33c830SBoris Brezillon #include <media/videobuf2-core.h>
25cd33c830SBoris Brezillon #include <media/videobuf2-vmalloc.h>
26cd33c830SBoris Brezillon
27cd33c830SBoris Brezillon #include "rkvdec.h"
28cd33c830SBoris Brezillon #include "rkvdec-regs.h"
29cd33c830SBoris Brezillon
rkvdec_try_ctrl(struct v4l2_ctrl * ctrl)309363aa33SEzequiel Garcia static int rkvdec_try_ctrl(struct v4l2_ctrl *ctrl)
319363aa33SEzequiel Garcia {
32cf76bb4dSNicolas Dufresne struct rkvdec_ctx *ctx = container_of(ctrl->handler, struct rkvdec_ctx, ctrl_hdl);
33cf76bb4dSNicolas Dufresne const struct rkvdec_coded_fmt_desc *desc = ctx->coded_fmt_desc;
34cf76bb4dSNicolas Dufresne
35cf76bb4dSNicolas Dufresne if (desc->ops->try_ctrl)
36cf76bb4dSNicolas Dufresne return desc->ops->try_ctrl(ctx, ctrl);
37cf76bb4dSNicolas Dufresne
389363aa33SEzequiel Garcia return 0;
399363aa33SEzequiel Garcia }
409363aa33SEzequiel Garcia
419363aa33SEzequiel Garcia static const struct v4l2_ctrl_ops rkvdec_ctrl_ops = {
429363aa33SEzequiel Garcia .try_ctrl = rkvdec_try_ctrl,
439363aa33SEzequiel Garcia };
449363aa33SEzequiel Garcia
45cd33c830SBoris Brezillon static const struct rkvdec_ctrl_desc rkvdec_h264_ctrl_descs[] = {
46cd33c830SBoris Brezillon {
4746a309d2SEzequiel Garcia .cfg.id = V4L2_CID_STATELESS_H264_DECODE_PARAMS,
48cd33c830SBoris Brezillon },
49cd33c830SBoris Brezillon {
5046a309d2SEzequiel Garcia .cfg.id = V4L2_CID_STATELESS_H264_SPS,
519363aa33SEzequiel Garcia .cfg.ops = &rkvdec_ctrl_ops,
52cd33c830SBoris Brezillon },
53cd33c830SBoris Brezillon {
5446a309d2SEzequiel Garcia .cfg.id = V4L2_CID_STATELESS_H264_PPS,
55cd33c830SBoris Brezillon },
56cd33c830SBoris Brezillon {
5746a309d2SEzequiel Garcia .cfg.id = V4L2_CID_STATELESS_H264_SCALING_MATRIX,
58cd33c830SBoris Brezillon },
59cd33c830SBoris Brezillon {
6046a309d2SEzequiel Garcia .cfg.id = V4L2_CID_STATELESS_H264_DECODE_MODE,
6146a309d2SEzequiel Garcia .cfg.min = V4L2_STATELESS_H264_DECODE_MODE_FRAME_BASED,
6246a309d2SEzequiel Garcia .cfg.max = V4L2_STATELESS_H264_DECODE_MODE_FRAME_BASED,
6346a309d2SEzequiel Garcia .cfg.def = V4L2_STATELESS_H264_DECODE_MODE_FRAME_BASED,
64cd33c830SBoris Brezillon },
65cd33c830SBoris Brezillon {
6646a309d2SEzequiel Garcia .cfg.id = V4L2_CID_STATELESS_H264_START_CODE,
6746a309d2SEzequiel Garcia .cfg.min = V4L2_STATELESS_H264_START_CODE_ANNEX_B,
6846a309d2SEzequiel Garcia .cfg.def = V4L2_STATELESS_H264_START_CODE_ANNEX_B,
6946a309d2SEzequiel Garcia .cfg.max = V4L2_STATELESS_H264_START_CODE_ANNEX_B,
70cd33c830SBoris Brezillon },
71b74593ebSJonas Karlman {
72b74593ebSJonas Karlman .cfg.id = V4L2_CID_MPEG_VIDEO_H264_PROFILE,
73b74593ebSJonas Karlman .cfg.min = V4L2_MPEG_VIDEO_H264_PROFILE_BASELINE,
74b74593ebSJonas Karlman .cfg.max = V4L2_MPEG_VIDEO_H264_PROFILE_HIGH,
75b74593ebSJonas Karlman .cfg.menu_skip_mask =
76b74593ebSJonas Karlman BIT(V4L2_MPEG_VIDEO_H264_PROFILE_EXTENDED),
77b74593ebSJonas Karlman .cfg.def = V4L2_MPEG_VIDEO_H264_PROFILE_MAIN,
78b74593ebSJonas Karlman },
79b74593ebSJonas Karlman {
80b74593ebSJonas Karlman .cfg.id = V4L2_CID_MPEG_VIDEO_H264_LEVEL,
81b74593ebSJonas Karlman .cfg.min = V4L2_MPEG_VIDEO_H264_LEVEL_1_0,
82b74593ebSJonas Karlman .cfg.max = V4L2_MPEG_VIDEO_H264_LEVEL_5_1,
83b74593ebSJonas Karlman },
84cd33c830SBoris Brezillon };
85cd33c830SBoris Brezillon
86cd33c830SBoris Brezillon static const struct rkvdec_ctrls rkvdec_h264_ctrls = {
87cd33c830SBoris Brezillon .ctrls = rkvdec_h264_ctrl_descs,
88cd33c830SBoris Brezillon .num_ctrls = ARRAY_SIZE(rkvdec_h264_ctrl_descs),
89cd33c830SBoris Brezillon };
90cd33c830SBoris Brezillon
91f25709c4SAndrzej Pietrasiewicz static const u32 rkvdec_h264_vp9_decoded_fmts[] = {
92cd33c830SBoris Brezillon V4L2_PIX_FMT_NV12,
93cd33c830SBoris Brezillon };
94cd33c830SBoris Brezillon
95f25709c4SAndrzej Pietrasiewicz static const struct rkvdec_ctrl_desc rkvdec_vp9_ctrl_descs[] = {
96f25709c4SAndrzej Pietrasiewicz {
97f25709c4SAndrzej Pietrasiewicz .cfg.id = V4L2_CID_STATELESS_VP9_FRAME,
98f25709c4SAndrzej Pietrasiewicz },
99f25709c4SAndrzej Pietrasiewicz {
100f25709c4SAndrzej Pietrasiewicz .cfg.id = V4L2_CID_STATELESS_VP9_COMPRESSED_HDR,
101f25709c4SAndrzej Pietrasiewicz },
102f25709c4SAndrzej Pietrasiewicz {
103f25709c4SAndrzej Pietrasiewicz .cfg.id = V4L2_CID_MPEG_VIDEO_VP9_PROFILE,
104f25709c4SAndrzej Pietrasiewicz .cfg.min = V4L2_MPEG_VIDEO_VP9_PROFILE_0,
105f25709c4SAndrzej Pietrasiewicz .cfg.max = V4L2_MPEG_VIDEO_VP9_PROFILE_0,
106f25709c4SAndrzej Pietrasiewicz .cfg.def = V4L2_MPEG_VIDEO_VP9_PROFILE_0,
107f25709c4SAndrzej Pietrasiewicz },
108f25709c4SAndrzej Pietrasiewicz };
109f25709c4SAndrzej Pietrasiewicz
110f25709c4SAndrzej Pietrasiewicz static const struct rkvdec_ctrls rkvdec_vp9_ctrls = {
111f25709c4SAndrzej Pietrasiewicz .ctrls = rkvdec_vp9_ctrl_descs,
112f25709c4SAndrzej Pietrasiewicz .num_ctrls = ARRAY_SIZE(rkvdec_vp9_ctrl_descs),
113f25709c4SAndrzej Pietrasiewicz };
114f25709c4SAndrzej Pietrasiewicz
115cd33c830SBoris Brezillon static const struct rkvdec_coded_fmt_desc rkvdec_coded_fmts[] = {
116cd33c830SBoris Brezillon {
117cd33c830SBoris Brezillon .fourcc = V4L2_PIX_FMT_H264_SLICE,
118cd33c830SBoris Brezillon .frmsize = {
119cd33c830SBoris Brezillon .min_width = 48,
120cd33c830SBoris Brezillon .max_width = 4096,
121cd33c830SBoris Brezillon .step_width = 16,
122cd33c830SBoris Brezillon .min_height = 48,
123f000e6caSBenjamin Gaignard .max_height = 2560,
124cd33c830SBoris Brezillon .step_height = 16,
125cd33c830SBoris Brezillon },
126cd33c830SBoris Brezillon .ctrls = &rkvdec_h264_ctrls,
127cd33c830SBoris Brezillon .ops = &rkvdec_h264_fmt_ops,
128f25709c4SAndrzej Pietrasiewicz .num_decoded_fmts = ARRAY_SIZE(rkvdec_h264_vp9_decoded_fmts),
129f25709c4SAndrzej Pietrasiewicz .decoded_fmts = rkvdec_h264_vp9_decoded_fmts,
130ed7bb87dSNicolas Dufresne .subsystem_flags = VB2_V4L2_FL_SUPPORTS_M2M_HOLD_CAPTURE_BUF,
131f25709c4SAndrzej Pietrasiewicz },
132f25709c4SAndrzej Pietrasiewicz {
133f25709c4SAndrzej Pietrasiewicz .fourcc = V4L2_PIX_FMT_VP9_FRAME,
134f25709c4SAndrzej Pietrasiewicz .frmsize = {
135f25709c4SAndrzej Pietrasiewicz .min_width = 64,
136f25709c4SAndrzej Pietrasiewicz .max_width = 4096,
137f25709c4SAndrzej Pietrasiewicz .step_width = 64,
138f25709c4SAndrzej Pietrasiewicz .min_height = 64,
139f25709c4SAndrzej Pietrasiewicz .max_height = 2304,
140f25709c4SAndrzej Pietrasiewicz .step_height = 64,
141f25709c4SAndrzej Pietrasiewicz },
142f25709c4SAndrzej Pietrasiewicz .ctrls = &rkvdec_vp9_ctrls,
143f25709c4SAndrzej Pietrasiewicz .ops = &rkvdec_vp9_fmt_ops,
144f25709c4SAndrzej Pietrasiewicz .num_decoded_fmts = ARRAY_SIZE(rkvdec_h264_vp9_decoded_fmts),
145f25709c4SAndrzej Pietrasiewicz .decoded_fmts = rkvdec_h264_vp9_decoded_fmts,
146cd33c830SBoris Brezillon }
147cd33c830SBoris Brezillon };
148cd33c830SBoris Brezillon
149cd33c830SBoris Brezillon static const struct rkvdec_coded_fmt_desc *
rkvdec_find_coded_fmt_desc(u32 fourcc)150cd33c830SBoris Brezillon rkvdec_find_coded_fmt_desc(u32 fourcc)
151cd33c830SBoris Brezillon {
152cd33c830SBoris Brezillon unsigned int i;
153cd33c830SBoris Brezillon
154cd33c830SBoris Brezillon for (i = 0; i < ARRAY_SIZE(rkvdec_coded_fmts); i++) {
155cd33c830SBoris Brezillon if (rkvdec_coded_fmts[i].fourcc == fourcc)
156cd33c830SBoris Brezillon return &rkvdec_coded_fmts[i];
157cd33c830SBoris Brezillon }
158cd33c830SBoris Brezillon
159cd33c830SBoris Brezillon return NULL;
160cd33c830SBoris Brezillon }
161cd33c830SBoris Brezillon
rkvdec_reset_fmt(struct rkvdec_ctx * ctx,struct v4l2_format * f,u32 fourcc)162cd33c830SBoris Brezillon static void rkvdec_reset_fmt(struct rkvdec_ctx *ctx, struct v4l2_format *f,
163cd33c830SBoris Brezillon u32 fourcc)
164cd33c830SBoris Brezillon {
165cd33c830SBoris Brezillon memset(f, 0, sizeof(*f));
166cd33c830SBoris Brezillon f->fmt.pix_mp.pixelformat = fourcc;
167cd33c830SBoris Brezillon f->fmt.pix_mp.field = V4L2_FIELD_NONE;
168a819678dSTravis Carter f->fmt.pix_mp.colorspace = V4L2_COLORSPACE_REC709;
169cd33c830SBoris Brezillon f->fmt.pix_mp.ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
170cd33c830SBoris Brezillon f->fmt.pix_mp.quantization = V4L2_QUANTIZATION_DEFAULT;
171cd33c830SBoris Brezillon f->fmt.pix_mp.xfer_func = V4L2_XFER_FUNC_DEFAULT;
172cd33c830SBoris Brezillon }
173cd33c830SBoris Brezillon
rkvdec_reset_coded_fmt(struct rkvdec_ctx * ctx)174cd33c830SBoris Brezillon static void rkvdec_reset_coded_fmt(struct rkvdec_ctx *ctx)
175cd33c830SBoris Brezillon {
176cd33c830SBoris Brezillon struct v4l2_format *f = &ctx->coded_fmt;
177cd33c830SBoris Brezillon
178cd33c830SBoris Brezillon ctx->coded_fmt_desc = &rkvdec_coded_fmts[0];
179cd33c830SBoris Brezillon rkvdec_reset_fmt(ctx, f, ctx->coded_fmt_desc->fourcc);
180cd33c830SBoris Brezillon
181cd33c830SBoris Brezillon f->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
182cd33c830SBoris Brezillon f->fmt.pix_mp.width = ctx->coded_fmt_desc->frmsize.min_width;
183cd33c830SBoris Brezillon f->fmt.pix_mp.height = ctx->coded_fmt_desc->frmsize.min_height;
184cd33c830SBoris Brezillon
185cd33c830SBoris Brezillon if (ctx->coded_fmt_desc->ops->adjust_fmt)
186cd33c830SBoris Brezillon ctx->coded_fmt_desc->ops->adjust_fmt(ctx, f);
187cd33c830SBoris Brezillon }
188cd33c830SBoris Brezillon
rkvdec_reset_decoded_fmt(struct rkvdec_ctx * ctx)189cd33c830SBoris Brezillon static void rkvdec_reset_decoded_fmt(struct rkvdec_ctx *ctx)
190cd33c830SBoris Brezillon {
191cd33c830SBoris Brezillon struct v4l2_format *f = &ctx->decoded_fmt;
192cd33c830SBoris Brezillon
193cd33c830SBoris Brezillon rkvdec_reset_fmt(ctx, f, ctx->coded_fmt_desc->decoded_fmts[0]);
194cd33c830SBoris Brezillon f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
195cd33c830SBoris Brezillon v4l2_fill_pixfmt_mp(&f->fmt.pix_mp,
196cd33c830SBoris Brezillon ctx->coded_fmt_desc->decoded_fmts[0],
197cd33c830SBoris Brezillon ctx->coded_fmt.fmt.pix_mp.width,
198cd33c830SBoris Brezillon ctx->coded_fmt.fmt.pix_mp.height);
199cd33c830SBoris Brezillon f->fmt.pix_mp.plane_fmt[0].sizeimage += 128 *
200cd33c830SBoris Brezillon DIV_ROUND_UP(f->fmt.pix_mp.width, 16) *
201cd33c830SBoris Brezillon DIV_ROUND_UP(f->fmt.pix_mp.height, 16);
202cd33c830SBoris Brezillon }
203cd33c830SBoris Brezillon
rkvdec_enum_framesizes(struct file * file,void * priv,struct v4l2_frmsizeenum * fsize)204cd33c830SBoris Brezillon static int rkvdec_enum_framesizes(struct file *file, void *priv,
205cd33c830SBoris Brezillon struct v4l2_frmsizeenum *fsize)
206cd33c830SBoris Brezillon {
207cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *fmt;
208cd33c830SBoris Brezillon
209cd33c830SBoris Brezillon if (fsize->index != 0)
210cd33c830SBoris Brezillon return -EINVAL;
211cd33c830SBoris Brezillon
212cd33c830SBoris Brezillon fmt = rkvdec_find_coded_fmt_desc(fsize->pixel_format);
213cd33c830SBoris Brezillon if (!fmt)
214cd33c830SBoris Brezillon return -EINVAL;
215cd33c830SBoris Brezillon
216cd33c830SBoris Brezillon fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE;
217cd33c830SBoris Brezillon fsize->stepwise = fmt->frmsize;
218cd33c830SBoris Brezillon return 0;
219cd33c830SBoris Brezillon }
220cd33c830SBoris Brezillon
rkvdec_querycap(struct file * file,void * priv,struct v4l2_capability * cap)221cd33c830SBoris Brezillon static int rkvdec_querycap(struct file *file, void *priv,
222cd33c830SBoris Brezillon struct v4l2_capability *cap)
223cd33c830SBoris Brezillon {
224cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = video_drvdata(file);
225cd33c830SBoris Brezillon struct video_device *vdev = video_devdata(file);
226cd33c830SBoris Brezillon
227cd33c830SBoris Brezillon strscpy(cap->driver, rkvdec->dev->driver->name,
228cd33c830SBoris Brezillon sizeof(cap->driver));
229cd33c830SBoris Brezillon strscpy(cap->card, vdev->name, sizeof(cap->card));
230cd33c830SBoris Brezillon snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s",
231cd33c830SBoris Brezillon rkvdec->dev->driver->name);
232cd33c830SBoris Brezillon return 0;
233cd33c830SBoris Brezillon }
234cd33c830SBoris Brezillon
rkvdec_try_capture_fmt(struct file * file,void * priv,struct v4l2_format * f)235cd33c830SBoris Brezillon static int rkvdec_try_capture_fmt(struct file *file, void *priv,
236cd33c830SBoris Brezillon struct v4l2_format *f)
237cd33c830SBoris Brezillon {
238cd33c830SBoris Brezillon struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp;
239cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
240cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *coded_desc;
241cd33c830SBoris Brezillon unsigned int i;
242cd33c830SBoris Brezillon
243cd33c830SBoris Brezillon /*
244cd33c830SBoris Brezillon * The codec context should point to a coded format desc, if the format
245cd33c830SBoris Brezillon * on the coded end has not been set yet, it should point to the
246cd33c830SBoris Brezillon * default value.
247cd33c830SBoris Brezillon */
248cd33c830SBoris Brezillon coded_desc = ctx->coded_fmt_desc;
249cd33c830SBoris Brezillon if (WARN_ON(!coded_desc))
250cd33c830SBoris Brezillon return -EINVAL;
251cd33c830SBoris Brezillon
252cd33c830SBoris Brezillon for (i = 0; i < coded_desc->num_decoded_fmts; i++) {
253cd33c830SBoris Brezillon if (coded_desc->decoded_fmts[i] == pix_mp->pixelformat)
254cd33c830SBoris Brezillon break;
255cd33c830SBoris Brezillon }
256cd33c830SBoris Brezillon
257cd33c830SBoris Brezillon if (i == coded_desc->num_decoded_fmts)
258cd33c830SBoris Brezillon pix_mp->pixelformat = coded_desc->decoded_fmts[0];
259cd33c830SBoris Brezillon
260cd33c830SBoris Brezillon /* Always apply the frmsize constraint of the coded end. */
2615e57a860SJonas Karlman pix_mp->width = max(pix_mp->width, ctx->coded_fmt.fmt.pix_mp.width);
2625e57a860SJonas Karlman pix_mp->height = max(pix_mp->height, ctx->coded_fmt.fmt.pix_mp.height);
263cd33c830SBoris Brezillon v4l2_apply_frmsize_constraints(&pix_mp->width,
264cd33c830SBoris Brezillon &pix_mp->height,
265cd33c830SBoris Brezillon &coded_desc->frmsize);
266cd33c830SBoris Brezillon
267cd33c830SBoris Brezillon v4l2_fill_pixfmt_mp(pix_mp, pix_mp->pixelformat,
268cd33c830SBoris Brezillon pix_mp->width, pix_mp->height);
269cd33c830SBoris Brezillon pix_mp->plane_fmt[0].sizeimage +=
270cd33c830SBoris Brezillon 128 *
271cd33c830SBoris Brezillon DIV_ROUND_UP(pix_mp->width, 16) *
272cd33c830SBoris Brezillon DIV_ROUND_UP(pix_mp->height, 16);
273cd33c830SBoris Brezillon pix_mp->field = V4L2_FIELD_NONE;
274cd33c830SBoris Brezillon
275cd33c830SBoris Brezillon return 0;
276cd33c830SBoris Brezillon }
277cd33c830SBoris Brezillon
rkvdec_try_output_fmt(struct file * file,void * priv,struct v4l2_format * f)278cd33c830SBoris Brezillon static int rkvdec_try_output_fmt(struct file *file, void *priv,
279cd33c830SBoris Brezillon struct v4l2_format *f)
280cd33c830SBoris Brezillon {
281cd33c830SBoris Brezillon struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp;
282cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
283cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *desc;
284cd33c830SBoris Brezillon
285cd33c830SBoris Brezillon desc = rkvdec_find_coded_fmt_desc(pix_mp->pixelformat);
286cd33c830SBoris Brezillon if (!desc) {
287cd33c830SBoris Brezillon pix_mp->pixelformat = rkvdec_coded_fmts[0].fourcc;
288cd33c830SBoris Brezillon desc = &rkvdec_coded_fmts[0];
289cd33c830SBoris Brezillon }
290cd33c830SBoris Brezillon
291cd33c830SBoris Brezillon v4l2_apply_frmsize_constraints(&pix_mp->width,
292cd33c830SBoris Brezillon &pix_mp->height,
293cd33c830SBoris Brezillon &desc->frmsize);
294cd33c830SBoris Brezillon
295cd33c830SBoris Brezillon pix_mp->field = V4L2_FIELD_NONE;
296cd33c830SBoris Brezillon /* All coded formats are considered single planar for now. */
297cd33c830SBoris Brezillon pix_mp->num_planes = 1;
298cd33c830SBoris Brezillon
299cd33c830SBoris Brezillon if (desc->ops->adjust_fmt) {
300cd33c830SBoris Brezillon int ret;
301cd33c830SBoris Brezillon
302cd33c830SBoris Brezillon ret = desc->ops->adjust_fmt(ctx, f);
303cd33c830SBoris Brezillon if (ret)
304cd33c830SBoris Brezillon return ret;
305cd33c830SBoris Brezillon }
306cd33c830SBoris Brezillon
307cd33c830SBoris Brezillon return 0;
308cd33c830SBoris Brezillon }
309cd33c830SBoris Brezillon
rkvdec_s_capture_fmt(struct file * file,void * priv,struct v4l2_format * f)310cd33c830SBoris Brezillon static int rkvdec_s_capture_fmt(struct file *file, void *priv,
311cd33c830SBoris Brezillon struct v4l2_format *f)
312cd33c830SBoris Brezillon {
313cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
3140887e9e1SChen-Yu Tsai struct vb2_queue *vq;
315cd33c830SBoris Brezillon int ret;
316cd33c830SBoris Brezillon
3170887e9e1SChen-Yu Tsai /* Change not allowed if queue is busy */
3180887e9e1SChen-Yu Tsai vq = v4l2_m2m_get_vq(ctx->fh.m2m_ctx,
3190887e9e1SChen-Yu Tsai V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE);
3200887e9e1SChen-Yu Tsai if (vb2_is_busy(vq))
3210887e9e1SChen-Yu Tsai return -EBUSY;
3220887e9e1SChen-Yu Tsai
3230887e9e1SChen-Yu Tsai ret = rkvdec_try_capture_fmt(file, priv, f);
324cd33c830SBoris Brezillon if (ret)
325cd33c830SBoris Brezillon return ret;
326cd33c830SBoris Brezillon
327cd33c830SBoris Brezillon ctx->decoded_fmt = *f;
328cd33c830SBoris Brezillon return 0;
329cd33c830SBoris Brezillon }
330cd33c830SBoris Brezillon
rkvdec_s_output_fmt(struct file * file,void * priv,struct v4l2_format * f)331cd33c830SBoris Brezillon static int rkvdec_s_output_fmt(struct file *file, void *priv,
332cd33c830SBoris Brezillon struct v4l2_format *f)
333cd33c830SBoris Brezillon {
334cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
335cd33c830SBoris Brezillon struct v4l2_m2m_ctx *m2m_ctx = ctx->fh.m2m_ctx;
336cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *desc;
337cd33c830SBoris Brezillon struct v4l2_format *cap_fmt;
3380887e9e1SChen-Yu Tsai struct vb2_queue *peer_vq, *vq;
339cd33c830SBoris Brezillon int ret;
340cd33c830SBoris Brezillon
341cd33c830SBoris Brezillon /*
3420887e9e1SChen-Yu Tsai * In order to support dynamic resolution change, the decoder admits
3430887e9e1SChen-Yu Tsai * a resolution change, as long as the pixelformat remains. Can't be
3440887e9e1SChen-Yu Tsai * done if streaming.
3450887e9e1SChen-Yu Tsai */
3460887e9e1SChen-Yu Tsai vq = v4l2_m2m_get_vq(m2m_ctx, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE);
3470887e9e1SChen-Yu Tsai if (vb2_is_streaming(vq) ||
3480887e9e1SChen-Yu Tsai (vb2_is_busy(vq) &&
3490887e9e1SChen-Yu Tsai f->fmt.pix_mp.pixelformat != ctx->coded_fmt.fmt.pix_mp.pixelformat))
3500887e9e1SChen-Yu Tsai return -EBUSY;
3510887e9e1SChen-Yu Tsai
3520887e9e1SChen-Yu Tsai /*
353cd33c830SBoris Brezillon * Since format change on the OUTPUT queue will reset the CAPTURE
354cd33c830SBoris Brezillon * queue, we can't allow doing so when the CAPTURE queue has buffers
355cd33c830SBoris Brezillon * allocated.
356cd33c830SBoris Brezillon */
357cd33c830SBoris Brezillon peer_vq = v4l2_m2m_get_vq(m2m_ctx, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE);
358cd33c830SBoris Brezillon if (vb2_is_busy(peer_vq))
359cd33c830SBoris Brezillon return -EBUSY;
360cd33c830SBoris Brezillon
3610887e9e1SChen-Yu Tsai ret = rkvdec_try_output_fmt(file, priv, f);
362cd33c830SBoris Brezillon if (ret)
363cd33c830SBoris Brezillon return ret;
364cd33c830SBoris Brezillon
365cd33c830SBoris Brezillon desc = rkvdec_find_coded_fmt_desc(f->fmt.pix_mp.pixelformat);
366cd33c830SBoris Brezillon if (!desc)
367cd33c830SBoris Brezillon return -EINVAL;
368cd33c830SBoris Brezillon ctx->coded_fmt_desc = desc;
369cd33c830SBoris Brezillon ctx->coded_fmt = *f;
370cd33c830SBoris Brezillon
371cd33c830SBoris Brezillon /*
372cd33c830SBoris Brezillon * Current decoded format might have become invalid with newly
373cd33c830SBoris Brezillon * selected codec, so reset it to default just to be safe and
374cd33c830SBoris Brezillon * keep internal driver state sane. User is mandated to set
375cd33c830SBoris Brezillon * the decoded format again after we return, so we don't need
376cd33c830SBoris Brezillon * anything smarter.
377cd33c830SBoris Brezillon *
378cd33c830SBoris Brezillon * Note that this will propagates any size changes to the decoded format.
379cd33c830SBoris Brezillon */
380cd33c830SBoris Brezillon rkvdec_reset_decoded_fmt(ctx);
381cd33c830SBoris Brezillon
382cd33c830SBoris Brezillon /* Propagate colorspace information to capture. */
383cd33c830SBoris Brezillon cap_fmt = &ctx->decoded_fmt;
384cd33c830SBoris Brezillon cap_fmt->fmt.pix_mp.colorspace = f->fmt.pix_mp.colorspace;
385cd33c830SBoris Brezillon cap_fmt->fmt.pix_mp.xfer_func = f->fmt.pix_mp.xfer_func;
386cd33c830SBoris Brezillon cap_fmt->fmt.pix_mp.ycbcr_enc = f->fmt.pix_mp.ycbcr_enc;
387cd33c830SBoris Brezillon cap_fmt->fmt.pix_mp.quantization = f->fmt.pix_mp.quantization;
388cd33c830SBoris Brezillon
389ed7bb87dSNicolas Dufresne /* Enable format specific queue features */
390ed7bb87dSNicolas Dufresne vq->subsystem_flags |= desc->subsystem_flags;
391ed7bb87dSNicolas Dufresne
392cd33c830SBoris Brezillon return 0;
393cd33c830SBoris Brezillon }
394cd33c830SBoris Brezillon
rkvdec_g_output_fmt(struct file * file,void * priv,struct v4l2_format * f)395cd33c830SBoris Brezillon static int rkvdec_g_output_fmt(struct file *file, void *priv,
396cd33c830SBoris Brezillon struct v4l2_format *f)
397cd33c830SBoris Brezillon {
398cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
399cd33c830SBoris Brezillon
400cd33c830SBoris Brezillon *f = ctx->coded_fmt;
401cd33c830SBoris Brezillon return 0;
402cd33c830SBoris Brezillon }
403cd33c830SBoris Brezillon
rkvdec_g_capture_fmt(struct file * file,void * priv,struct v4l2_format * f)404cd33c830SBoris Brezillon static int rkvdec_g_capture_fmt(struct file *file, void *priv,
405cd33c830SBoris Brezillon struct v4l2_format *f)
406cd33c830SBoris Brezillon {
407cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
408cd33c830SBoris Brezillon
409cd33c830SBoris Brezillon *f = ctx->decoded_fmt;
410cd33c830SBoris Brezillon return 0;
411cd33c830SBoris Brezillon }
412cd33c830SBoris Brezillon
rkvdec_enum_output_fmt(struct file * file,void * priv,struct v4l2_fmtdesc * f)413cd33c830SBoris Brezillon static int rkvdec_enum_output_fmt(struct file *file, void *priv,
414cd33c830SBoris Brezillon struct v4l2_fmtdesc *f)
415cd33c830SBoris Brezillon {
416cd33c830SBoris Brezillon if (f->index >= ARRAY_SIZE(rkvdec_coded_fmts))
417cd33c830SBoris Brezillon return -EINVAL;
418cd33c830SBoris Brezillon
419cd33c830SBoris Brezillon f->pixelformat = rkvdec_coded_fmts[f->index].fourcc;
420cd33c830SBoris Brezillon return 0;
421cd33c830SBoris Brezillon }
422cd33c830SBoris Brezillon
rkvdec_enum_capture_fmt(struct file * file,void * priv,struct v4l2_fmtdesc * f)423cd33c830SBoris Brezillon static int rkvdec_enum_capture_fmt(struct file *file, void *priv,
424cd33c830SBoris Brezillon struct v4l2_fmtdesc *f)
425cd33c830SBoris Brezillon {
426cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(priv);
427cd33c830SBoris Brezillon
428cd33c830SBoris Brezillon if (WARN_ON(!ctx->coded_fmt_desc))
429cd33c830SBoris Brezillon return -EINVAL;
430cd33c830SBoris Brezillon
431cd33c830SBoris Brezillon if (f->index >= ctx->coded_fmt_desc->num_decoded_fmts)
432cd33c830SBoris Brezillon return -EINVAL;
433cd33c830SBoris Brezillon
434cd33c830SBoris Brezillon f->pixelformat = ctx->coded_fmt_desc->decoded_fmts[f->index];
435cd33c830SBoris Brezillon return 0;
436cd33c830SBoris Brezillon }
437cd33c830SBoris Brezillon
438cd33c830SBoris Brezillon static const struct v4l2_ioctl_ops rkvdec_ioctl_ops = {
439cd33c830SBoris Brezillon .vidioc_querycap = rkvdec_querycap,
440cd33c830SBoris Brezillon .vidioc_enum_framesizes = rkvdec_enum_framesizes,
441cd33c830SBoris Brezillon
442cd33c830SBoris Brezillon .vidioc_try_fmt_vid_cap_mplane = rkvdec_try_capture_fmt,
443cd33c830SBoris Brezillon .vidioc_try_fmt_vid_out_mplane = rkvdec_try_output_fmt,
444cd33c830SBoris Brezillon .vidioc_s_fmt_vid_out_mplane = rkvdec_s_output_fmt,
445cd33c830SBoris Brezillon .vidioc_s_fmt_vid_cap_mplane = rkvdec_s_capture_fmt,
446cd33c830SBoris Brezillon .vidioc_g_fmt_vid_out_mplane = rkvdec_g_output_fmt,
447cd33c830SBoris Brezillon .vidioc_g_fmt_vid_cap_mplane = rkvdec_g_capture_fmt,
448cd33c830SBoris Brezillon .vidioc_enum_fmt_vid_out = rkvdec_enum_output_fmt,
449cd33c830SBoris Brezillon .vidioc_enum_fmt_vid_cap = rkvdec_enum_capture_fmt,
450cd33c830SBoris Brezillon
451cd33c830SBoris Brezillon .vidioc_reqbufs = v4l2_m2m_ioctl_reqbufs,
452cd33c830SBoris Brezillon .vidioc_querybuf = v4l2_m2m_ioctl_querybuf,
453cd33c830SBoris Brezillon .vidioc_qbuf = v4l2_m2m_ioctl_qbuf,
454cd33c830SBoris Brezillon .vidioc_dqbuf = v4l2_m2m_ioctl_dqbuf,
455cd33c830SBoris Brezillon .vidioc_prepare_buf = v4l2_m2m_ioctl_prepare_buf,
456cd33c830SBoris Brezillon .vidioc_create_bufs = v4l2_m2m_ioctl_create_bufs,
457cd33c830SBoris Brezillon .vidioc_expbuf = v4l2_m2m_ioctl_expbuf,
458cd33c830SBoris Brezillon
459cd33c830SBoris Brezillon .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
460cd33c830SBoris Brezillon .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
461cd33c830SBoris Brezillon
462cd33c830SBoris Brezillon .vidioc_streamon = v4l2_m2m_ioctl_streamon,
463cd33c830SBoris Brezillon .vidioc_streamoff = v4l2_m2m_ioctl_streamoff,
464*251743c4SPaul Kocialkowski
465*251743c4SPaul Kocialkowski .vidioc_decoder_cmd = v4l2_m2m_ioctl_stateless_decoder_cmd,
466*251743c4SPaul Kocialkowski .vidioc_try_decoder_cmd = v4l2_m2m_ioctl_stateless_try_decoder_cmd,
467cd33c830SBoris Brezillon };
468cd33c830SBoris Brezillon
rkvdec_queue_setup(struct vb2_queue * vq,unsigned int * num_buffers,unsigned int * num_planes,unsigned int sizes[],struct device * alloc_devs[])469cd33c830SBoris Brezillon static int rkvdec_queue_setup(struct vb2_queue *vq, unsigned int *num_buffers,
470cd33c830SBoris Brezillon unsigned int *num_planes, unsigned int sizes[],
471cd33c830SBoris Brezillon struct device *alloc_devs[])
472cd33c830SBoris Brezillon {
473cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(vq);
474cd33c830SBoris Brezillon struct v4l2_format *f;
475cd33c830SBoris Brezillon unsigned int i;
476cd33c830SBoris Brezillon
477cd33c830SBoris Brezillon if (V4L2_TYPE_IS_OUTPUT(vq->type))
478cd33c830SBoris Brezillon f = &ctx->coded_fmt;
479cd33c830SBoris Brezillon else
480cd33c830SBoris Brezillon f = &ctx->decoded_fmt;
481cd33c830SBoris Brezillon
482cd33c830SBoris Brezillon if (*num_planes) {
483cd33c830SBoris Brezillon if (*num_planes != f->fmt.pix_mp.num_planes)
484cd33c830SBoris Brezillon return -EINVAL;
485cd33c830SBoris Brezillon
486cd33c830SBoris Brezillon for (i = 0; i < f->fmt.pix_mp.num_planes; i++) {
487cd33c830SBoris Brezillon if (sizes[i] < f->fmt.pix_mp.plane_fmt[i].sizeimage)
488cd33c830SBoris Brezillon return -EINVAL;
489cd33c830SBoris Brezillon }
490cd33c830SBoris Brezillon } else {
491cd33c830SBoris Brezillon *num_planes = f->fmt.pix_mp.num_planes;
492cd33c830SBoris Brezillon for (i = 0; i < f->fmt.pix_mp.num_planes; i++)
493cd33c830SBoris Brezillon sizes[i] = f->fmt.pix_mp.plane_fmt[i].sizeimage;
494cd33c830SBoris Brezillon }
495cd33c830SBoris Brezillon
496cd33c830SBoris Brezillon return 0;
497cd33c830SBoris Brezillon }
498cd33c830SBoris Brezillon
rkvdec_buf_prepare(struct vb2_buffer * vb)499cd33c830SBoris Brezillon static int rkvdec_buf_prepare(struct vb2_buffer *vb)
500cd33c830SBoris Brezillon {
501cd33c830SBoris Brezillon struct vb2_queue *vq = vb->vb2_queue;
502cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(vq);
503cd33c830SBoris Brezillon struct v4l2_format *f;
504cd33c830SBoris Brezillon unsigned int i;
505cd33c830SBoris Brezillon
506cd33c830SBoris Brezillon if (V4L2_TYPE_IS_OUTPUT(vq->type))
507cd33c830SBoris Brezillon f = &ctx->coded_fmt;
508cd33c830SBoris Brezillon else
509cd33c830SBoris Brezillon f = &ctx->decoded_fmt;
510cd33c830SBoris Brezillon
511cd33c830SBoris Brezillon for (i = 0; i < f->fmt.pix_mp.num_planes; ++i) {
512cd33c830SBoris Brezillon u32 sizeimage = f->fmt.pix_mp.plane_fmt[i].sizeimage;
513cd33c830SBoris Brezillon
514cd33c830SBoris Brezillon if (vb2_plane_size(vb, i) < sizeimage)
515cd33c830SBoris Brezillon return -EINVAL;
516cd33c830SBoris Brezillon }
517ba1ed4aeSEzequiel Garcia
518ba1ed4aeSEzequiel Garcia /*
519ba1ed4aeSEzequiel Garcia * Buffer's bytesused must be written by driver for CAPTURE buffers.
520ba1ed4aeSEzequiel Garcia * (for OUTPUT buffers, if userspace passes 0 bytesused, v4l2-core sets
521ba1ed4aeSEzequiel Garcia * it to buffer length).
522ba1ed4aeSEzequiel Garcia */
523ba1ed4aeSEzequiel Garcia if (V4L2_TYPE_IS_CAPTURE(vq->type))
524cd33c830SBoris Brezillon vb2_set_plane_payload(vb, 0, f->fmt.pix_mp.plane_fmt[0].sizeimage);
525ba1ed4aeSEzequiel Garcia
526cd33c830SBoris Brezillon return 0;
527cd33c830SBoris Brezillon }
528cd33c830SBoris Brezillon
rkvdec_buf_queue(struct vb2_buffer * vb)529cd33c830SBoris Brezillon static void rkvdec_buf_queue(struct vb2_buffer *vb)
530cd33c830SBoris Brezillon {
531cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
532cd33c830SBoris Brezillon struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
533cd33c830SBoris Brezillon
534cd33c830SBoris Brezillon v4l2_m2m_buf_queue(ctx->fh.m2m_ctx, vbuf);
535cd33c830SBoris Brezillon }
536cd33c830SBoris Brezillon
rkvdec_buf_out_validate(struct vb2_buffer * vb)537cd33c830SBoris Brezillon static int rkvdec_buf_out_validate(struct vb2_buffer *vb)
538cd33c830SBoris Brezillon {
539cd33c830SBoris Brezillon struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
540cd33c830SBoris Brezillon
541cd33c830SBoris Brezillon vbuf->field = V4L2_FIELD_NONE;
542cd33c830SBoris Brezillon return 0;
543cd33c830SBoris Brezillon }
544cd33c830SBoris Brezillon
rkvdec_buf_request_complete(struct vb2_buffer * vb)545cd33c830SBoris Brezillon static void rkvdec_buf_request_complete(struct vb2_buffer *vb)
546cd33c830SBoris Brezillon {
547cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
548cd33c830SBoris Brezillon
549cd33c830SBoris Brezillon v4l2_ctrl_request_complete(vb->req_obj.req, &ctx->ctrl_hdl);
550cd33c830SBoris Brezillon }
551cd33c830SBoris Brezillon
rkvdec_start_streaming(struct vb2_queue * q,unsigned int count)552cd33c830SBoris Brezillon static int rkvdec_start_streaming(struct vb2_queue *q, unsigned int count)
553cd33c830SBoris Brezillon {
554cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(q);
555cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *desc;
556cd33c830SBoris Brezillon int ret;
557cd33c830SBoris Brezillon
558b3ab1c60SEzequiel Garcia if (V4L2_TYPE_IS_CAPTURE(q->type))
559cd33c830SBoris Brezillon return 0;
560cd33c830SBoris Brezillon
561cd33c830SBoris Brezillon desc = ctx->coded_fmt_desc;
562cd33c830SBoris Brezillon if (WARN_ON(!desc))
563cd33c830SBoris Brezillon return -EINVAL;
564cd33c830SBoris Brezillon
565cd33c830SBoris Brezillon if (desc->ops->start) {
566cd33c830SBoris Brezillon ret = desc->ops->start(ctx);
567cd33c830SBoris Brezillon if (ret)
568cd33c830SBoris Brezillon return ret;
569cd33c830SBoris Brezillon }
570cd33c830SBoris Brezillon
571cd33c830SBoris Brezillon return 0;
572cd33c830SBoris Brezillon }
573cd33c830SBoris Brezillon
rkvdec_queue_cleanup(struct vb2_queue * vq,u32 state)574cd33c830SBoris Brezillon static void rkvdec_queue_cleanup(struct vb2_queue *vq, u32 state)
575cd33c830SBoris Brezillon {
576cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(vq);
577cd33c830SBoris Brezillon
578cd33c830SBoris Brezillon while (true) {
579cd33c830SBoris Brezillon struct vb2_v4l2_buffer *vbuf;
580cd33c830SBoris Brezillon
581cd33c830SBoris Brezillon if (V4L2_TYPE_IS_OUTPUT(vq->type))
582cd33c830SBoris Brezillon vbuf = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
583cd33c830SBoris Brezillon else
584cd33c830SBoris Brezillon vbuf = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx);
585cd33c830SBoris Brezillon
586cd33c830SBoris Brezillon if (!vbuf)
587cd33c830SBoris Brezillon break;
588cd33c830SBoris Brezillon
589cd33c830SBoris Brezillon v4l2_ctrl_request_complete(vbuf->vb2_buf.req_obj.req,
590cd33c830SBoris Brezillon &ctx->ctrl_hdl);
591cd33c830SBoris Brezillon v4l2_m2m_buf_done(vbuf, state);
592cd33c830SBoris Brezillon }
593cd33c830SBoris Brezillon }
594cd33c830SBoris Brezillon
rkvdec_stop_streaming(struct vb2_queue * q)595cd33c830SBoris Brezillon static void rkvdec_stop_streaming(struct vb2_queue *q)
596cd33c830SBoris Brezillon {
597cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = vb2_get_drv_priv(q);
598cd33c830SBoris Brezillon
599cd33c830SBoris Brezillon if (V4L2_TYPE_IS_OUTPUT(q->type)) {
600cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *desc = ctx->coded_fmt_desc;
601cd33c830SBoris Brezillon
602cd33c830SBoris Brezillon if (WARN_ON(!desc))
603cd33c830SBoris Brezillon return;
604cd33c830SBoris Brezillon
605cd33c830SBoris Brezillon if (desc->ops->stop)
606cd33c830SBoris Brezillon desc->ops->stop(ctx);
607cd33c830SBoris Brezillon }
608cd33c830SBoris Brezillon
609cd33c830SBoris Brezillon rkvdec_queue_cleanup(q, VB2_BUF_STATE_ERROR);
610cd33c830SBoris Brezillon }
611cd33c830SBoris Brezillon
612cd33c830SBoris Brezillon static const struct vb2_ops rkvdec_queue_ops = {
613cd33c830SBoris Brezillon .queue_setup = rkvdec_queue_setup,
614cd33c830SBoris Brezillon .buf_prepare = rkvdec_buf_prepare,
615cd33c830SBoris Brezillon .buf_queue = rkvdec_buf_queue,
616cd33c830SBoris Brezillon .buf_out_validate = rkvdec_buf_out_validate,
617cd33c830SBoris Brezillon .buf_request_complete = rkvdec_buf_request_complete,
618cd33c830SBoris Brezillon .start_streaming = rkvdec_start_streaming,
619cd33c830SBoris Brezillon .stop_streaming = rkvdec_stop_streaming,
620cd33c830SBoris Brezillon .wait_prepare = vb2_ops_wait_prepare,
621cd33c830SBoris Brezillon .wait_finish = vb2_ops_wait_finish,
622cd33c830SBoris Brezillon };
623cd33c830SBoris Brezillon
rkvdec_request_validate(struct media_request * req)624cd33c830SBoris Brezillon static int rkvdec_request_validate(struct media_request *req)
625cd33c830SBoris Brezillon {
62654676d5fSDaniel Almeida unsigned int count;
627cd33c830SBoris Brezillon
628cd33c830SBoris Brezillon count = vb2_request_buffer_cnt(req);
629cd33c830SBoris Brezillon if (!count)
630cd33c830SBoris Brezillon return -ENOENT;
631cd33c830SBoris Brezillon else if (count > 1)
632cd33c830SBoris Brezillon return -EINVAL;
633cd33c830SBoris Brezillon
634cd33c830SBoris Brezillon return vb2_request_validate(req);
635cd33c830SBoris Brezillon }
636cd33c830SBoris Brezillon
637cd33c830SBoris Brezillon static const struct media_device_ops rkvdec_media_ops = {
638cd33c830SBoris Brezillon .req_validate = rkvdec_request_validate,
639cd33c830SBoris Brezillon .req_queue = v4l2_m2m_request_queue,
640cd33c830SBoris Brezillon };
641cd33c830SBoris Brezillon
rkvdec_job_finish_no_pm(struct rkvdec_ctx * ctx,enum vb2_buffer_state result)642cd33c830SBoris Brezillon static void rkvdec_job_finish_no_pm(struct rkvdec_ctx *ctx,
643cd33c830SBoris Brezillon enum vb2_buffer_state result)
644cd33c830SBoris Brezillon {
645cd33c830SBoris Brezillon if (ctx->coded_fmt_desc->ops->done) {
646cd33c830SBoris Brezillon struct vb2_v4l2_buffer *src_buf, *dst_buf;
647cd33c830SBoris Brezillon
648cd33c830SBoris Brezillon src_buf = v4l2_m2m_next_src_buf(ctx->fh.m2m_ctx);
649cd33c830SBoris Brezillon dst_buf = v4l2_m2m_next_dst_buf(ctx->fh.m2m_ctx);
650cd33c830SBoris Brezillon ctx->coded_fmt_desc->ops->done(ctx, src_buf, dst_buf, result);
651cd33c830SBoris Brezillon }
652cd33c830SBoris Brezillon
653cd33c830SBoris Brezillon v4l2_m2m_buf_done_and_job_finish(ctx->dev->m2m_dev, ctx->fh.m2m_ctx,
654cd33c830SBoris Brezillon result);
655cd33c830SBoris Brezillon }
656cd33c830SBoris Brezillon
rkvdec_job_finish(struct rkvdec_ctx * ctx,enum vb2_buffer_state result)657cd33c830SBoris Brezillon static void rkvdec_job_finish(struct rkvdec_ctx *ctx,
658cd33c830SBoris Brezillon enum vb2_buffer_state result)
659cd33c830SBoris Brezillon {
660cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = ctx->dev;
661cd33c830SBoris Brezillon
662cd33c830SBoris Brezillon pm_runtime_mark_last_busy(rkvdec->dev);
663cd33c830SBoris Brezillon pm_runtime_put_autosuspend(rkvdec->dev);
664cd33c830SBoris Brezillon rkvdec_job_finish_no_pm(ctx, result);
665cd33c830SBoris Brezillon }
666cd33c830SBoris Brezillon
rkvdec_run_preamble(struct rkvdec_ctx * ctx,struct rkvdec_run * run)667cd33c830SBoris Brezillon void rkvdec_run_preamble(struct rkvdec_ctx *ctx, struct rkvdec_run *run)
668cd33c830SBoris Brezillon {
669cd33c830SBoris Brezillon struct media_request *src_req;
670cd33c830SBoris Brezillon
671cd33c830SBoris Brezillon memset(run, 0, sizeof(*run));
672cd33c830SBoris Brezillon
673cd33c830SBoris Brezillon run->bufs.src = v4l2_m2m_next_src_buf(ctx->fh.m2m_ctx);
674cd33c830SBoris Brezillon run->bufs.dst = v4l2_m2m_next_dst_buf(ctx->fh.m2m_ctx);
675cd33c830SBoris Brezillon
676cd33c830SBoris Brezillon /* Apply request(s) controls if needed. */
677cd33c830SBoris Brezillon src_req = run->bufs.src->vb2_buf.req_obj.req;
678cd33c830SBoris Brezillon if (src_req)
679cd33c830SBoris Brezillon v4l2_ctrl_request_setup(src_req, &ctx->ctrl_hdl);
680cd33c830SBoris Brezillon
681cd33c830SBoris Brezillon v4l2_m2m_buf_copy_metadata(run->bufs.src, run->bufs.dst, true);
682cd33c830SBoris Brezillon }
683cd33c830SBoris Brezillon
rkvdec_run_postamble(struct rkvdec_ctx * ctx,struct rkvdec_run * run)684cd33c830SBoris Brezillon void rkvdec_run_postamble(struct rkvdec_ctx *ctx, struct rkvdec_run *run)
685cd33c830SBoris Brezillon {
686cd33c830SBoris Brezillon struct media_request *src_req = run->bufs.src->vb2_buf.req_obj.req;
687cd33c830SBoris Brezillon
688cd33c830SBoris Brezillon if (src_req)
689cd33c830SBoris Brezillon v4l2_ctrl_request_complete(src_req, &ctx->ctrl_hdl);
690cd33c830SBoris Brezillon }
691cd33c830SBoris Brezillon
rkvdec_device_run(void * priv)692cd33c830SBoris Brezillon static void rkvdec_device_run(void *priv)
693cd33c830SBoris Brezillon {
694cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = priv;
695cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = ctx->dev;
696cd33c830SBoris Brezillon const struct rkvdec_coded_fmt_desc *desc = ctx->coded_fmt_desc;
697cd33c830SBoris Brezillon int ret;
698cd33c830SBoris Brezillon
699cd33c830SBoris Brezillon if (WARN_ON(!desc))
700cd33c830SBoris Brezillon return;
701cd33c830SBoris Brezillon
702e90812c4SMauro Carvalho Chehab ret = pm_runtime_resume_and_get(rkvdec->dev);
703cd33c830SBoris Brezillon if (ret < 0) {
704cd33c830SBoris Brezillon rkvdec_job_finish_no_pm(ctx, VB2_BUF_STATE_ERROR);
705cd33c830SBoris Brezillon return;
706cd33c830SBoris Brezillon }
707cd33c830SBoris Brezillon
708cd33c830SBoris Brezillon ret = desc->ops->run(ctx);
709cd33c830SBoris Brezillon if (ret)
710cd33c830SBoris Brezillon rkvdec_job_finish(ctx, VB2_BUF_STATE_ERROR);
711cd33c830SBoris Brezillon }
712cd33c830SBoris Brezillon
71330162960SRikard Falkeborn static const struct v4l2_m2m_ops rkvdec_m2m_ops = {
714cd33c830SBoris Brezillon .device_run = rkvdec_device_run,
715cd33c830SBoris Brezillon };
716cd33c830SBoris Brezillon
rkvdec_queue_init(void * priv,struct vb2_queue * src_vq,struct vb2_queue * dst_vq)717cd33c830SBoris Brezillon static int rkvdec_queue_init(void *priv,
718cd33c830SBoris Brezillon struct vb2_queue *src_vq,
719cd33c830SBoris Brezillon struct vb2_queue *dst_vq)
720cd33c830SBoris Brezillon {
721cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = priv;
722cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = ctx->dev;
723cd33c830SBoris Brezillon int ret;
724cd33c830SBoris Brezillon
725cd33c830SBoris Brezillon src_vq->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
726cd33c830SBoris Brezillon src_vq->io_modes = VB2_MMAP | VB2_DMABUF;
727cd33c830SBoris Brezillon src_vq->drv_priv = ctx;
728cd33c830SBoris Brezillon src_vq->ops = &rkvdec_queue_ops;
729cd33c830SBoris Brezillon src_vq->mem_ops = &vb2_dma_contig_memops;
730cd33c830SBoris Brezillon
731cd33c830SBoris Brezillon /*
732cd33c830SBoris Brezillon * Driver does mostly sequential access, so sacrifice TLB efficiency
733cd33c830SBoris Brezillon * for faster allocation. Also, no CPU access on the source queue,
734cd33c830SBoris Brezillon * so no kernel mapping needed.
735cd33c830SBoris Brezillon */
736cd33c830SBoris Brezillon src_vq->dma_attrs = DMA_ATTR_ALLOC_SINGLE_PAGES |
737cd33c830SBoris Brezillon DMA_ATTR_NO_KERNEL_MAPPING;
738cd33c830SBoris Brezillon src_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer);
739cd33c830SBoris Brezillon src_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
740cd33c830SBoris Brezillon src_vq->lock = &rkvdec->vdev_lock;
741cd33c830SBoris Brezillon src_vq->dev = rkvdec->v4l2_dev.dev;
742cd33c830SBoris Brezillon src_vq->supports_requests = true;
743cd33c830SBoris Brezillon src_vq->requires_requests = true;
744cd33c830SBoris Brezillon
745cd33c830SBoris Brezillon ret = vb2_queue_init(src_vq);
746cd33c830SBoris Brezillon if (ret)
747cd33c830SBoris Brezillon return ret;
748cd33c830SBoris Brezillon
749cd33c830SBoris Brezillon dst_vq->bidirectional = true;
750cd33c830SBoris Brezillon dst_vq->mem_ops = &vb2_dma_contig_memops;
751cd33c830SBoris Brezillon dst_vq->dma_attrs = DMA_ATTR_ALLOC_SINGLE_PAGES |
752cd33c830SBoris Brezillon DMA_ATTR_NO_KERNEL_MAPPING;
753cd33c830SBoris Brezillon dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
754cd33c830SBoris Brezillon dst_vq->io_modes = VB2_MMAP | VB2_DMABUF;
755cd33c830SBoris Brezillon dst_vq->drv_priv = ctx;
756cd33c830SBoris Brezillon dst_vq->ops = &rkvdec_queue_ops;
757cd33c830SBoris Brezillon dst_vq->buf_struct_size = sizeof(struct rkvdec_decoded_buffer);
758cd33c830SBoris Brezillon dst_vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_COPY;
759cd33c830SBoris Brezillon dst_vq->lock = &rkvdec->vdev_lock;
760cd33c830SBoris Brezillon dst_vq->dev = rkvdec->v4l2_dev.dev;
761cd33c830SBoris Brezillon
762cd33c830SBoris Brezillon return vb2_queue_init(dst_vq);
763cd33c830SBoris Brezillon }
764cd33c830SBoris Brezillon
rkvdec_add_ctrls(struct rkvdec_ctx * ctx,const struct rkvdec_ctrls * ctrls)765cd33c830SBoris Brezillon static int rkvdec_add_ctrls(struct rkvdec_ctx *ctx,
766cd33c830SBoris Brezillon const struct rkvdec_ctrls *ctrls)
767cd33c830SBoris Brezillon {
768cd33c830SBoris Brezillon unsigned int i;
769cd33c830SBoris Brezillon
770cd33c830SBoris Brezillon for (i = 0; i < ctrls->num_ctrls; i++) {
771cd33c830SBoris Brezillon const struct v4l2_ctrl_config *cfg = &ctrls->ctrls[i].cfg;
772cd33c830SBoris Brezillon
773cd33c830SBoris Brezillon v4l2_ctrl_new_custom(&ctx->ctrl_hdl, cfg, ctx);
774cd33c830SBoris Brezillon if (ctx->ctrl_hdl.error)
775cd33c830SBoris Brezillon return ctx->ctrl_hdl.error;
776cd33c830SBoris Brezillon }
777cd33c830SBoris Brezillon
778cd33c830SBoris Brezillon return 0;
779cd33c830SBoris Brezillon }
780cd33c830SBoris Brezillon
rkvdec_init_ctrls(struct rkvdec_ctx * ctx)781cd33c830SBoris Brezillon static int rkvdec_init_ctrls(struct rkvdec_ctx *ctx)
782cd33c830SBoris Brezillon {
783cd33c830SBoris Brezillon unsigned int i, nctrls = 0;
784cd33c830SBoris Brezillon int ret;
785cd33c830SBoris Brezillon
786cd33c830SBoris Brezillon for (i = 0; i < ARRAY_SIZE(rkvdec_coded_fmts); i++)
787cd33c830SBoris Brezillon nctrls += rkvdec_coded_fmts[i].ctrls->num_ctrls;
788cd33c830SBoris Brezillon
789cd33c830SBoris Brezillon v4l2_ctrl_handler_init(&ctx->ctrl_hdl, nctrls);
790cd33c830SBoris Brezillon
791cd33c830SBoris Brezillon for (i = 0; i < ARRAY_SIZE(rkvdec_coded_fmts); i++) {
792cd33c830SBoris Brezillon ret = rkvdec_add_ctrls(ctx, rkvdec_coded_fmts[i].ctrls);
793cd33c830SBoris Brezillon if (ret)
794cd33c830SBoris Brezillon goto err_free_handler;
795cd33c830SBoris Brezillon }
796cd33c830SBoris Brezillon
797cd33c830SBoris Brezillon ret = v4l2_ctrl_handler_setup(&ctx->ctrl_hdl);
798cd33c830SBoris Brezillon if (ret)
799cd33c830SBoris Brezillon goto err_free_handler;
800cd33c830SBoris Brezillon
801cd33c830SBoris Brezillon ctx->fh.ctrl_handler = &ctx->ctrl_hdl;
802cd33c830SBoris Brezillon return 0;
803cd33c830SBoris Brezillon
804cd33c830SBoris Brezillon err_free_handler:
805cd33c830SBoris Brezillon v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
806cd33c830SBoris Brezillon return ret;
807cd33c830SBoris Brezillon }
808cd33c830SBoris Brezillon
rkvdec_open(struct file * filp)809cd33c830SBoris Brezillon static int rkvdec_open(struct file *filp)
810cd33c830SBoris Brezillon {
811cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = video_drvdata(filp);
812cd33c830SBoris Brezillon struct rkvdec_ctx *ctx;
813cd33c830SBoris Brezillon int ret;
814cd33c830SBoris Brezillon
815cd33c830SBoris Brezillon ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
816cd33c830SBoris Brezillon if (!ctx)
817cd33c830SBoris Brezillon return -ENOMEM;
818cd33c830SBoris Brezillon
819cd33c830SBoris Brezillon ctx->dev = rkvdec;
820cd33c830SBoris Brezillon rkvdec_reset_coded_fmt(ctx);
821cd33c830SBoris Brezillon rkvdec_reset_decoded_fmt(ctx);
822cd33c830SBoris Brezillon v4l2_fh_init(&ctx->fh, video_devdata(filp));
823cd33c830SBoris Brezillon
824cd33c830SBoris Brezillon ret = rkvdec_init_ctrls(ctx);
825cd33c830SBoris Brezillon if (ret)
826cd33c830SBoris Brezillon goto err_free_ctx;
827cd33c830SBoris Brezillon
828cd33c830SBoris Brezillon ctx->fh.m2m_ctx = v4l2_m2m_ctx_init(rkvdec->m2m_dev, ctx,
829cd33c830SBoris Brezillon rkvdec_queue_init);
830cd33c830SBoris Brezillon if (IS_ERR(ctx->fh.m2m_ctx)) {
831cd33c830SBoris Brezillon ret = PTR_ERR(ctx->fh.m2m_ctx);
832cd33c830SBoris Brezillon goto err_cleanup_ctrls;
833cd33c830SBoris Brezillon }
834cd33c830SBoris Brezillon
835cd33c830SBoris Brezillon filp->private_data = &ctx->fh;
836cd33c830SBoris Brezillon v4l2_fh_add(&ctx->fh);
837cd33c830SBoris Brezillon
838cd33c830SBoris Brezillon return 0;
839cd33c830SBoris Brezillon
840cd33c830SBoris Brezillon err_cleanup_ctrls:
841cd33c830SBoris Brezillon v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
842cd33c830SBoris Brezillon
843cd33c830SBoris Brezillon err_free_ctx:
844cd33c830SBoris Brezillon kfree(ctx);
845cd33c830SBoris Brezillon return ret;
846cd33c830SBoris Brezillon }
847cd33c830SBoris Brezillon
rkvdec_release(struct file * filp)848cd33c830SBoris Brezillon static int rkvdec_release(struct file *filp)
849cd33c830SBoris Brezillon {
850cd33c830SBoris Brezillon struct rkvdec_ctx *ctx = fh_to_rkvdec_ctx(filp->private_data);
851cd33c830SBoris Brezillon
852cd33c830SBoris Brezillon v4l2_fh_del(&ctx->fh);
853cd33c830SBoris Brezillon v4l2_m2m_ctx_release(ctx->fh.m2m_ctx);
854cd33c830SBoris Brezillon v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
855cd33c830SBoris Brezillon v4l2_fh_exit(&ctx->fh);
856cd33c830SBoris Brezillon kfree(ctx);
857cd33c830SBoris Brezillon
858cd33c830SBoris Brezillon return 0;
859cd33c830SBoris Brezillon }
860cd33c830SBoris Brezillon
861cd33c830SBoris Brezillon static const struct v4l2_file_operations rkvdec_fops = {
862cd33c830SBoris Brezillon .owner = THIS_MODULE,
863cd33c830SBoris Brezillon .open = rkvdec_open,
864cd33c830SBoris Brezillon .release = rkvdec_release,
865cd33c830SBoris Brezillon .poll = v4l2_m2m_fop_poll,
866cd33c830SBoris Brezillon .unlocked_ioctl = video_ioctl2,
867cd33c830SBoris Brezillon .mmap = v4l2_m2m_fop_mmap,
868cd33c830SBoris Brezillon };
869cd33c830SBoris Brezillon
rkvdec_v4l2_init(struct rkvdec_dev * rkvdec)870cd33c830SBoris Brezillon static int rkvdec_v4l2_init(struct rkvdec_dev *rkvdec)
871cd33c830SBoris Brezillon {
872cd33c830SBoris Brezillon int ret;
873cd33c830SBoris Brezillon
874cd33c830SBoris Brezillon ret = v4l2_device_register(rkvdec->dev, &rkvdec->v4l2_dev);
875cd33c830SBoris Brezillon if (ret) {
876cd33c830SBoris Brezillon dev_err(rkvdec->dev, "Failed to register V4L2 device\n");
877cd33c830SBoris Brezillon return ret;
878cd33c830SBoris Brezillon }
879cd33c830SBoris Brezillon
880cd33c830SBoris Brezillon rkvdec->m2m_dev = v4l2_m2m_init(&rkvdec_m2m_ops);
881cd33c830SBoris Brezillon if (IS_ERR(rkvdec->m2m_dev)) {
882cd33c830SBoris Brezillon v4l2_err(&rkvdec->v4l2_dev, "Failed to init mem2mem device\n");
883cd33c830SBoris Brezillon ret = PTR_ERR(rkvdec->m2m_dev);
884cd33c830SBoris Brezillon goto err_unregister_v4l2;
885cd33c830SBoris Brezillon }
886cd33c830SBoris Brezillon
887cd33c830SBoris Brezillon rkvdec->mdev.dev = rkvdec->dev;
888cd33c830SBoris Brezillon strscpy(rkvdec->mdev.model, "rkvdec", sizeof(rkvdec->mdev.model));
889cd33c830SBoris Brezillon strscpy(rkvdec->mdev.bus_info, "platform:rkvdec",
890cd33c830SBoris Brezillon sizeof(rkvdec->mdev.bus_info));
891cd33c830SBoris Brezillon media_device_init(&rkvdec->mdev);
892cd33c830SBoris Brezillon rkvdec->mdev.ops = &rkvdec_media_ops;
893cd33c830SBoris Brezillon rkvdec->v4l2_dev.mdev = &rkvdec->mdev;
894cd33c830SBoris Brezillon
895cd33c830SBoris Brezillon rkvdec->vdev.lock = &rkvdec->vdev_lock;
896cd33c830SBoris Brezillon rkvdec->vdev.v4l2_dev = &rkvdec->v4l2_dev;
897cd33c830SBoris Brezillon rkvdec->vdev.fops = &rkvdec_fops;
898cd33c830SBoris Brezillon rkvdec->vdev.release = video_device_release_empty;
899cd33c830SBoris Brezillon rkvdec->vdev.vfl_dir = VFL_DIR_M2M;
900cd33c830SBoris Brezillon rkvdec->vdev.device_caps = V4L2_CAP_STREAMING |
901cd33c830SBoris Brezillon V4L2_CAP_VIDEO_M2M_MPLANE;
902cd33c830SBoris Brezillon rkvdec->vdev.ioctl_ops = &rkvdec_ioctl_ops;
903cd33c830SBoris Brezillon video_set_drvdata(&rkvdec->vdev, rkvdec);
904cd33c830SBoris Brezillon strscpy(rkvdec->vdev.name, "rkvdec", sizeof(rkvdec->vdev.name));
905cd33c830SBoris Brezillon
906cd33c830SBoris Brezillon ret = video_register_device(&rkvdec->vdev, VFL_TYPE_VIDEO, -1);
907cd33c830SBoris Brezillon if (ret) {
908cd33c830SBoris Brezillon v4l2_err(&rkvdec->v4l2_dev, "Failed to register video device\n");
909cd33c830SBoris Brezillon goto err_cleanup_mc;
910cd33c830SBoris Brezillon }
911cd33c830SBoris Brezillon
912cd33c830SBoris Brezillon ret = v4l2_m2m_register_media_controller(rkvdec->m2m_dev, &rkvdec->vdev,
913cd33c830SBoris Brezillon MEDIA_ENT_F_PROC_VIDEO_DECODER);
914cd33c830SBoris Brezillon if (ret) {
915cd33c830SBoris Brezillon v4l2_err(&rkvdec->v4l2_dev,
916cd33c830SBoris Brezillon "Failed to initialize V4L2 M2M media controller\n");
917cd33c830SBoris Brezillon goto err_unregister_vdev;
918cd33c830SBoris Brezillon }
919cd33c830SBoris Brezillon
920cd33c830SBoris Brezillon ret = media_device_register(&rkvdec->mdev);
921cd33c830SBoris Brezillon if (ret) {
922cd33c830SBoris Brezillon v4l2_err(&rkvdec->v4l2_dev, "Failed to register media device\n");
923cd33c830SBoris Brezillon goto err_unregister_mc;
924cd33c830SBoris Brezillon }
925cd33c830SBoris Brezillon
926cd33c830SBoris Brezillon return 0;
927cd33c830SBoris Brezillon
928cd33c830SBoris Brezillon err_unregister_mc:
929cd33c830SBoris Brezillon v4l2_m2m_unregister_media_controller(rkvdec->m2m_dev);
930cd33c830SBoris Brezillon
931cd33c830SBoris Brezillon err_unregister_vdev:
932cd33c830SBoris Brezillon video_unregister_device(&rkvdec->vdev);
933cd33c830SBoris Brezillon
934cd33c830SBoris Brezillon err_cleanup_mc:
935cd33c830SBoris Brezillon media_device_cleanup(&rkvdec->mdev);
936cd33c830SBoris Brezillon v4l2_m2m_release(rkvdec->m2m_dev);
937cd33c830SBoris Brezillon
938cd33c830SBoris Brezillon err_unregister_v4l2:
939cd33c830SBoris Brezillon v4l2_device_unregister(&rkvdec->v4l2_dev);
940cd33c830SBoris Brezillon return ret;
941cd33c830SBoris Brezillon }
942cd33c830SBoris Brezillon
rkvdec_v4l2_cleanup(struct rkvdec_dev * rkvdec)943cd33c830SBoris Brezillon static void rkvdec_v4l2_cleanup(struct rkvdec_dev *rkvdec)
944cd33c830SBoris Brezillon {
945cd33c830SBoris Brezillon media_device_unregister(&rkvdec->mdev);
946cd33c830SBoris Brezillon v4l2_m2m_unregister_media_controller(rkvdec->m2m_dev);
947cd33c830SBoris Brezillon video_unregister_device(&rkvdec->vdev);
948cd33c830SBoris Brezillon media_device_cleanup(&rkvdec->mdev);
949cd33c830SBoris Brezillon v4l2_m2m_release(rkvdec->m2m_dev);
950cd33c830SBoris Brezillon v4l2_device_unregister(&rkvdec->v4l2_dev);
951cd33c830SBoris Brezillon }
952cd33c830SBoris Brezillon
rkvdec_irq_handler(int irq,void * priv)953cd33c830SBoris Brezillon static irqreturn_t rkvdec_irq_handler(int irq, void *priv)
954cd33c830SBoris Brezillon {
955cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = priv;
956cd33c830SBoris Brezillon enum vb2_buffer_state state;
957cd33c830SBoris Brezillon u32 status;
958cd33c830SBoris Brezillon
959cd33c830SBoris Brezillon status = readl(rkvdec->regs + RKVDEC_REG_INTERRUPT);
960cd33c830SBoris Brezillon state = (status & RKVDEC_RDY_STA) ?
961cd33c830SBoris Brezillon VB2_BUF_STATE_DONE : VB2_BUF_STATE_ERROR;
962cd33c830SBoris Brezillon
963cd33c830SBoris Brezillon writel(0, rkvdec->regs + RKVDEC_REG_INTERRUPT);
964cd33c830SBoris Brezillon if (cancel_delayed_work(&rkvdec->watchdog_work)) {
965cd33c830SBoris Brezillon struct rkvdec_ctx *ctx;
966cd33c830SBoris Brezillon
967cd33c830SBoris Brezillon ctx = v4l2_m2m_get_curr_priv(rkvdec->m2m_dev);
968cd33c830SBoris Brezillon rkvdec_job_finish(ctx, state);
969cd33c830SBoris Brezillon }
970cd33c830SBoris Brezillon
971cd33c830SBoris Brezillon return IRQ_HANDLED;
972cd33c830SBoris Brezillon }
973cd33c830SBoris Brezillon
rkvdec_watchdog_func(struct work_struct * work)974cd33c830SBoris Brezillon static void rkvdec_watchdog_func(struct work_struct *work)
975cd33c830SBoris Brezillon {
976cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec;
977cd33c830SBoris Brezillon struct rkvdec_ctx *ctx;
978cd33c830SBoris Brezillon
979cd33c830SBoris Brezillon rkvdec = container_of(to_delayed_work(work), struct rkvdec_dev,
980cd33c830SBoris Brezillon watchdog_work);
981cd33c830SBoris Brezillon ctx = v4l2_m2m_get_curr_priv(rkvdec->m2m_dev);
982cd33c830SBoris Brezillon if (ctx) {
983cd33c830SBoris Brezillon dev_err(rkvdec->dev, "Frame processing timed out!\n");
984cd33c830SBoris Brezillon writel(RKVDEC_IRQ_DIS, rkvdec->regs + RKVDEC_REG_INTERRUPT);
985cd33c830SBoris Brezillon writel(0, rkvdec->regs + RKVDEC_REG_SYSCTRL);
986cd33c830SBoris Brezillon rkvdec_job_finish(ctx, VB2_BUF_STATE_ERROR);
987cd33c830SBoris Brezillon }
988cd33c830SBoris Brezillon }
989cd33c830SBoris Brezillon
990cd33c830SBoris Brezillon static const struct of_device_id of_rkvdec_match[] = {
991cd33c830SBoris Brezillon { .compatible = "rockchip,rk3399-vdec" },
992cd33c830SBoris Brezillon { /* sentinel */ }
993cd33c830SBoris Brezillon };
994cd33c830SBoris Brezillon MODULE_DEVICE_TABLE(of, of_rkvdec_match);
995cd33c830SBoris Brezillon
996cd33c830SBoris Brezillon static const char * const rkvdec_clk_names[] = {
997cd33c830SBoris Brezillon "axi", "ahb", "cabac", "core"
998cd33c830SBoris Brezillon };
999cd33c830SBoris Brezillon
rkvdec_probe(struct platform_device * pdev)1000cd33c830SBoris Brezillon static int rkvdec_probe(struct platform_device *pdev)
1001cd33c830SBoris Brezillon {
1002cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec;
1003cd33c830SBoris Brezillon unsigned int i;
1004cd33c830SBoris Brezillon int ret, irq;
1005cd33c830SBoris Brezillon
1006cd33c830SBoris Brezillon rkvdec = devm_kzalloc(&pdev->dev, sizeof(*rkvdec), GFP_KERNEL);
1007cd33c830SBoris Brezillon if (!rkvdec)
1008cd33c830SBoris Brezillon return -ENOMEM;
1009cd33c830SBoris Brezillon
1010cd33c830SBoris Brezillon platform_set_drvdata(pdev, rkvdec);
1011cd33c830SBoris Brezillon rkvdec->dev = &pdev->dev;
1012cd33c830SBoris Brezillon mutex_init(&rkvdec->vdev_lock);
1013cd33c830SBoris Brezillon INIT_DELAYED_WORK(&rkvdec->watchdog_work, rkvdec_watchdog_func);
1014cd33c830SBoris Brezillon
1015cd33c830SBoris Brezillon rkvdec->clocks = devm_kcalloc(&pdev->dev, ARRAY_SIZE(rkvdec_clk_names),
1016cd33c830SBoris Brezillon sizeof(*rkvdec->clocks), GFP_KERNEL);
1017cd33c830SBoris Brezillon if (!rkvdec->clocks)
1018cd33c830SBoris Brezillon return -ENOMEM;
1019cd33c830SBoris Brezillon
1020cd33c830SBoris Brezillon for (i = 0; i < ARRAY_SIZE(rkvdec_clk_names); i++)
1021cd33c830SBoris Brezillon rkvdec->clocks[i].id = rkvdec_clk_names[i];
1022cd33c830SBoris Brezillon
1023cd33c830SBoris Brezillon ret = devm_clk_bulk_get(&pdev->dev, ARRAY_SIZE(rkvdec_clk_names),
1024cd33c830SBoris Brezillon rkvdec->clocks);
1025cd33c830SBoris Brezillon if (ret)
1026cd33c830SBoris Brezillon return ret;
1027cd33c830SBoris Brezillon
10285a3683d6SCai Huoqing rkvdec->regs = devm_platform_ioremap_resource(pdev, 0);
1029cd33c830SBoris Brezillon if (IS_ERR(rkvdec->regs))
1030cd33c830SBoris Brezillon return PTR_ERR(rkvdec->regs);
1031cd33c830SBoris Brezillon
1032cd33c830SBoris Brezillon ret = dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32));
1033cd33c830SBoris Brezillon if (ret) {
1034cd33c830SBoris Brezillon dev_err(&pdev->dev, "Could not set DMA coherent mask.\n");
1035cd33c830SBoris Brezillon return ret;
1036cd33c830SBoris Brezillon }
1037cd33c830SBoris Brezillon
1038cd33c830SBoris Brezillon vb2_dma_contig_set_max_seg_size(&pdev->dev, DMA_BIT_MASK(32));
1039cd33c830SBoris Brezillon
1040cd33c830SBoris Brezillon irq = platform_get_irq(pdev, 0);
1041121ca877SYueHaibing if (irq <= 0)
1042cd33c830SBoris Brezillon return -ENXIO;
1043cd33c830SBoris Brezillon
1044cd33c830SBoris Brezillon ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
1045cd33c830SBoris Brezillon rkvdec_irq_handler, IRQF_ONESHOT,
1046cd33c830SBoris Brezillon dev_name(&pdev->dev), rkvdec);
1047cd33c830SBoris Brezillon if (ret) {
1048cd33c830SBoris Brezillon dev_err(&pdev->dev, "Could not request vdec IRQ\n");
1049cd33c830SBoris Brezillon return ret;
1050cd33c830SBoris Brezillon }
1051cd33c830SBoris Brezillon
1052cd33c830SBoris Brezillon pm_runtime_set_autosuspend_delay(&pdev->dev, 100);
1053cd33c830SBoris Brezillon pm_runtime_use_autosuspend(&pdev->dev);
1054cd33c830SBoris Brezillon pm_runtime_enable(&pdev->dev);
1055cd33c830SBoris Brezillon
1056cd33c830SBoris Brezillon ret = rkvdec_v4l2_init(rkvdec);
1057cd33c830SBoris Brezillon if (ret)
1058cd33c830SBoris Brezillon goto err_disable_runtime_pm;
1059cd33c830SBoris Brezillon
1060cd33c830SBoris Brezillon return 0;
1061cd33c830SBoris Brezillon
1062cd33c830SBoris Brezillon err_disable_runtime_pm:
1063cd33c830SBoris Brezillon pm_runtime_dont_use_autosuspend(&pdev->dev);
1064cd33c830SBoris Brezillon pm_runtime_disable(&pdev->dev);
1065cd33c830SBoris Brezillon return ret;
1066cd33c830SBoris Brezillon }
1067cd33c830SBoris Brezillon
rkvdec_remove(struct platform_device * pdev)10687f91babeSUwe Kleine-König static void rkvdec_remove(struct platform_device *pdev)
1069cd33c830SBoris Brezillon {
1070cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = platform_get_drvdata(pdev);
1071cd33c830SBoris Brezillon
10723228cec2SZheng Wang cancel_delayed_work_sync(&rkvdec->watchdog_work);
10733228cec2SZheng Wang
1074cd33c830SBoris Brezillon rkvdec_v4l2_cleanup(rkvdec);
1075cd33c830SBoris Brezillon pm_runtime_disable(&pdev->dev);
1076cd33c830SBoris Brezillon pm_runtime_dont_use_autosuspend(&pdev->dev);
1077cd33c830SBoris Brezillon }
1078cd33c830SBoris Brezillon
1079cd33c830SBoris Brezillon #ifdef CONFIG_PM
rkvdec_runtime_resume(struct device * dev)1080cd33c830SBoris Brezillon static int rkvdec_runtime_resume(struct device *dev)
1081cd33c830SBoris Brezillon {
1082cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = dev_get_drvdata(dev);
1083cd33c830SBoris Brezillon
1084cd33c830SBoris Brezillon return clk_bulk_prepare_enable(ARRAY_SIZE(rkvdec_clk_names),
1085cd33c830SBoris Brezillon rkvdec->clocks);
1086cd33c830SBoris Brezillon }
1087cd33c830SBoris Brezillon
rkvdec_runtime_suspend(struct device * dev)1088cd33c830SBoris Brezillon static int rkvdec_runtime_suspend(struct device *dev)
1089cd33c830SBoris Brezillon {
1090cd33c830SBoris Brezillon struct rkvdec_dev *rkvdec = dev_get_drvdata(dev);
1091cd33c830SBoris Brezillon
1092cd33c830SBoris Brezillon clk_bulk_disable_unprepare(ARRAY_SIZE(rkvdec_clk_names),
1093cd33c830SBoris Brezillon rkvdec->clocks);
1094cd33c830SBoris Brezillon return 0;
1095cd33c830SBoris Brezillon }
1096cd33c830SBoris Brezillon #endif
1097cd33c830SBoris Brezillon
1098cd33c830SBoris Brezillon static const struct dev_pm_ops rkvdec_pm_ops = {
1099cd33c830SBoris Brezillon SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
1100cd33c830SBoris Brezillon pm_runtime_force_resume)
1101cd33c830SBoris Brezillon SET_RUNTIME_PM_OPS(rkvdec_runtime_suspend, rkvdec_runtime_resume, NULL)
1102cd33c830SBoris Brezillon };
1103cd33c830SBoris Brezillon
1104cd33c830SBoris Brezillon static struct platform_driver rkvdec_driver = {
1105cd33c830SBoris Brezillon .probe = rkvdec_probe,
11067f91babeSUwe Kleine-König .remove_new = rkvdec_remove,
1107cd33c830SBoris Brezillon .driver = {
1108cd33c830SBoris Brezillon .name = "rkvdec",
1109c2357dd9SFabio Estevam .of_match_table = of_rkvdec_match,
1110cd33c830SBoris Brezillon .pm = &rkvdec_pm_ops,
1111cd33c830SBoris Brezillon },
1112cd33c830SBoris Brezillon };
1113cd33c830SBoris Brezillon module_platform_driver(rkvdec_driver);
1114cd33c830SBoris Brezillon
1115cd33c830SBoris Brezillon MODULE_AUTHOR("Boris Brezillon <boris.brezillon@collabora.com>");
1116cd33c830SBoris Brezillon MODULE_DESCRIPTION("Rockchip Video Decoder driver");
1117cd33c830SBoris Brezillon MODULE_LICENSE("GPL v2");
1118