1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2012-2016, The Linux Foundation. All rights reserved.
4 * Copyright (C) 2017 Linaro Ltd.
5 */
6 #include <linux/idr.h>
7 #include <linux/list.h>
8 #include <linux/mutex.h>
9 #include <linux/slab.h>
10 #include <linux/kernel.h>
11 #include <media/videobuf2-dma-contig.h>
12 #include <media/v4l2-mem2mem.h>
13 #include <asm/div64.h>
14
15 #include "core.h"
16 #include "helpers.h"
17 #include "hfi_helper.h"
18 #include "pm_helpers.h"
19 #include "hfi_platform.h"
20 #include "hfi_parser.h"
21
22 #define NUM_MBS_720P (((ALIGN(1280, 16)) >> 4) * ((ALIGN(736, 16)) >> 4))
23 #define NUM_MBS_4K (((ALIGN(4096, 16)) >> 4) * ((ALIGN(2304, 16)) >> 4))
24
25 enum dpb_buf_owner {
26 DRIVER,
27 FIRMWARE,
28 };
29
30 struct intbuf {
31 struct list_head list;
32 u32 type;
33 size_t size;
34 void *va;
35 dma_addr_t da;
36 unsigned long attrs;
37 enum dpb_buf_owner owned_by;
38 u32 dpb_out_tag;
39 };
40
venus_helper_check_codec(struct venus_inst * inst,u32 v4l2_pixfmt)41 bool venus_helper_check_codec(struct venus_inst *inst, u32 v4l2_pixfmt)
42 {
43 struct venus_core *core = inst->core;
44 u32 session_type = inst->session_type;
45 u32 codec;
46
47 switch (v4l2_pixfmt) {
48 case V4L2_PIX_FMT_H264:
49 codec = HFI_VIDEO_CODEC_H264;
50 break;
51 case V4L2_PIX_FMT_H263:
52 codec = HFI_VIDEO_CODEC_H263;
53 break;
54 case V4L2_PIX_FMT_MPEG1:
55 codec = HFI_VIDEO_CODEC_MPEG1;
56 break;
57 case V4L2_PIX_FMT_MPEG2:
58 codec = HFI_VIDEO_CODEC_MPEG2;
59 break;
60 case V4L2_PIX_FMT_MPEG4:
61 codec = HFI_VIDEO_CODEC_MPEG4;
62 break;
63 case V4L2_PIX_FMT_VC1_ANNEX_G:
64 case V4L2_PIX_FMT_VC1_ANNEX_L:
65 codec = HFI_VIDEO_CODEC_VC1;
66 break;
67 case V4L2_PIX_FMT_VP8:
68 codec = HFI_VIDEO_CODEC_VP8;
69 break;
70 case V4L2_PIX_FMT_VP9:
71 codec = HFI_VIDEO_CODEC_VP9;
72 break;
73 case V4L2_PIX_FMT_XVID:
74 codec = HFI_VIDEO_CODEC_DIVX;
75 break;
76 case V4L2_PIX_FMT_HEVC:
77 codec = HFI_VIDEO_CODEC_HEVC;
78 break;
79 default:
80 return false;
81 }
82
83 if (session_type == VIDC_SESSION_TYPE_ENC && core->enc_codecs & codec)
84 return true;
85
86 if (session_type == VIDC_SESSION_TYPE_DEC && core->dec_codecs & codec)
87 return true;
88
89 return false;
90 }
91 EXPORT_SYMBOL_GPL(venus_helper_check_codec);
92
free_dpb_buf(struct venus_inst * inst,struct intbuf * buf)93 static void free_dpb_buf(struct venus_inst *inst, struct intbuf *buf)
94 {
95 ida_free(&inst->dpb_ids, buf->dpb_out_tag);
96
97 list_del_init(&buf->list);
98 dma_free_attrs(inst->core->dev, buf->size, buf->va, buf->da,
99 buf->attrs);
100 kfree(buf);
101 }
102
venus_helper_queue_dpb_bufs(struct venus_inst * inst)103 int venus_helper_queue_dpb_bufs(struct venus_inst *inst)
104 {
105 struct intbuf *buf, *next;
106 unsigned int dpb_size = 0;
107 int ret = 0;
108
109 if (inst->dpb_buftype == HFI_BUFFER_OUTPUT)
110 dpb_size = inst->output_buf_size;
111 else if (inst->dpb_buftype == HFI_BUFFER_OUTPUT2)
112 dpb_size = inst->output2_buf_size;
113
114 list_for_each_entry_safe(buf, next, &inst->dpbbufs, list) {
115 struct hfi_frame_data fdata;
116
117 memset(&fdata, 0, sizeof(fdata));
118 fdata.alloc_len = buf->size;
119 fdata.device_addr = buf->da;
120 fdata.buffer_type = buf->type;
121
122 if (buf->owned_by == FIRMWARE)
123 continue;
124
125 /* free buffer from previous sequence which was released later */
126 if (dpb_size > buf->size) {
127 free_dpb_buf(inst, buf);
128 continue;
129 }
130
131 fdata.clnt_data = buf->dpb_out_tag;
132
133 ret = hfi_session_process_buf(inst, &fdata);
134 if (ret)
135 goto fail;
136
137 buf->owned_by = FIRMWARE;
138 }
139
140 fail:
141 return ret;
142 }
143 EXPORT_SYMBOL_GPL(venus_helper_queue_dpb_bufs);
144
venus_helper_free_dpb_bufs(struct venus_inst * inst)145 int venus_helper_free_dpb_bufs(struct venus_inst *inst)
146 {
147 struct intbuf *buf, *n;
148
149 list_for_each_entry_safe(buf, n, &inst->dpbbufs, list) {
150 if (buf->owned_by == FIRMWARE)
151 continue;
152 free_dpb_buf(inst, buf);
153 }
154
155 if (list_empty(&inst->dpbbufs))
156 INIT_LIST_HEAD(&inst->dpbbufs);
157
158 return 0;
159 }
160 EXPORT_SYMBOL_GPL(venus_helper_free_dpb_bufs);
161
venus_helper_alloc_dpb_bufs(struct venus_inst * inst)162 int venus_helper_alloc_dpb_bufs(struct venus_inst *inst)
163 {
164 struct venus_core *core = inst->core;
165 struct device *dev = core->dev;
166 enum hfi_version ver = core->res->hfi_version;
167 struct hfi_buffer_requirements bufreq;
168 u32 buftype = inst->dpb_buftype;
169 unsigned int dpb_size = 0;
170 struct intbuf *buf;
171 unsigned int i;
172 u32 count;
173 int ret;
174 int id;
175
176 /* no need to allocate dpb buffers */
177 if (!inst->dpb_fmt)
178 return 0;
179
180 if (inst->dpb_buftype == HFI_BUFFER_OUTPUT)
181 dpb_size = inst->output_buf_size;
182 else if (inst->dpb_buftype == HFI_BUFFER_OUTPUT2)
183 dpb_size = inst->output2_buf_size;
184
185 if (!dpb_size)
186 return 0;
187
188 ret = venus_helper_get_bufreq(inst, buftype, &bufreq);
189 if (ret)
190 return ret;
191
192 count = HFI_BUFREQ_COUNT_MIN(&bufreq, ver);
193
194 for (i = 0; i < count; i++) {
195 buf = kzalloc(sizeof(*buf), GFP_KERNEL);
196 if (!buf) {
197 ret = -ENOMEM;
198 goto fail;
199 }
200
201 buf->type = buftype;
202 buf->size = dpb_size;
203 buf->attrs = DMA_ATTR_WRITE_COMBINE |
204 DMA_ATTR_NO_KERNEL_MAPPING;
205 buf->va = dma_alloc_attrs(dev, buf->size, &buf->da, GFP_KERNEL,
206 buf->attrs);
207 if (!buf->va) {
208 ret = -ENOMEM;
209 goto fail;
210 }
211 buf->owned_by = DRIVER;
212
213 id = ida_alloc_min(&inst->dpb_ids, VB2_MAX_FRAME, GFP_KERNEL);
214 if (id < 0) {
215 ret = id;
216 goto fail;
217 }
218
219 buf->dpb_out_tag = id;
220
221 list_add_tail(&buf->list, &inst->dpbbufs);
222 }
223
224 return 0;
225
226 fail:
227 kfree(buf);
228 venus_helper_free_dpb_bufs(inst);
229 return ret;
230 }
231 EXPORT_SYMBOL_GPL(venus_helper_alloc_dpb_bufs);
232
intbufs_set_buffer(struct venus_inst * inst,u32 type)233 static int intbufs_set_buffer(struct venus_inst *inst, u32 type)
234 {
235 struct venus_core *core = inst->core;
236 struct device *dev = core->dev;
237 struct hfi_buffer_requirements bufreq;
238 struct hfi_buffer_desc bd;
239 struct intbuf *buf;
240 unsigned int i;
241 int ret;
242
243 ret = venus_helper_get_bufreq(inst, type, &bufreq);
244 if (ret)
245 return 0;
246
247 if (!bufreq.size)
248 return 0;
249
250 for (i = 0; i < bufreq.count_actual; i++) {
251 buf = kzalloc(sizeof(*buf), GFP_KERNEL);
252 if (!buf) {
253 ret = -ENOMEM;
254 goto fail;
255 }
256
257 buf->type = bufreq.type;
258 buf->size = bufreq.size;
259 buf->attrs = DMA_ATTR_WRITE_COMBINE |
260 DMA_ATTR_NO_KERNEL_MAPPING;
261 buf->va = dma_alloc_attrs(dev, buf->size, &buf->da, GFP_KERNEL,
262 buf->attrs);
263 if (!buf->va) {
264 ret = -ENOMEM;
265 goto fail;
266 }
267
268 memset(&bd, 0, sizeof(bd));
269 bd.buffer_size = buf->size;
270 bd.buffer_type = buf->type;
271 bd.num_buffers = 1;
272 bd.device_addr = buf->da;
273
274 ret = hfi_session_set_buffers(inst, &bd);
275 if (ret) {
276 dev_err(dev, "set session buffers failed\n");
277 goto dma_free;
278 }
279
280 list_add_tail(&buf->list, &inst->internalbufs);
281 }
282
283 return 0;
284
285 dma_free:
286 dma_free_attrs(dev, buf->size, buf->va, buf->da, buf->attrs);
287 fail:
288 kfree(buf);
289 return ret;
290 }
291
intbufs_unset_buffers(struct venus_inst * inst)292 static int intbufs_unset_buffers(struct venus_inst *inst)
293 {
294 struct hfi_buffer_desc bd = {0};
295 struct intbuf *buf, *n;
296 int ret = 0;
297
298 list_for_each_entry_safe(buf, n, &inst->internalbufs, list) {
299 bd.buffer_size = buf->size;
300 bd.buffer_type = buf->type;
301 bd.num_buffers = 1;
302 bd.device_addr = buf->da;
303 bd.response_required = true;
304
305 ret = hfi_session_unset_buffers(inst, &bd);
306
307 list_del_init(&buf->list);
308 dma_free_attrs(inst->core->dev, buf->size, buf->va, buf->da,
309 buf->attrs);
310 kfree(buf);
311 }
312
313 return ret;
314 }
315
316 static const unsigned int intbuf_types_1xx[] = {
317 HFI_BUFFER_INTERNAL_SCRATCH(HFI_VERSION_1XX),
318 HFI_BUFFER_INTERNAL_SCRATCH_1(HFI_VERSION_1XX),
319 HFI_BUFFER_INTERNAL_SCRATCH_2(HFI_VERSION_1XX),
320 HFI_BUFFER_INTERNAL_PERSIST,
321 HFI_BUFFER_INTERNAL_PERSIST_1,
322 };
323
324 static const unsigned int intbuf_types_4xx[] = {
325 HFI_BUFFER_INTERNAL_SCRATCH(HFI_VERSION_4XX),
326 HFI_BUFFER_INTERNAL_SCRATCH_1(HFI_VERSION_4XX),
327 HFI_BUFFER_INTERNAL_SCRATCH_2(HFI_VERSION_4XX),
328 HFI_BUFFER_INTERNAL_PERSIST,
329 HFI_BUFFER_INTERNAL_PERSIST_1,
330 };
331
332 static const unsigned int intbuf_types_6xx[] = {
333 HFI_BUFFER_INTERNAL_SCRATCH(HFI_VERSION_6XX),
334 HFI_BUFFER_INTERNAL_SCRATCH_1(HFI_VERSION_6XX),
335 HFI_BUFFER_INTERNAL_SCRATCH_2(HFI_VERSION_6XX),
336 HFI_BUFFER_INTERNAL_PERSIST,
337 HFI_BUFFER_INTERNAL_PERSIST_1,
338 };
339
venus_helper_intbufs_alloc(struct venus_inst * inst)340 int venus_helper_intbufs_alloc(struct venus_inst *inst)
341 {
342 const unsigned int *intbuf;
343 size_t arr_sz, i;
344 int ret;
345
346 if (IS_V6(inst->core)) {
347 arr_sz = ARRAY_SIZE(intbuf_types_6xx);
348 intbuf = intbuf_types_6xx;
349 } else if (IS_V4(inst->core)) {
350 arr_sz = ARRAY_SIZE(intbuf_types_4xx);
351 intbuf = intbuf_types_4xx;
352 } else {
353 arr_sz = ARRAY_SIZE(intbuf_types_1xx);
354 intbuf = intbuf_types_1xx;
355 }
356
357 for (i = 0; i < arr_sz; i++) {
358 ret = intbufs_set_buffer(inst, intbuf[i]);
359 if (ret)
360 goto error;
361 }
362
363 return 0;
364
365 error:
366 intbufs_unset_buffers(inst);
367 return ret;
368 }
369 EXPORT_SYMBOL_GPL(venus_helper_intbufs_alloc);
370
venus_helper_intbufs_free(struct venus_inst * inst)371 int venus_helper_intbufs_free(struct venus_inst *inst)
372 {
373 return intbufs_unset_buffers(inst);
374 }
375 EXPORT_SYMBOL_GPL(venus_helper_intbufs_free);
376
venus_helper_intbufs_realloc(struct venus_inst * inst)377 int venus_helper_intbufs_realloc(struct venus_inst *inst)
378 {
379 enum hfi_version ver = inst->core->res->hfi_version;
380 struct hfi_buffer_desc bd;
381 struct intbuf *buf, *n;
382 int ret;
383
384 list_for_each_entry_safe(buf, n, &inst->internalbufs, list) {
385 if (buf->type == HFI_BUFFER_INTERNAL_PERSIST ||
386 buf->type == HFI_BUFFER_INTERNAL_PERSIST_1)
387 continue;
388
389 memset(&bd, 0, sizeof(bd));
390 bd.buffer_size = buf->size;
391 bd.buffer_type = buf->type;
392 bd.num_buffers = 1;
393 bd.device_addr = buf->da;
394 bd.response_required = true;
395
396 ret = hfi_session_unset_buffers(inst, &bd);
397
398 dma_free_attrs(inst->core->dev, buf->size, buf->va, buf->da,
399 buf->attrs);
400
401 list_del_init(&buf->list);
402 kfree(buf);
403 }
404
405 ret = intbufs_set_buffer(inst, HFI_BUFFER_INTERNAL_SCRATCH(ver));
406 if (ret)
407 goto err;
408
409 ret = intbufs_set_buffer(inst, HFI_BUFFER_INTERNAL_SCRATCH_1(ver));
410 if (ret)
411 goto err;
412
413 ret = intbufs_set_buffer(inst, HFI_BUFFER_INTERNAL_SCRATCH_2(ver));
414 if (ret)
415 goto err;
416
417 return 0;
418 err:
419 return ret;
420 }
421 EXPORT_SYMBOL_GPL(venus_helper_intbufs_realloc);
422
fill_buffer_desc(const struct venus_buffer * buf,struct hfi_buffer_desc * bd,bool response)423 static void fill_buffer_desc(const struct venus_buffer *buf,
424 struct hfi_buffer_desc *bd, bool response)
425 {
426 memset(bd, 0, sizeof(*bd));
427 bd->buffer_type = HFI_BUFFER_OUTPUT;
428 bd->buffer_size = buf->size;
429 bd->num_buffers = 1;
430 bd->device_addr = buf->dma_addr;
431 bd->response_required = response;
432 }
433
return_buf_error(struct venus_inst * inst,struct vb2_v4l2_buffer * vbuf)434 static void return_buf_error(struct venus_inst *inst,
435 struct vb2_v4l2_buffer *vbuf)
436 {
437 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
438
439 if (vbuf->vb2_buf.type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
440 v4l2_m2m_src_buf_remove_by_buf(m2m_ctx, vbuf);
441 else
442 v4l2_m2m_dst_buf_remove_by_buf(m2m_ctx, vbuf);
443
444 v4l2_m2m_buf_done(vbuf, VB2_BUF_STATE_ERROR);
445 }
446
447 static void
put_ts_metadata(struct venus_inst * inst,struct vb2_v4l2_buffer * vbuf)448 put_ts_metadata(struct venus_inst *inst, struct vb2_v4l2_buffer *vbuf)
449 {
450 struct vb2_buffer *vb = &vbuf->vb2_buf;
451 unsigned int i;
452 int slot = -1;
453 u64 ts_us = vb->timestamp;
454
455 for (i = 0; i < ARRAY_SIZE(inst->tss); i++) {
456 if (!inst->tss[i].used) {
457 slot = i;
458 break;
459 }
460 }
461
462 if (slot == -1) {
463 dev_dbg(inst->core->dev, VDBGL "no free slot\n");
464 return;
465 }
466
467 do_div(ts_us, NSEC_PER_USEC);
468
469 inst->tss[slot].used = true;
470 inst->tss[slot].flags = vbuf->flags;
471 inst->tss[slot].tc = vbuf->timecode;
472 inst->tss[slot].ts_us = ts_us;
473 inst->tss[slot].ts_ns = vb->timestamp;
474 }
475
venus_helper_get_ts_metadata(struct venus_inst * inst,u64 timestamp_us,struct vb2_v4l2_buffer * vbuf)476 void venus_helper_get_ts_metadata(struct venus_inst *inst, u64 timestamp_us,
477 struct vb2_v4l2_buffer *vbuf)
478 {
479 struct vb2_buffer *vb = &vbuf->vb2_buf;
480 unsigned int i;
481
482 for (i = 0; i < ARRAY_SIZE(inst->tss); ++i) {
483 if (!inst->tss[i].used)
484 continue;
485
486 if (inst->tss[i].ts_us != timestamp_us)
487 continue;
488
489 inst->tss[i].used = false;
490 vbuf->flags |= inst->tss[i].flags;
491 vbuf->timecode = inst->tss[i].tc;
492 vb->timestamp = inst->tss[i].ts_ns;
493 break;
494 }
495 }
496 EXPORT_SYMBOL_GPL(venus_helper_get_ts_metadata);
497
498 static int
session_process_buf(struct venus_inst * inst,struct vb2_v4l2_buffer * vbuf)499 session_process_buf(struct venus_inst *inst, struct vb2_v4l2_buffer *vbuf)
500 {
501 struct venus_buffer *buf = to_venus_buffer(vbuf);
502 struct vb2_buffer *vb = &vbuf->vb2_buf;
503 unsigned int type = vb->type;
504 struct hfi_frame_data fdata;
505 int ret;
506
507 memset(&fdata, 0, sizeof(fdata));
508 fdata.alloc_len = buf->size;
509 fdata.device_addr = buf->dma_addr;
510 fdata.timestamp = vb->timestamp;
511 do_div(fdata.timestamp, NSEC_PER_USEC);
512 fdata.flags = 0;
513 fdata.clnt_data = vbuf->vb2_buf.index;
514
515 if (type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE) {
516 fdata.buffer_type = HFI_BUFFER_INPUT;
517 fdata.filled_len = vb2_get_plane_payload(vb, 0);
518 fdata.offset = vb->planes[0].data_offset;
519
520 if (vbuf->flags & V4L2_BUF_FLAG_LAST || !fdata.filled_len)
521 fdata.flags |= HFI_BUFFERFLAG_EOS;
522
523 if (inst->session_type == VIDC_SESSION_TYPE_DEC)
524 put_ts_metadata(inst, vbuf);
525
526 venus_pm_load_scale(inst);
527 } else if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
528 if (inst->session_type == VIDC_SESSION_TYPE_ENC)
529 fdata.buffer_type = HFI_BUFFER_OUTPUT;
530 else
531 fdata.buffer_type = inst->opb_buftype;
532 fdata.filled_len = 0;
533 fdata.offset = 0;
534 }
535
536 ret = hfi_session_process_buf(inst, &fdata);
537 if (ret)
538 return ret;
539
540 return 0;
541 }
542
is_dynamic_bufmode(struct venus_inst * inst)543 static bool is_dynamic_bufmode(struct venus_inst *inst)
544 {
545 struct venus_core *core = inst->core;
546 struct hfi_plat_caps *caps;
547
548 /*
549 * v4 doesn't send BUFFER_ALLOC_MODE_SUPPORTED property and supports
550 * dynamic buffer mode by default for HFI_BUFFER_OUTPUT/OUTPUT2.
551 */
552 if (IS_V4(core) || IS_V6(core))
553 return true;
554
555 caps = venus_caps_by_codec(core, inst->hfi_codec, inst->session_type);
556 if (!caps)
557 return false;
558
559 return caps->cap_bufs_mode_dynamic;
560 }
561
venus_helper_unregister_bufs(struct venus_inst * inst)562 int venus_helper_unregister_bufs(struct venus_inst *inst)
563 {
564 struct venus_buffer *buf, *n;
565 struct hfi_buffer_desc bd;
566 int ret = 0;
567
568 if (is_dynamic_bufmode(inst))
569 return 0;
570
571 list_for_each_entry_safe(buf, n, &inst->registeredbufs, reg_list) {
572 fill_buffer_desc(buf, &bd, true);
573 ret = hfi_session_unset_buffers(inst, &bd);
574 list_del_init(&buf->reg_list);
575 }
576
577 return ret;
578 }
579 EXPORT_SYMBOL_GPL(venus_helper_unregister_bufs);
580
session_register_bufs(struct venus_inst * inst)581 static int session_register_bufs(struct venus_inst *inst)
582 {
583 struct venus_core *core = inst->core;
584 struct device *dev = core->dev;
585 struct hfi_buffer_desc bd;
586 struct venus_buffer *buf;
587 int ret = 0;
588
589 if (is_dynamic_bufmode(inst))
590 return 0;
591
592 list_for_each_entry(buf, &inst->registeredbufs, reg_list) {
593 fill_buffer_desc(buf, &bd, false);
594 ret = hfi_session_set_buffers(inst, &bd);
595 if (ret) {
596 dev_err(dev, "%s: set buffer failed\n", __func__);
597 break;
598 }
599 }
600
601 return ret;
602 }
603
to_hfi_raw_fmt(u32 v4l2_fmt)604 static u32 to_hfi_raw_fmt(u32 v4l2_fmt)
605 {
606 switch (v4l2_fmt) {
607 case V4L2_PIX_FMT_NV12:
608 return HFI_COLOR_FORMAT_NV12;
609 case V4L2_PIX_FMT_NV21:
610 return HFI_COLOR_FORMAT_NV21;
611 case V4L2_PIX_FMT_QC08C:
612 return HFI_COLOR_FORMAT_NV12_UBWC;
613 case V4L2_PIX_FMT_QC10C:
614 return HFI_COLOR_FORMAT_YUV420_TP10_UBWC;
615 default:
616 break;
617 }
618
619 return 0;
620 }
621
platform_get_bufreq(struct venus_inst * inst,u32 buftype,struct hfi_buffer_requirements * req)622 static int platform_get_bufreq(struct venus_inst *inst, u32 buftype,
623 struct hfi_buffer_requirements *req)
624 {
625 enum hfi_version version = inst->core->res->hfi_version;
626 const struct hfi_platform *hfi_plat;
627 struct hfi_plat_buffers_params params;
628 bool is_dec = inst->session_type == VIDC_SESSION_TYPE_DEC;
629 struct venc_controls *enc_ctr = &inst->controls.enc;
630
631 hfi_plat = hfi_platform_get(version);
632
633 if (!hfi_plat || !hfi_plat->bufreq)
634 return -EINVAL;
635
636 params.version = version;
637 params.num_vpp_pipes = inst->core->res->num_vpp_pipes;
638
639 if (is_dec) {
640 params.width = inst->width;
641 params.height = inst->height;
642 params.codec = inst->fmt_out->pixfmt;
643 params.hfi_color_fmt = to_hfi_raw_fmt(inst->fmt_cap->pixfmt);
644 params.dec.max_mbs_per_frame = mbs_per_frame_max(inst);
645 params.dec.buffer_size_limit = 0;
646 params.dec.is_secondary_output =
647 inst->opb_buftype == HFI_BUFFER_OUTPUT2;
648 params.dec.is_interlaced =
649 inst->pic_struct != HFI_INTERLACE_FRAME_PROGRESSIVE;
650 } else {
651 params.width = inst->out_width;
652 params.height = inst->out_height;
653 params.codec = inst->fmt_cap->pixfmt;
654 params.hfi_color_fmt = to_hfi_raw_fmt(inst->fmt_out->pixfmt);
655 params.enc.work_mode = VIDC_WORK_MODE_2;
656 params.enc.rc_type = HFI_RATE_CONTROL_OFF;
657 if (enc_ctr->bitrate_mode == V4L2_MPEG_VIDEO_BITRATE_MODE_CQ)
658 params.enc.rc_type = HFI_RATE_CONTROL_CQ;
659 params.enc.num_b_frames = enc_ctr->num_b_frames;
660 params.enc.is_tenbit = inst->bit_depth == VIDC_BITDEPTH_10;
661 }
662
663 return hfi_plat->bufreq(¶ms, inst->session_type, buftype, req);
664 }
665
venus_helper_get_bufreq(struct venus_inst * inst,u32 type,struct hfi_buffer_requirements * req)666 int venus_helper_get_bufreq(struct venus_inst *inst, u32 type,
667 struct hfi_buffer_requirements *req)
668 {
669 u32 ptype = HFI_PROPERTY_CONFIG_BUFFER_REQUIREMENTS;
670 union hfi_get_property hprop;
671 unsigned int i;
672 int ret;
673
674 if (req)
675 memset(req, 0, sizeof(*req));
676
677 if (type == HFI_BUFFER_OUTPUT || type == HFI_BUFFER_OUTPUT2)
678 req->count_min = inst->fw_min_cnt;
679
680 ret = platform_get_bufreq(inst, type, req);
681 if (!ret) {
682 if (type == HFI_BUFFER_OUTPUT || type == HFI_BUFFER_OUTPUT2)
683 inst->fw_min_cnt = req->count_min;
684 return 0;
685 }
686
687 ret = hfi_session_get_property(inst, ptype, &hprop);
688 if (ret)
689 return ret;
690
691 ret = -EINVAL;
692
693 for (i = 0; i < HFI_BUFFER_TYPE_MAX; i++) {
694 if (hprop.bufreq[i].type != type)
695 continue;
696
697 if (req)
698 memcpy(req, &hprop.bufreq[i], sizeof(*req));
699 ret = 0;
700 break;
701 }
702
703 return ret;
704 }
705 EXPORT_SYMBOL_GPL(venus_helper_get_bufreq);
706
707 struct id_mapping {
708 u32 hfi_id;
709 u32 v4l2_id;
710 };
711
712 static const struct id_mapping mpeg4_profiles[] = {
713 { HFI_MPEG4_PROFILE_SIMPLE, V4L2_MPEG_VIDEO_MPEG4_PROFILE_SIMPLE },
714 { HFI_MPEG4_PROFILE_ADVANCEDSIMPLE, V4L2_MPEG_VIDEO_MPEG4_PROFILE_ADVANCED_SIMPLE },
715 };
716
717 static const struct id_mapping mpeg4_levels[] = {
718 { HFI_MPEG4_LEVEL_0, V4L2_MPEG_VIDEO_MPEG4_LEVEL_0 },
719 { HFI_MPEG4_LEVEL_0b, V4L2_MPEG_VIDEO_MPEG4_LEVEL_0B },
720 { HFI_MPEG4_LEVEL_1, V4L2_MPEG_VIDEO_MPEG4_LEVEL_1 },
721 { HFI_MPEG4_LEVEL_2, V4L2_MPEG_VIDEO_MPEG4_LEVEL_2 },
722 { HFI_MPEG4_LEVEL_3, V4L2_MPEG_VIDEO_MPEG4_LEVEL_3 },
723 { HFI_MPEG4_LEVEL_4, V4L2_MPEG_VIDEO_MPEG4_LEVEL_4 },
724 { HFI_MPEG4_LEVEL_5, V4L2_MPEG_VIDEO_MPEG4_LEVEL_5 },
725 };
726
727 static const struct id_mapping mpeg2_profiles[] = {
728 { HFI_MPEG2_PROFILE_SIMPLE, V4L2_MPEG_VIDEO_MPEG2_PROFILE_SIMPLE },
729 { HFI_MPEG2_PROFILE_MAIN, V4L2_MPEG_VIDEO_MPEG2_PROFILE_MAIN },
730 { HFI_MPEG2_PROFILE_SNR, V4L2_MPEG_VIDEO_MPEG2_PROFILE_SNR_SCALABLE },
731 { HFI_MPEG2_PROFILE_SPATIAL, V4L2_MPEG_VIDEO_MPEG2_PROFILE_SPATIALLY_SCALABLE },
732 { HFI_MPEG2_PROFILE_HIGH, V4L2_MPEG_VIDEO_MPEG2_PROFILE_HIGH },
733 };
734
735 static const struct id_mapping mpeg2_levels[] = {
736 { HFI_MPEG2_LEVEL_LL, V4L2_MPEG_VIDEO_MPEG2_LEVEL_LOW },
737 { HFI_MPEG2_LEVEL_ML, V4L2_MPEG_VIDEO_MPEG2_LEVEL_MAIN },
738 { HFI_MPEG2_LEVEL_H14, V4L2_MPEG_VIDEO_MPEG2_LEVEL_HIGH_1440 },
739 { HFI_MPEG2_LEVEL_HL, V4L2_MPEG_VIDEO_MPEG2_LEVEL_HIGH },
740 };
741
742 static const struct id_mapping h264_profiles[] = {
743 { HFI_H264_PROFILE_BASELINE, V4L2_MPEG_VIDEO_H264_PROFILE_BASELINE },
744 { HFI_H264_PROFILE_MAIN, V4L2_MPEG_VIDEO_H264_PROFILE_MAIN },
745 { HFI_H264_PROFILE_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_HIGH },
746 { HFI_H264_PROFILE_STEREO_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_STEREO_HIGH },
747 { HFI_H264_PROFILE_MULTIVIEW_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_MULTIVIEW_HIGH },
748 { HFI_H264_PROFILE_CONSTRAINED_BASE, V4L2_MPEG_VIDEO_H264_PROFILE_CONSTRAINED_BASELINE },
749 { HFI_H264_PROFILE_CONSTRAINED_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_CONSTRAINED_HIGH },
750 };
751
752 static const struct id_mapping h264_levels[] = {
753 { HFI_H264_LEVEL_1, V4L2_MPEG_VIDEO_H264_LEVEL_1_0 },
754 { HFI_H264_LEVEL_1b, V4L2_MPEG_VIDEO_H264_LEVEL_1B },
755 { HFI_H264_LEVEL_11, V4L2_MPEG_VIDEO_H264_LEVEL_1_1 },
756 { HFI_H264_LEVEL_12, V4L2_MPEG_VIDEO_H264_LEVEL_1_2 },
757 { HFI_H264_LEVEL_13, V4L2_MPEG_VIDEO_H264_LEVEL_1_3 },
758 { HFI_H264_LEVEL_2, V4L2_MPEG_VIDEO_H264_LEVEL_2_0 },
759 { HFI_H264_LEVEL_21, V4L2_MPEG_VIDEO_H264_LEVEL_2_1 },
760 { HFI_H264_LEVEL_22, V4L2_MPEG_VIDEO_H264_LEVEL_2_2 },
761 { HFI_H264_LEVEL_3, V4L2_MPEG_VIDEO_H264_LEVEL_3_0 },
762 { HFI_H264_LEVEL_31, V4L2_MPEG_VIDEO_H264_LEVEL_3_1 },
763 { HFI_H264_LEVEL_32, V4L2_MPEG_VIDEO_H264_LEVEL_3_2 },
764 { HFI_H264_LEVEL_4, V4L2_MPEG_VIDEO_H264_LEVEL_4_0 },
765 { HFI_H264_LEVEL_41, V4L2_MPEG_VIDEO_H264_LEVEL_4_1 },
766 { HFI_H264_LEVEL_42, V4L2_MPEG_VIDEO_H264_LEVEL_4_2 },
767 { HFI_H264_LEVEL_5, V4L2_MPEG_VIDEO_H264_LEVEL_5_0 },
768 { HFI_H264_LEVEL_51, V4L2_MPEG_VIDEO_H264_LEVEL_5_1 },
769 { HFI_H264_LEVEL_52, V4L2_MPEG_VIDEO_H264_LEVEL_5_1 },
770 };
771
772 static const struct id_mapping hevc_profiles[] = {
773 { HFI_HEVC_PROFILE_MAIN, V4L2_MPEG_VIDEO_HEVC_PROFILE_MAIN },
774 { HFI_HEVC_PROFILE_MAIN_STILL_PIC, V4L2_MPEG_VIDEO_HEVC_PROFILE_MAIN_STILL_PICTURE },
775 { HFI_HEVC_PROFILE_MAIN10, V4L2_MPEG_VIDEO_HEVC_PROFILE_MAIN_10 },
776 };
777
778 static const struct id_mapping hevc_levels[] = {
779 { HFI_HEVC_LEVEL_1, V4L2_MPEG_VIDEO_HEVC_LEVEL_1 },
780 { HFI_HEVC_LEVEL_2, V4L2_MPEG_VIDEO_HEVC_LEVEL_2 },
781 { HFI_HEVC_LEVEL_21, V4L2_MPEG_VIDEO_HEVC_LEVEL_2_1 },
782 { HFI_HEVC_LEVEL_3, V4L2_MPEG_VIDEO_HEVC_LEVEL_3 },
783 { HFI_HEVC_LEVEL_31, V4L2_MPEG_VIDEO_HEVC_LEVEL_3_1 },
784 { HFI_HEVC_LEVEL_4, V4L2_MPEG_VIDEO_HEVC_LEVEL_4 },
785 { HFI_HEVC_LEVEL_41, V4L2_MPEG_VIDEO_HEVC_LEVEL_4_1 },
786 { HFI_HEVC_LEVEL_5, V4L2_MPEG_VIDEO_HEVC_LEVEL_5 },
787 { HFI_HEVC_LEVEL_51, V4L2_MPEG_VIDEO_HEVC_LEVEL_5_1 },
788 { HFI_HEVC_LEVEL_52, V4L2_MPEG_VIDEO_HEVC_LEVEL_5_2 },
789 { HFI_HEVC_LEVEL_6, V4L2_MPEG_VIDEO_HEVC_LEVEL_6 },
790 { HFI_HEVC_LEVEL_61, V4L2_MPEG_VIDEO_HEVC_LEVEL_6_1 },
791 { HFI_HEVC_LEVEL_62, V4L2_MPEG_VIDEO_HEVC_LEVEL_6_2 },
792 };
793
794 static const struct id_mapping vp8_profiles[] = {
795 { HFI_VPX_PROFILE_VERSION_0, V4L2_MPEG_VIDEO_VP8_PROFILE_0 },
796 { HFI_VPX_PROFILE_VERSION_1, V4L2_MPEG_VIDEO_VP8_PROFILE_1 },
797 { HFI_VPX_PROFILE_VERSION_2, V4L2_MPEG_VIDEO_VP8_PROFILE_2 },
798 { HFI_VPX_PROFILE_VERSION_3, V4L2_MPEG_VIDEO_VP8_PROFILE_3 },
799 };
800
801 static const struct id_mapping vp9_profiles[] = {
802 { HFI_VP9_PROFILE_P0, V4L2_MPEG_VIDEO_VP9_PROFILE_0 },
803 { HFI_VP9_PROFILE_P2_10B, V4L2_MPEG_VIDEO_VP9_PROFILE_2 },
804 };
805
806 static const struct id_mapping vp9_levels[] = {
807 { HFI_VP9_LEVEL_1, V4L2_MPEG_VIDEO_VP9_LEVEL_1_0 },
808 { HFI_VP9_LEVEL_11, V4L2_MPEG_VIDEO_VP9_LEVEL_1_1 },
809 { HFI_VP9_LEVEL_2, V4L2_MPEG_VIDEO_VP9_LEVEL_2_0},
810 { HFI_VP9_LEVEL_21, V4L2_MPEG_VIDEO_VP9_LEVEL_2_1 },
811 { HFI_VP9_LEVEL_3, V4L2_MPEG_VIDEO_VP9_LEVEL_3_0},
812 { HFI_VP9_LEVEL_31, V4L2_MPEG_VIDEO_VP9_LEVEL_3_1 },
813 { HFI_VP9_LEVEL_4, V4L2_MPEG_VIDEO_VP9_LEVEL_4_0 },
814 { HFI_VP9_LEVEL_41, V4L2_MPEG_VIDEO_VP9_LEVEL_4_1 },
815 { HFI_VP9_LEVEL_5, V4L2_MPEG_VIDEO_VP9_LEVEL_5_0 },
816 { HFI_VP9_LEVEL_51, V4L2_MPEG_VIDEO_VP9_LEVEL_5_1 },
817 { HFI_VP9_LEVEL_6, V4L2_MPEG_VIDEO_VP9_LEVEL_6_0 },
818 { HFI_VP9_LEVEL_61, V4L2_MPEG_VIDEO_VP9_LEVEL_6_1 },
819 };
820
find_v4l2_id(u32 hfi_id,const struct id_mapping * array,unsigned int array_sz)821 static u32 find_v4l2_id(u32 hfi_id, const struct id_mapping *array, unsigned int array_sz)
822 {
823 unsigned int i;
824
825 if (!array || !array_sz)
826 return 0;
827
828 for (i = 0; i < array_sz; i++)
829 if (hfi_id == array[i].hfi_id)
830 return array[i].v4l2_id;
831
832 return 0;
833 }
834
find_hfi_id(u32 v4l2_id,const struct id_mapping * array,unsigned int array_sz)835 static u32 find_hfi_id(u32 v4l2_id, const struct id_mapping *array, unsigned int array_sz)
836 {
837 unsigned int i;
838
839 if (!array || !array_sz)
840 return 0;
841
842 for (i = 0; i < array_sz; i++)
843 if (v4l2_id == array[i].v4l2_id)
844 return array[i].hfi_id;
845
846 return 0;
847 }
848
849 static void
v4l2_id_profile_level(u32 hfi_codec,struct hfi_profile_level * pl,u32 * profile,u32 * level)850 v4l2_id_profile_level(u32 hfi_codec, struct hfi_profile_level *pl, u32 *profile, u32 *level)
851 {
852 u32 hfi_pf = pl->profile;
853 u32 hfi_lvl = pl->level;
854
855 switch (hfi_codec) {
856 case HFI_VIDEO_CODEC_H264:
857 *profile = find_v4l2_id(hfi_pf, h264_profiles, ARRAY_SIZE(h264_profiles));
858 *level = find_v4l2_id(hfi_lvl, h264_levels, ARRAY_SIZE(h264_levels));
859 break;
860 case HFI_VIDEO_CODEC_MPEG2:
861 *profile = find_v4l2_id(hfi_pf, mpeg2_profiles, ARRAY_SIZE(mpeg2_profiles));
862 *level = find_v4l2_id(hfi_lvl, mpeg2_levels, ARRAY_SIZE(mpeg2_levels));
863 break;
864 case HFI_VIDEO_CODEC_MPEG4:
865 *profile = find_v4l2_id(hfi_pf, mpeg4_profiles, ARRAY_SIZE(mpeg4_profiles));
866 *level = find_v4l2_id(hfi_lvl, mpeg4_levels, ARRAY_SIZE(mpeg4_levels));
867 break;
868 case HFI_VIDEO_CODEC_VP8:
869 *profile = find_v4l2_id(hfi_pf, vp8_profiles, ARRAY_SIZE(vp8_profiles));
870 *level = 0;
871 break;
872 case HFI_VIDEO_CODEC_VP9:
873 *profile = find_v4l2_id(hfi_pf, vp9_profiles, ARRAY_SIZE(vp9_profiles));
874 *level = find_v4l2_id(hfi_lvl, vp9_levels, ARRAY_SIZE(vp9_levels));
875 break;
876 case HFI_VIDEO_CODEC_HEVC:
877 *profile = find_v4l2_id(hfi_pf, hevc_profiles, ARRAY_SIZE(hevc_profiles));
878 *level = find_v4l2_id(hfi_lvl, hevc_levels, ARRAY_SIZE(hevc_levels));
879 break;
880 default:
881 break;
882 }
883 }
884
885 static void
hfi_id_profile_level(u32 hfi_codec,u32 v4l2_pf,u32 v4l2_lvl,struct hfi_profile_level * pl)886 hfi_id_profile_level(u32 hfi_codec, u32 v4l2_pf, u32 v4l2_lvl, struct hfi_profile_level *pl)
887 {
888 switch (hfi_codec) {
889 case HFI_VIDEO_CODEC_H264:
890 pl->profile = find_hfi_id(v4l2_pf, h264_profiles, ARRAY_SIZE(h264_profiles));
891 pl->level = find_hfi_id(v4l2_lvl, h264_levels, ARRAY_SIZE(h264_levels));
892 break;
893 case HFI_VIDEO_CODEC_MPEG2:
894 pl->profile = find_hfi_id(v4l2_pf, mpeg2_profiles, ARRAY_SIZE(mpeg2_profiles));
895 pl->level = find_hfi_id(v4l2_lvl, mpeg2_levels, ARRAY_SIZE(mpeg2_levels));
896 break;
897 case HFI_VIDEO_CODEC_MPEG4:
898 pl->profile = find_hfi_id(v4l2_pf, mpeg4_profiles, ARRAY_SIZE(mpeg4_profiles));
899 pl->level = find_hfi_id(v4l2_lvl, mpeg4_levels, ARRAY_SIZE(mpeg4_levels));
900 break;
901 case HFI_VIDEO_CODEC_VP8:
902 pl->profile = find_hfi_id(v4l2_pf, vp8_profiles, ARRAY_SIZE(vp8_profiles));
903 pl->level = 0;
904 break;
905 case HFI_VIDEO_CODEC_VP9:
906 pl->profile = find_hfi_id(v4l2_pf, vp9_profiles, ARRAY_SIZE(vp9_profiles));
907 pl->level = find_hfi_id(v4l2_lvl, vp9_levels, ARRAY_SIZE(vp9_levels));
908 break;
909 case HFI_VIDEO_CODEC_HEVC:
910 pl->profile = find_hfi_id(v4l2_pf, hevc_profiles, ARRAY_SIZE(hevc_profiles));
911 pl->level = find_hfi_id(v4l2_lvl, hevc_levels, ARRAY_SIZE(hevc_levels));
912 break;
913 default:
914 break;
915 }
916 }
917
venus_helper_get_profile_level(struct venus_inst * inst,u32 * profile,u32 * level)918 int venus_helper_get_profile_level(struct venus_inst *inst, u32 *profile, u32 *level)
919 {
920 const u32 ptype = HFI_PROPERTY_PARAM_PROFILE_LEVEL_CURRENT;
921 union hfi_get_property hprop;
922 int ret;
923
924 ret = hfi_session_get_property(inst, ptype, &hprop);
925 if (ret)
926 return ret;
927
928 v4l2_id_profile_level(inst->hfi_codec, &hprop.profile_level, profile, level);
929
930 return 0;
931 }
932 EXPORT_SYMBOL_GPL(venus_helper_get_profile_level);
933
venus_helper_set_profile_level(struct venus_inst * inst,u32 profile,u32 level)934 int venus_helper_set_profile_level(struct venus_inst *inst, u32 profile, u32 level)
935 {
936 const u32 ptype = HFI_PROPERTY_PARAM_PROFILE_LEVEL_CURRENT;
937 struct hfi_profile_level pl;
938
939 hfi_id_profile_level(inst->hfi_codec, profile, level, &pl);
940
941 return hfi_session_set_property(inst, ptype, &pl);
942 }
943 EXPORT_SYMBOL_GPL(venus_helper_set_profile_level);
944
get_framesize_raw_nv12(u32 width,u32 height)945 static u32 get_framesize_raw_nv12(u32 width, u32 height)
946 {
947 u32 y_stride, uv_stride, y_plane;
948 u32 y_sclines, uv_sclines, uv_plane;
949 u32 size;
950
951 y_stride = ALIGN(width, 128);
952 uv_stride = ALIGN(width, 128);
953 y_sclines = ALIGN(height, 32);
954 uv_sclines = ALIGN(((height + 1) >> 1), 16);
955
956 y_plane = y_stride * y_sclines;
957 uv_plane = uv_stride * uv_sclines + SZ_4K;
958 size = y_plane + uv_plane + SZ_8K;
959
960 return ALIGN(size, SZ_4K);
961 }
962
get_framesize_raw_nv12_ubwc(u32 width,u32 height)963 static u32 get_framesize_raw_nv12_ubwc(u32 width, u32 height)
964 {
965 u32 y_meta_stride, y_meta_plane;
966 u32 y_stride, y_plane;
967 u32 uv_meta_stride, uv_meta_plane;
968 u32 uv_stride, uv_plane;
969 u32 extradata = SZ_16K;
970
971 y_meta_stride = ALIGN(DIV_ROUND_UP(width, 32), 64);
972 y_meta_plane = y_meta_stride * ALIGN(DIV_ROUND_UP(height, 8), 16);
973 y_meta_plane = ALIGN(y_meta_plane, SZ_4K);
974
975 y_stride = ALIGN(width, 128);
976 y_plane = ALIGN(y_stride * ALIGN(height, 32), SZ_4K);
977
978 uv_meta_stride = ALIGN(DIV_ROUND_UP(width / 2, 16), 64);
979 uv_meta_plane = uv_meta_stride * ALIGN(DIV_ROUND_UP(height / 2, 8), 16);
980 uv_meta_plane = ALIGN(uv_meta_plane, SZ_4K);
981
982 uv_stride = ALIGN(width, 128);
983 uv_plane = ALIGN(uv_stride * ALIGN(height / 2, 32), SZ_4K);
984
985 return ALIGN(y_meta_plane + y_plane + uv_meta_plane + uv_plane +
986 max(extradata, y_stride * 48), SZ_4K);
987 }
988
get_framesize_raw_p010(u32 width,u32 height)989 static u32 get_framesize_raw_p010(u32 width, u32 height)
990 {
991 u32 y_plane, uv_plane, y_stride, uv_stride, y_sclines, uv_sclines;
992
993 y_stride = ALIGN(width * 2, 256);
994 uv_stride = ALIGN(width * 2, 256);
995 y_sclines = ALIGN(height, 32);
996 uv_sclines = ALIGN((height + 1) >> 1, 16);
997 y_plane = y_stride * y_sclines;
998 uv_plane = uv_stride * uv_sclines;
999
1000 return ALIGN((y_plane + uv_plane), SZ_4K);
1001 }
1002
get_framesize_raw_p010_ubwc(u32 width,u32 height)1003 static u32 get_framesize_raw_p010_ubwc(u32 width, u32 height)
1004 {
1005 u32 y_stride, uv_stride, y_sclines, uv_sclines;
1006 u32 y_ubwc_plane, uv_ubwc_plane;
1007 u32 y_meta_stride, y_meta_scanlines;
1008 u32 uv_meta_stride, uv_meta_scanlines;
1009 u32 y_meta_plane, uv_meta_plane;
1010 u32 size;
1011
1012 y_stride = ALIGN(width * 2, 256);
1013 uv_stride = ALIGN(width * 2, 256);
1014 y_sclines = ALIGN(height, 16);
1015 uv_sclines = ALIGN((height + 1) >> 1, 16);
1016
1017 y_ubwc_plane = ALIGN(y_stride * y_sclines, SZ_4K);
1018 uv_ubwc_plane = ALIGN(uv_stride * uv_sclines, SZ_4K);
1019 y_meta_stride = ALIGN(DIV_ROUND_UP(width, 32), 64);
1020 y_meta_scanlines = ALIGN(DIV_ROUND_UP(height, 4), 16);
1021 y_meta_plane = ALIGN(y_meta_stride * y_meta_scanlines, SZ_4K);
1022 uv_meta_stride = ALIGN(DIV_ROUND_UP((width + 1) >> 1, 16), 64);
1023 uv_meta_scanlines = ALIGN(DIV_ROUND_UP((height + 1) >> 1, 4), 16);
1024 uv_meta_plane = ALIGN(uv_meta_stride * uv_meta_scanlines, SZ_4K);
1025
1026 size = y_ubwc_plane + uv_ubwc_plane + y_meta_plane + uv_meta_plane;
1027
1028 return ALIGN(size, SZ_4K);
1029 }
1030
get_framesize_raw_yuv420_tp10_ubwc(u32 width,u32 height)1031 static u32 get_framesize_raw_yuv420_tp10_ubwc(u32 width, u32 height)
1032 {
1033 u32 y_stride, uv_stride, y_sclines, uv_sclines;
1034 u32 y_ubwc_plane, uv_ubwc_plane;
1035 u32 y_meta_stride, y_meta_scanlines;
1036 u32 uv_meta_stride, uv_meta_scanlines;
1037 u32 y_meta_plane, uv_meta_plane;
1038 u32 extradata = SZ_16K;
1039 u32 size;
1040
1041 y_stride = ALIGN(ALIGN(width, 192) * 4 / 3, 256);
1042 uv_stride = ALIGN(ALIGN(width, 192) * 4 / 3, 256);
1043 y_sclines = ALIGN(height, 16);
1044 uv_sclines = ALIGN((height + 1) >> 1, 16);
1045
1046 y_ubwc_plane = ALIGN(y_stride * y_sclines, SZ_4K);
1047 uv_ubwc_plane = ALIGN(uv_stride * uv_sclines, SZ_4K);
1048 y_meta_stride = ALIGN(DIV_ROUND_UP(width, 48), 64);
1049 y_meta_scanlines = ALIGN(DIV_ROUND_UP(height, 4), 16);
1050 y_meta_plane = ALIGN(y_meta_stride * y_meta_scanlines, SZ_4K);
1051 uv_meta_stride = ALIGN(DIV_ROUND_UP((width + 1) >> 1, 24), 64);
1052 uv_meta_scanlines = ALIGN(DIV_ROUND_UP((height + 1) >> 1, 4), 16);
1053 uv_meta_plane = ALIGN(uv_meta_stride * uv_meta_scanlines, SZ_4K);
1054
1055 size = y_ubwc_plane + uv_ubwc_plane + y_meta_plane + uv_meta_plane;
1056 size += max(extradata + SZ_8K, y_stride * 48);
1057
1058 return ALIGN(size, SZ_4K);
1059 }
1060
venus_helper_get_framesz_raw(u32 hfi_fmt,u32 width,u32 height)1061 u32 venus_helper_get_framesz_raw(u32 hfi_fmt, u32 width, u32 height)
1062 {
1063 switch (hfi_fmt) {
1064 case HFI_COLOR_FORMAT_NV12:
1065 case HFI_COLOR_FORMAT_NV21:
1066 return get_framesize_raw_nv12(width, height);
1067 case HFI_COLOR_FORMAT_NV12_UBWC:
1068 return get_framesize_raw_nv12_ubwc(width, height);
1069 case HFI_COLOR_FORMAT_P010:
1070 return get_framesize_raw_p010(width, height);
1071 case HFI_COLOR_FORMAT_P010_UBWC:
1072 return get_framesize_raw_p010_ubwc(width, height);
1073 case HFI_COLOR_FORMAT_YUV420_TP10_UBWC:
1074 return get_framesize_raw_yuv420_tp10_ubwc(width, height);
1075 default:
1076 return 0;
1077 }
1078 }
1079 EXPORT_SYMBOL_GPL(venus_helper_get_framesz_raw);
1080
venus_helper_get_framesz(u32 v4l2_fmt,u32 width,u32 height)1081 u32 venus_helper_get_framesz(u32 v4l2_fmt, u32 width, u32 height)
1082 {
1083 u32 hfi_fmt, sz;
1084 bool compressed;
1085
1086 switch (v4l2_fmt) {
1087 case V4L2_PIX_FMT_MPEG:
1088 case V4L2_PIX_FMT_H264:
1089 case V4L2_PIX_FMT_H264_NO_SC:
1090 case V4L2_PIX_FMT_H264_MVC:
1091 case V4L2_PIX_FMT_H263:
1092 case V4L2_PIX_FMT_MPEG1:
1093 case V4L2_PIX_FMT_MPEG2:
1094 case V4L2_PIX_FMT_MPEG4:
1095 case V4L2_PIX_FMT_XVID:
1096 case V4L2_PIX_FMT_VC1_ANNEX_G:
1097 case V4L2_PIX_FMT_VC1_ANNEX_L:
1098 case V4L2_PIX_FMT_VP8:
1099 case V4L2_PIX_FMT_VP9:
1100 case V4L2_PIX_FMT_HEVC:
1101 compressed = true;
1102 break;
1103 default:
1104 compressed = false;
1105 break;
1106 }
1107
1108 if (compressed) {
1109 sz = ALIGN(height, 32) * ALIGN(width, 32) * 3 / 2 / 2;
1110 if (width < 1280 || height < 720)
1111 sz *= 8;
1112 return ALIGN(sz, SZ_4K);
1113 }
1114
1115 hfi_fmt = to_hfi_raw_fmt(v4l2_fmt);
1116 if (!hfi_fmt)
1117 return 0;
1118
1119 return venus_helper_get_framesz_raw(hfi_fmt, width, height);
1120 }
1121 EXPORT_SYMBOL_GPL(venus_helper_get_framesz);
1122
venus_helper_set_input_resolution(struct venus_inst * inst,unsigned int width,unsigned int height)1123 int venus_helper_set_input_resolution(struct venus_inst *inst,
1124 unsigned int width, unsigned int height)
1125 {
1126 u32 ptype = HFI_PROPERTY_PARAM_FRAME_SIZE;
1127 struct hfi_framesize fs;
1128
1129 fs.buffer_type = HFI_BUFFER_INPUT;
1130 fs.width = width;
1131 fs.height = height;
1132
1133 return hfi_session_set_property(inst, ptype, &fs);
1134 }
1135 EXPORT_SYMBOL_GPL(venus_helper_set_input_resolution);
1136
venus_helper_set_output_resolution(struct venus_inst * inst,unsigned int width,unsigned int height,u32 buftype)1137 int venus_helper_set_output_resolution(struct venus_inst *inst,
1138 unsigned int width, unsigned int height,
1139 u32 buftype)
1140 {
1141 u32 ptype = HFI_PROPERTY_PARAM_FRAME_SIZE;
1142 struct hfi_framesize fs;
1143
1144 fs.buffer_type = buftype;
1145 fs.width = width;
1146 fs.height = height;
1147
1148 return hfi_session_set_property(inst, ptype, &fs);
1149 }
1150 EXPORT_SYMBOL_GPL(venus_helper_set_output_resolution);
1151
venus_helper_get_work_mode(struct venus_inst * inst)1152 static u32 venus_helper_get_work_mode(struct venus_inst *inst)
1153 {
1154 u32 mode;
1155 u32 num_mbs;
1156
1157 mode = VIDC_WORK_MODE_2;
1158 if (inst->session_type == VIDC_SESSION_TYPE_DEC) {
1159 num_mbs = (ALIGN(inst->height, 16) * ALIGN(inst->width, 16)) / 256;
1160 if (inst->hfi_codec == HFI_VIDEO_CODEC_MPEG2 ||
1161 inst->pic_struct != HFI_INTERLACE_FRAME_PROGRESSIVE ||
1162 num_mbs <= NUM_MBS_720P)
1163 mode = VIDC_WORK_MODE_1;
1164 } else {
1165 num_mbs = (ALIGN(inst->out_height, 16) * ALIGN(inst->out_width, 16)) / 256;
1166 if (inst->hfi_codec == HFI_VIDEO_CODEC_VP8 &&
1167 num_mbs <= NUM_MBS_4K)
1168 mode = VIDC_WORK_MODE_1;
1169 }
1170
1171 return mode;
1172 }
1173
venus_helper_set_work_mode(struct venus_inst * inst)1174 int venus_helper_set_work_mode(struct venus_inst *inst)
1175 {
1176 const u32 ptype = HFI_PROPERTY_PARAM_WORK_MODE;
1177 struct hfi_video_work_mode wm;
1178 u32 mode;
1179
1180 if (!IS_V4(inst->core) && !IS_V6(inst->core))
1181 return 0;
1182
1183 mode = venus_helper_get_work_mode(inst);
1184 wm.video_work_mode = mode;
1185 return hfi_session_set_property(inst, ptype, &wm);
1186 }
1187 EXPORT_SYMBOL_GPL(venus_helper_set_work_mode);
1188
venus_helper_set_format_constraints(struct venus_inst * inst)1189 int venus_helper_set_format_constraints(struct venus_inst *inst)
1190 {
1191 const u32 ptype = HFI_PROPERTY_PARAM_UNCOMPRESSED_PLANE_ACTUAL_CONSTRAINTS_INFO;
1192 struct hfi_uncompressed_plane_actual_constraints_info pconstraint;
1193
1194 if (!IS_V6(inst->core))
1195 return 0;
1196
1197 if (inst->opb_fmt == HFI_COLOR_FORMAT_NV12_UBWC ||
1198 inst->opb_fmt == HFI_COLOR_FORMAT_YUV420_TP10_UBWC)
1199 return 0;
1200
1201 pconstraint.buffer_type = HFI_BUFFER_OUTPUT2;
1202 pconstraint.num_planes = 2;
1203 pconstraint.plane_format[0].stride_multiples = 128;
1204 pconstraint.plane_format[0].max_stride = 8192;
1205 pconstraint.plane_format[0].min_plane_buffer_height_multiple = 32;
1206 pconstraint.plane_format[0].buffer_alignment = 256;
1207
1208 pconstraint.plane_format[1].stride_multiples = 128;
1209 pconstraint.plane_format[1].max_stride = 8192;
1210 pconstraint.plane_format[1].min_plane_buffer_height_multiple = 16;
1211 pconstraint.plane_format[1].buffer_alignment = 256;
1212
1213 return hfi_session_set_property(inst, ptype, &pconstraint);
1214 }
1215 EXPORT_SYMBOL_GPL(venus_helper_set_format_constraints);
1216
venus_helper_set_num_bufs(struct venus_inst * inst,unsigned int input_bufs,unsigned int output_bufs,unsigned int output2_bufs)1217 int venus_helper_set_num_bufs(struct venus_inst *inst, unsigned int input_bufs,
1218 unsigned int output_bufs,
1219 unsigned int output2_bufs)
1220 {
1221 u32 ptype = HFI_PROPERTY_PARAM_BUFFER_COUNT_ACTUAL;
1222 struct hfi_buffer_count_actual buf_count;
1223 int ret;
1224
1225 buf_count.type = HFI_BUFFER_INPUT;
1226 buf_count.count_actual = input_bufs;
1227
1228 ret = hfi_session_set_property(inst, ptype, &buf_count);
1229 if (ret)
1230 return ret;
1231
1232 buf_count.type = HFI_BUFFER_OUTPUT;
1233 buf_count.count_actual = output_bufs;
1234
1235 ret = hfi_session_set_property(inst, ptype, &buf_count);
1236 if (ret)
1237 return ret;
1238
1239 if (output2_bufs) {
1240 buf_count.type = HFI_BUFFER_OUTPUT2;
1241 buf_count.count_actual = output2_bufs;
1242
1243 ret = hfi_session_set_property(inst, ptype, &buf_count);
1244 }
1245
1246 return ret;
1247 }
1248 EXPORT_SYMBOL_GPL(venus_helper_set_num_bufs);
1249
venus_helper_set_raw_format(struct venus_inst * inst,u32 hfi_format,u32 buftype)1250 int venus_helper_set_raw_format(struct venus_inst *inst, u32 hfi_format,
1251 u32 buftype)
1252 {
1253 const u32 ptype = HFI_PROPERTY_PARAM_UNCOMPRESSED_FORMAT_SELECT;
1254 struct hfi_uncompressed_format_select fmt;
1255
1256 fmt.buffer_type = buftype;
1257 fmt.format = hfi_format;
1258
1259 return hfi_session_set_property(inst, ptype, &fmt);
1260 }
1261 EXPORT_SYMBOL_GPL(venus_helper_set_raw_format);
1262
venus_helper_set_color_format(struct venus_inst * inst,u32 pixfmt)1263 int venus_helper_set_color_format(struct venus_inst *inst, u32 pixfmt)
1264 {
1265 u32 hfi_format, buftype;
1266
1267 if (inst->session_type == VIDC_SESSION_TYPE_DEC)
1268 buftype = HFI_BUFFER_OUTPUT;
1269 else if (inst->session_type == VIDC_SESSION_TYPE_ENC)
1270 buftype = HFI_BUFFER_INPUT;
1271 else
1272 return -EINVAL;
1273
1274 hfi_format = to_hfi_raw_fmt(pixfmt);
1275 if (!hfi_format)
1276 return -EINVAL;
1277
1278 return venus_helper_set_raw_format(inst, hfi_format, buftype);
1279 }
1280 EXPORT_SYMBOL_GPL(venus_helper_set_color_format);
1281
venus_helper_set_multistream(struct venus_inst * inst,bool out_en,bool out2_en)1282 int venus_helper_set_multistream(struct venus_inst *inst, bool out_en,
1283 bool out2_en)
1284 {
1285 struct hfi_multi_stream multi = {0};
1286 u32 ptype = HFI_PROPERTY_PARAM_VDEC_MULTI_STREAM;
1287 int ret;
1288
1289 multi.buffer_type = HFI_BUFFER_OUTPUT;
1290 multi.enable = out_en;
1291
1292 ret = hfi_session_set_property(inst, ptype, &multi);
1293 if (ret)
1294 return ret;
1295
1296 multi.buffer_type = HFI_BUFFER_OUTPUT2;
1297 multi.enable = out2_en;
1298
1299 return hfi_session_set_property(inst, ptype, &multi);
1300 }
1301 EXPORT_SYMBOL_GPL(venus_helper_set_multistream);
1302
venus_helper_set_dyn_bufmode(struct venus_inst * inst)1303 int venus_helper_set_dyn_bufmode(struct venus_inst *inst)
1304 {
1305 const u32 ptype = HFI_PROPERTY_PARAM_BUFFER_ALLOC_MODE;
1306 struct hfi_buffer_alloc_mode mode;
1307 int ret;
1308
1309 if (!is_dynamic_bufmode(inst))
1310 return 0;
1311
1312 mode.type = HFI_BUFFER_OUTPUT;
1313 mode.mode = HFI_BUFFER_MODE_DYNAMIC;
1314
1315 ret = hfi_session_set_property(inst, ptype, &mode);
1316 if (ret)
1317 return ret;
1318
1319 mode.type = HFI_BUFFER_OUTPUT2;
1320
1321 return hfi_session_set_property(inst, ptype, &mode);
1322 }
1323 EXPORT_SYMBOL_GPL(venus_helper_set_dyn_bufmode);
1324
venus_helper_set_bufsize(struct venus_inst * inst,u32 bufsize,u32 buftype)1325 int venus_helper_set_bufsize(struct venus_inst *inst, u32 bufsize, u32 buftype)
1326 {
1327 const u32 ptype = HFI_PROPERTY_PARAM_BUFFER_SIZE_ACTUAL;
1328 struct hfi_buffer_size_actual bufsz;
1329
1330 bufsz.type = buftype;
1331 bufsz.size = bufsize;
1332
1333 return hfi_session_set_property(inst, ptype, &bufsz);
1334 }
1335 EXPORT_SYMBOL_GPL(venus_helper_set_bufsize);
1336
venus_helper_get_opb_size(struct venus_inst * inst)1337 unsigned int venus_helper_get_opb_size(struct venus_inst *inst)
1338 {
1339 /* the encoder has only one output */
1340 if (inst->session_type == VIDC_SESSION_TYPE_ENC)
1341 return inst->output_buf_size;
1342
1343 if (inst->opb_buftype == HFI_BUFFER_OUTPUT)
1344 return inst->output_buf_size;
1345 else if (inst->opb_buftype == HFI_BUFFER_OUTPUT2)
1346 return inst->output2_buf_size;
1347
1348 return 0;
1349 }
1350 EXPORT_SYMBOL_GPL(venus_helper_get_opb_size);
1351
delayed_process_buf_func(struct work_struct * work)1352 static void delayed_process_buf_func(struct work_struct *work)
1353 {
1354 struct venus_buffer *buf, *n;
1355 struct venus_inst *inst;
1356 int ret;
1357
1358 inst = container_of(work, struct venus_inst, delayed_process_work);
1359
1360 mutex_lock(&inst->lock);
1361
1362 if (!(inst->streamon_out & inst->streamon_cap))
1363 goto unlock;
1364
1365 list_for_each_entry_safe(buf, n, &inst->delayed_process, ref_list) {
1366 if (buf->flags & HFI_BUFFERFLAG_READONLY)
1367 continue;
1368
1369 ret = session_process_buf(inst, &buf->vb);
1370 if (ret)
1371 return_buf_error(inst, &buf->vb);
1372
1373 list_del_init(&buf->ref_list);
1374 }
1375 unlock:
1376 mutex_unlock(&inst->lock);
1377 }
1378
venus_helper_release_buf_ref(struct venus_inst * inst,unsigned int idx)1379 void venus_helper_release_buf_ref(struct venus_inst *inst, unsigned int idx)
1380 {
1381 struct venus_buffer *buf;
1382
1383 list_for_each_entry(buf, &inst->registeredbufs, reg_list) {
1384 if (buf->vb.vb2_buf.index == idx) {
1385 buf->flags &= ~HFI_BUFFERFLAG_READONLY;
1386 schedule_work(&inst->delayed_process_work);
1387 break;
1388 }
1389 }
1390 }
1391 EXPORT_SYMBOL_GPL(venus_helper_release_buf_ref);
1392
venus_helper_acquire_buf_ref(struct vb2_v4l2_buffer * vbuf)1393 void venus_helper_acquire_buf_ref(struct vb2_v4l2_buffer *vbuf)
1394 {
1395 struct venus_buffer *buf = to_venus_buffer(vbuf);
1396
1397 buf->flags |= HFI_BUFFERFLAG_READONLY;
1398 }
1399 EXPORT_SYMBOL_GPL(venus_helper_acquire_buf_ref);
1400
is_buf_refed(struct venus_inst * inst,struct vb2_v4l2_buffer * vbuf)1401 static int is_buf_refed(struct venus_inst *inst, struct vb2_v4l2_buffer *vbuf)
1402 {
1403 struct venus_buffer *buf = to_venus_buffer(vbuf);
1404
1405 if (buf->flags & HFI_BUFFERFLAG_READONLY) {
1406 list_add_tail(&buf->ref_list, &inst->delayed_process);
1407 schedule_work(&inst->delayed_process_work);
1408 return 1;
1409 }
1410
1411 return 0;
1412 }
1413
1414 struct vb2_v4l2_buffer *
venus_helper_find_buf(struct venus_inst * inst,unsigned int type,u32 idx)1415 venus_helper_find_buf(struct venus_inst *inst, unsigned int type, u32 idx)
1416 {
1417 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1418
1419 if (type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
1420 return v4l2_m2m_src_buf_remove_by_idx(m2m_ctx, idx);
1421 else
1422 return v4l2_m2m_dst_buf_remove_by_idx(m2m_ctx, idx);
1423 }
1424 EXPORT_SYMBOL_GPL(venus_helper_find_buf);
1425
venus_helper_change_dpb_owner(struct venus_inst * inst,struct vb2_v4l2_buffer * vbuf,unsigned int type,unsigned int buf_type,u32 tag)1426 void venus_helper_change_dpb_owner(struct venus_inst *inst,
1427 struct vb2_v4l2_buffer *vbuf, unsigned int type,
1428 unsigned int buf_type, u32 tag)
1429 {
1430 struct intbuf *dpb_buf;
1431
1432 if (!V4L2_TYPE_IS_CAPTURE(type) ||
1433 buf_type != inst->dpb_buftype)
1434 return;
1435
1436 list_for_each_entry(dpb_buf, &inst->dpbbufs, list)
1437 if (dpb_buf->dpb_out_tag == tag) {
1438 dpb_buf->owned_by = DRIVER;
1439 break;
1440 }
1441 }
1442 EXPORT_SYMBOL_GPL(venus_helper_change_dpb_owner);
1443
venus_helper_vb2_buf_init(struct vb2_buffer * vb)1444 int venus_helper_vb2_buf_init(struct vb2_buffer *vb)
1445 {
1446 struct venus_inst *inst = vb2_get_drv_priv(vb->vb2_queue);
1447 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1448 struct venus_buffer *buf = to_venus_buffer(vbuf);
1449
1450 buf->size = vb2_plane_size(vb, 0);
1451 buf->dma_addr = vb2_dma_contig_plane_dma_addr(vb, 0);
1452
1453 if (vb->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
1454 list_add_tail(&buf->reg_list, &inst->registeredbufs);
1455
1456 return 0;
1457 }
1458 EXPORT_SYMBOL_GPL(venus_helper_vb2_buf_init);
1459
venus_helper_vb2_buf_prepare(struct vb2_buffer * vb)1460 int venus_helper_vb2_buf_prepare(struct vb2_buffer *vb)
1461 {
1462 struct venus_inst *inst = vb2_get_drv_priv(vb->vb2_queue);
1463 unsigned int out_buf_size = venus_helper_get_opb_size(inst);
1464 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1465
1466 if (V4L2_TYPE_IS_OUTPUT(vb->vb2_queue->type)) {
1467 if (vbuf->field == V4L2_FIELD_ANY)
1468 vbuf->field = V4L2_FIELD_NONE;
1469 if (vbuf->field != V4L2_FIELD_NONE) {
1470 dev_err(inst->core->dev, "%s field isn't supported\n",
1471 __func__);
1472 return -EINVAL;
1473 }
1474 }
1475
1476 if (vb->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE &&
1477 vb2_plane_size(vb, 0) < out_buf_size)
1478 return -EINVAL;
1479 if (vb->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE &&
1480 vb2_plane_size(vb, 0) < inst->input_buf_size)
1481 return -EINVAL;
1482
1483 return 0;
1484 }
1485 EXPORT_SYMBOL_GPL(venus_helper_vb2_buf_prepare);
1486
cache_payload(struct venus_inst * inst,struct vb2_buffer * vb)1487 static void cache_payload(struct venus_inst *inst, struct vb2_buffer *vb)
1488 {
1489 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1490 unsigned int idx = vbuf->vb2_buf.index;
1491
1492 if (vbuf->vb2_buf.type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
1493 inst->payloads[idx] = vb2_get_plane_payload(vb, 0);
1494 }
1495
venus_helper_vb2_buf_queue(struct vb2_buffer * vb)1496 void venus_helper_vb2_buf_queue(struct vb2_buffer *vb)
1497 {
1498 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1499 struct venus_inst *inst = vb2_get_drv_priv(vb->vb2_queue);
1500 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1501 int ret;
1502
1503 v4l2_m2m_buf_queue(m2m_ctx, vbuf);
1504
1505 /* Skip processing queued capture buffers after LAST flag */
1506 if (inst->session_type == VIDC_SESSION_TYPE_DEC &&
1507 V4L2_TYPE_IS_CAPTURE(vb->vb2_queue->type) &&
1508 inst->codec_state == VENUS_DEC_STATE_DRC)
1509 return;
1510
1511 cache_payload(inst, vb);
1512
1513 if (inst->session_type == VIDC_SESSION_TYPE_ENC &&
1514 !(inst->streamon_out && inst->streamon_cap))
1515 return;
1516
1517 if (vb2_start_streaming_called(vb->vb2_queue)) {
1518 ret = is_buf_refed(inst, vbuf);
1519 if (ret)
1520 return;
1521
1522 ret = session_process_buf(inst, vbuf);
1523 if (ret)
1524 return_buf_error(inst, vbuf);
1525 }
1526 }
1527 EXPORT_SYMBOL_GPL(venus_helper_vb2_buf_queue);
1528
venus_helper_buffers_done(struct venus_inst * inst,unsigned int type,enum vb2_buffer_state state)1529 void venus_helper_buffers_done(struct venus_inst *inst, unsigned int type,
1530 enum vb2_buffer_state state)
1531 {
1532 struct vb2_v4l2_buffer *buf;
1533
1534 if (type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE) {
1535 while ((buf = v4l2_m2m_src_buf_remove(inst->m2m_ctx)))
1536 v4l2_m2m_buf_done(buf, state);
1537 } else if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
1538 while ((buf = v4l2_m2m_dst_buf_remove(inst->m2m_ctx)))
1539 v4l2_m2m_buf_done(buf, state);
1540 }
1541 }
1542 EXPORT_SYMBOL_GPL(venus_helper_buffers_done);
1543
venus_helper_vb2_stop_streaming(struct vb2_queue * q)1544 void venus_helper_vb2_stop_streaming(struct vb2_queue *q)
1545 {
1546 struct venus_inst *inst = vb2_get_drv_priv(q);
1547 struct venus_core *core = inst->core;
1548 int ret;
1549
1550 mutex_lock(&inst->lock);
1551
1552 if (inst->streamon_out & inst->streamon_cap) {
1553 ret = hfi_session_stop(inst);
1554 ret |= hfi_session_unload_res(inst);
1555 ret |= venus_helper_unregister_bufs(inst);
1556 ret |= venus_helper_intbufs_free(inst);
1557 ret |= hfi_session_deinit(inst);
1558
1559 if (inst->session_error || test_bit(0, &core->sys_error))
1560 ret = -EIO;
1561
1562 if (ret)
1563 hfi_session_abort(inst);
1564
1565 venus_helper_free_dpb_bufs(inst);
1566
1567 venus_pm_load_scale(inst);
1568 INIT_LIST_HEAD(&inst->registeredbufs);
1569 }
1570
1571 venus_helper_buffers_done(inst, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE,
1572 VB2_BUF_STATE_ERROR);
1573 venus_helper_buffers_done(inst, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE,
1574 VB2_BUF_STATE_ERROR);
1575
1576 if (q->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
1577 inst->streamon_out = 0;
1578 else
1579 inst->streamon_cap = 0;
1580
1581 venus_pm_release_core(inst);
1582
1583 inst->session_error = 0;
1584
1585 mutex_unlock(&inst->lock);
1586 }
1587 EXPORT_SYMBOL_GPL(venus_helper_vb2_stop_streaming);
1588
venus_helper_vb2_queue_error(struct venus_inst * inst)1589 void venus_helper_vb2_queue_error(struct venus_inst *inst)
1590 {
1591 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1592 struct vb2_queue *q;
1593
1594 q = v4l2_m2m_get_src_vq(m2m_ctx);
1595 vb2_queue_error(q);
1596 q = v4l2_m2m_get_dst_vq(m2m_ctx);
1597 vb2_queue_error(q);
1598 }
1599 EXPORT_SYMBOL_GPL(venus_helper_vb2_queue_error);
1600
venus_helper_process_initial_cap_bufs(struct venus_inst * inst)1601 int venus_helper_process_initial_cap_bufs(struct venus_inst *inst)
1602 {
1603 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1604 struct v4l2_m2m_buffer *buf, *n;
1605 int ret;
1606
1607 v4l2_m2m_for_each_dst_buf_safe(m2m_ctx, buf, n) {
1608 ret = session_process_buf(inst, &buf->vb);
1609 if (ret) {
1610 return_buf_error(inst, &buf->vb);
1611 return ret;
1612 }
1613 }
1614
1615 return 0;
1616 }
1617 EXPORT_SYMBOL_GPL(venus_helper_process_initial_cap_bufs);
1618
venus_helper_process_initial_out_bufs(struct venus_inst * inst)1619 int venus_helper_process_initial_out_bufs(struct venus_inst *inst)
1620 {
1621 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1622 struct v4l2_m2m_buffer *buf, *n;
1623 int ret;
1624
1625 v4l2_m2m_for_each_src_buf_safe(m2m_ctx, buf, n) {
1626 ret = session_process_buf(inst, &buf->vb);
1627 if (ret) {
1628 return_buf_error(inst, &buf->vb);
1629 return ret;
1630 }
1631 }
1632
1633 return 0;
1634 }
1635 EXPORT_SYMBOL_GPL(venus_helper_process_initial_out_bufs);
1636
venus_helper_vb2_start_streaming(struct venus_inst * inst)1637 int venus_helper_vb2_start_streaming(struct venus_inst *inst)
1638 {
1639 int ret;
1640
1641 ret = venus_helper_intbufs_alloc(inst);
1642 if (ret)
1643 return ret;
1644
1645 ret = session_register_bufs(inst);
1646 if (ret)
1647 goto err_bufs_free;
1648
1649 venus_pm_load_scale(inst);
1650
1651 ret = hfi_session_load_res(inst);
1652 if (ret)
1653 goto err_unreg_bufs;
1654
1655 ret = hfi_session_start(inst);
1656 if (ret)
1657 goto err_unload_res;
1658
1659 return 0;
1660
1661 err_unload_res:
1662 hfi_session_unload_res(inst);
1663 err_unreg_bufs:
1664 venus_helper_unregister_bufs(inst);
1665 err_bufs_free:
1666 venus_helper_intbufs_free(inst);
1667 return ret;
1668 }
1669 EXPORT_SYMBOL_GPL(venus_helper_vb2_start_streaming);
1670
venus_helper_m2m_device_run(void * priv)1671 void venus_helper_m2m_device_run(void *priv)
1672 {
1673 struct venus_inst *inst = priv;
1674 struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1675 struct v4l2_m2m_buffer *buf, *n;
1676 int ret;
1677
1678 mutex_lock(&inst->lock);
1679
1680 v4l2_m2m_for_each_dst_buf_safe(m2m_ctx, buf, n) {
1681 ret = session_process_buf(inst, &buf->vb);
1682 if (ret)
1683 return_buf_error(inst, &buf->vb);
1684 }
1685
1686 v4l2_m2m_for_each_src_buf_safe(m2m_ctx, buf, n) {
1687 ret = session_process_buf(inst, &buf->vb);
1688 if (ret)
1689 return_buf_error(inst, &buf->vb);
1690 }
1691
1692 mutex_unlock(&inst->lock);
1693 }
1694 EXPORT_SYMBOL_GPL(venus_helper_m2m_device_run);
1695
venus_helper_m2m_job_abort(void * priv)1696 void venus_helper_m2m_job_abort(void *priv)
1697 {
1698 struct venus_inst *inst = priv;
1699
1700 v4l2_m2m_job_finish(inst->m2m_dev, inst->m2m_ctx);
1701 }
1702 EXPORT_SYMBOL_GPL(venus_helper_m2m_job_abort);
1703
venus_helper_session_init(struct venus_inst * inst)1704 int venus_helper_session_init(struct venus_inst *inst)
1705 {
1706 enum hfi_version version = inst->core->res->hfi_version;
1707 u32 session_type = inst->session_type;
1708 u32 codec;
1709 int ret;
1710
1711 codec = inst->session_type == VIDC_SESSION_TYPE_DEC ?
1712 inst->fmt_out->pixfmt : inst->fmt_cap->pixfmt;
1713
1714 ret = hfi_session_init(inst, codec);
1715 if (ret)
1716 return ret;
1717
1718 inst->clk_data.vpp_freq = hfi_platform_get_codec_vpp_freq(version, codec,
1719 session_type);
1720 inst->clk_data.vsp_freq = hfi_platform_get_codec_vsp_freq(version, codec,
1721 session_type);
1722 inst->clk_data.low_power_freq = hfi_platform_get_codec_lp_freq(version, codec,
1723 session_type);
1724
1725 return 0;
1726 }
1727 EXPORT_SYMBOL_GPL(venus_helper_session_init);
1728
venus_helper_init_instance(struct venus_inst * inst)1729 void venus_helper_init_instance(struct venus_inst *inst)
1730 {
1731 if (inst->session_type == VIDC_SESSION_TYPE_DEC) {
1732 INIT_LIST_HEAD(&inst->delayed_process);
1733 INIT_WORK(&inst->delayed_process_work,
1734 delayed_process_buf_func);
1735 }
1736 }
1737 EXPORT_SYMBOL_GPL(venus_helper_init_instance);
1738
find_fmt_from_caps(struct hfi_plat_caps * caps,u32 buftype,u32 fmt)1739 static bool find_fmt_from_caps(struct hfi_plat_caps *caps, u32 buftype, u32 fmt)
1740 {
1741 unsigned int i;
1742
1743 for (i = 0; i < caps->num_fmts; i++) {
1744 if (caps->fmts[i].buftype == buftype &&
1745 caps->fmts[i].fmt == fmt)
1746 return true;
1747 }
1748
1749 return false;
1750 }
1751
venus_helper_get_out_fmts(struct venus_inst * inst,u32 v4l2_fmt,u32 * out_fmt,u32 * out2_fmt,bool ubwc)1752 int venus_helper_get_out_fmts(struct venus_inst *inst, u32 v4l2_fmt,
1753 u32 *out_fmt, u32 *out2_fmt, bool ubwc)
1754 {
1755 struct venus_core *core = inst->core;
1756 struct hfi_plat_caps *caps;
1757 u32 ubwc_fmt, fmt = to_hfi_raw_fmt(v4l2_fmt);
1758 bool found, found_ubwc;
1759
1760 *out_fmt = *out2_fmt = 0;
1761
1762 if (!fmt)
1763 return -EINVAL;
1764
1765 caps = venus_caps_by_codec(core, inst->hfi_codec, inst->session_type);
1766 if (!caps)
1767 return -EINVAL;
1768
1769 if (ubwc) {
1770 ubwc_fmt = fmt | HFI_COLOR_FORMAT_UBWC_BASE;
1771 found_ubwc = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT,
1772 ubwc_fmt);
1773 found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT2, fmt);
1774
1775 if (found_ubwc && found) {
1776 *out_fmt = ubwc_fmt;
1777 *out2_fmt = fmt;
1778 return 0;
1779 }
1780 }
1781
1782 found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT, fmt);
1783 if (found) {
1784 *out_fmt = fmt;
1785 *out2_fmt = 0;
1786 return 0;
1787 }
1788
1789 found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT2, fmt);
1790 if (found) {
1791 *out_fmt = 0;
1792 *out2_fmt = fmt;
1793 return 0;
1794 }
1795
1796 return -EINVAL;
1797 }
1798 EXPORT_SYMBOL_GPL(venus_helper_get_out_fmts);
1799
venus_helper_check_format(struct venus_inst * inst,u32 v4l2_pixfmt)1800 bool venus_helper_check_format(struct venus_inst *inst, u32 v4l2_pixfmt)
1801 {
1802 struct venus_core *core = inst->core;
1803 u32 fmt = to_hfi_raw_fmt(v4l2_pixfmt);
1804 struct hfi_plat_caps *caps;
1805 u32 buftype;
1806
1807 if (!fmt)
1808 return false;
1809
1810 caps = venus_caps_by_codec(core, inst->hfi_codec, inst->session_type);
1811 if (!caps)
1812 return false;
1813
1814 if (inst->session_type == VIDC_SESSION_TYPE_DEC)
1815 buftype = HFI_BUFFER_OUTPUT2;
1816 else
1817 buftype = HFI_BUFFER_OUTPUT;
1818
1819 return find_fmt_from_caps(caps, buftype, fmt);
1820 }
1821 EXPORT_SYMBOL_GPL(venus_helper_check_format);
1822
venus_helper_set_stride(struct venus_inst * inst,unsigned int width,unsigned int height)1823 int venus_helper_set_stride(struct venus_inst *inst,
1824 unsigned int width, unsigned int height)
1825 {
1826 const u32 ptype = HFI_PROPERTY_PARAM_UNCOMPRESSED_PLANE_ACTUAL_INFO;
1827
1828 struct hfi_uncompressed_plane_actual_info plane_actual_info;
1829
1830 plane_actual_info.buffer_type = HFI_BUFFER_INPUT;
1831 plane_actual_info.num_planes = 2;
1832 plane_actual_info.plane_format[0].actual_stride = width;
1833 plane_actual_info.plane_format[0].actual_plane_buffer_height = height;
1834 plane_actual_info.plane_format[1].actual_stride = width;
1835 plane_actual_info.plane_format[1].actual_plane_buffer_height = height / 2;
1836
1837 return hfi_session_set_property(inst, ptype, &plane_actual_info);
1838 }
1839 EXPORT_SYMBOL_GPL(venus_helper_set_stride);
1840