drivers/media/platform/qcom/venus/helpers.c

   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
  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
  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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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(&params, inst->session_type, buftype, req);
 664 }
 665
 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         memset(req, 0, sizeof(*req));
 675
 676         if (type == HFI_BUFFER_OUTPUT || type == HFI_BUFFER_OUTPUT2)
 677                 req->count_min = inst->fw_min_cnt;
 678
 679         ret = platform_get_bufreq(inst, type, req);
 680         if (!ret) {
 681                 if (type == HFI_BUFFER_OUTPUT || type == HFI_BUFFER_OUTPUT2)
 682                         inst->fw_min_cnt = req->count_min;
 683                 return 0;
 684         }
 685
 686         ret = hfi_session_get_property(inst, ptype, &hprop);
 687         if (ret)
 688                 return ret;
 689
 690         ret = -EINVAL;
 691
 692         for (i = 0; i < HFI_BUFFER_TYPE_MAX; i++) {
 693                 if (hprop.bufreq[i].type != type)
 694                         continue;
 695
 696                 memcpy(req, &hprop.bufreq[i], sizeof(*req));
 697                 ret = 0;
 698                 break;
 699         }
 700
 701         return ret;
 702 }
 703 EXPORT_SYMBOL_GPL(venus_helper_get_bufreq);
 704
 705 struct id_mapping {
 706         u32 hfi_id;
 707         u32 v4l2_id;
 708 };
 709
 710 static const struct id_mapping mpeg4_profiles[] = {
 711         { HFI_MPEG4_PROFILE_SIMPLE, V4L2_MPEG_VIDEO_MPEG4_PROFILE_SIMPLE },
 712         { HFI_MPEG4_PROFILE_ADVANCEDSIMPLE, V4L2_MPEG_VIDEO_MPEG4_PROFILE_ADVANCED_SIMPLE },
 713 };
 714
 715 static const struct id_mapping mpeg4_levels[] = {
 716         { HFI_MPEG4_LEVEL_0, V4L2_MPEG_VIDEO_MPEG4_LEVEL_0 },
 717         { HFI_MPEG4_LEVEL_0b, V4L2_MPEG_VIDEO_MPEG4_LEVEL_0B },
 718         { HFI_MPEG4_LEVEL_1, V4L2_MPEG_VIDEO_MPEG4_LEVEL_1 },
 719         { HFI_MPEG4_LEVEL_2, V4L2_MPEG_VIDEO_MPEG4_LEVEL_2 },
 720         { HFI_MPEG4_LEVEL_3, V4L2_MPEG_VIDEO_MPEG4_LEVEL_3 },
 721         { HFI_MPEG4_LEVEL_4, V4L2_MPEG_VIDEO_MPEG4_LEVEL_4 },
 722         { HFI_MPEG4_LEVEL_5, V4L2_MPEG_VIDEO_MPEG4_LEVEL_5 },
 723 };
 724
 725 static const struct id_mapping mpeg2_profiles[] = {
 726         { HFI_MPEG2_PROFILE_SIMPLE, V4L2_MPEG_VIDEO_MPEG2_PROFILE_SIMPLE },
 727         { HFI_MPEG2_PROFILE_MAIN, V4L2_MPEG_VIDEO_MPEG2_PROFILE_MAIN },
 728         { HFI_MPEG2_PROFILE_SNR, V4L2_MPEG_VIDEO_MPEG2_PROFILE_SNR_SCALABLE },
 729         { HFI_MPEG2_PROFILE_SPATIAL, V4L2_MPEG_VIDEO_MPEG2_PROFILE_SPATIALLY_SCALABLE },
 730         { HFI_MPEG2_PROFILE_HIGH, V4L2_MPEG_VIDEO_MPEG2_PROFILE_HIGH },
 731 };
 732
 733 static const struct id_mapping mpeg2_levels[] = {
 734         { HFI_MPEG2_LEVEL_LL, V4L2_MPEG_VIDEO_MPEG2_LEVEL_LOW },
 735         { HFI_MPEG2_LEVEL_ML, V4L2_MPEG_VIDEO_MPEG2_LEVEL_MAIN },
 736         { HFI_MPEG2_LEVEL_H14, V4L2_MPEG_VIDEO_MPEG2_LEVEL_HIGH_1440 },
 737         { HFI_MPEG2_LEVEL_HL, V4L2_MPEG_VIDEO_MPEG2_LEVEL_HIGH },
 738 };
 739
 740 static const struct id_mapping h264_profiles[] = {
 741         { HFI_H264_PROFILE_BASELINE, V4L2_MPEG_VIDEO_H264_PROFILE_BASELINE },
 742         { HFI_H264_PROFILE_MAIN, V4L2_MPEG_VIDEO_H264_PROFILE_MAIN },
 743         { HFI_H264_PROFILE_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_HIGH },
 744         { HFI_H264_PROFILE_STEREO_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_STEREO_HIGH },
 745         { HFI_H264_PROFILE_MULTIVIEW_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_MULTIVIEW_HIGH },
 746         { HFI_H264_PROFILE_CONSTRAINED_BASE, V4L2_MPEG_VIDEO_H264_PROFILE_CONSTRAINED_BASELINE },
 747         { HFI_H264_PROFILE_CONSTRAINED_HIGH, V4L2_MPEG_VIDEO_H264_PROFILE_CONSTRAINED_HIGH },
 748 };
 749
 750 static const struct id_mapping h264_levels[] = {
 751         { HFI_H264_LEVEL_1, V4L2_MPEG_VIDEO_H264_LEVEL_1_0 },
 752         { HFI_H264_LEVEL_1b, V4L2_MPEG_VIDEO_H264_LEVEL_1B },
 753         { HFI_H264_LEVEL_11, V4L2_MPEG_VIDEO_H264_LEVEL_1_1 },
 754         { HFI_H264_LEVEL_12, V4L2_MPEG_VIDEO_H264_LEVEL_1_2 },
 755         { HFI_H264_LEVEL_13, V4L2_MPEG_VIDEO_H264_LEVEL_1_3 },
 756         { HFI_H264_LEVEL_2, V4L2_MPEG_VIDEO_H264_LEVEL_2_0 },
 757         { HFI_H264_LEVEL_21, V4L2_MPEG_VIDEO_H264_LEVEL_2_1 },
 758         { HFI_H264_LEVEL_22, V4L2_MPEG_VIDEO_H264_LEVEL_2_2 },
 759         { HFI_H264_LEVEL_3, V4L2_MPEG_VIDEO_H264_LEVEL_3_0 },
 760         { HFI_H264_LEVEL_31, V4L2_MPEG_VIDEO_H264_LEVEL_3_1 },
 761         { HFI_H264_LEVEL_32, V4L2_MPEG_VIDEO_H264_LEVEL_3_2 },
 762         { HFI_H264_LEVEL_4, V4L2_MPEG_VIDEO_H264_LEVEL_4_0 },
 763         { HFI_H264_LEVEL_41, V4L2_MPEG_VIDEO_H264_LEVEL_4_1 },
 764         { HFI_H264_LEVEL_42, V4L2_MPEG_VIDEO_H264_LEVEL_4_2 },
 765         { HFI_H264_LEVEL_5, V4L2_MPEG_VIDEO_H264_LEVEL_5_0 },
 766         { HFI_H264_LEVEL_51, V4L2_MPEG_VIDEO_H264_LEVEL_5_1 },
 767         { HFI_H264_LEVEL_52, V4L2_MPEG_VIDEO_H264_LEVEL_5_1 },
 768 };
 769
 770 static const struct id_mapping hevc_profiles[] = {
 771         { HFI_HEVC_PROFILE_MAIN, V4L2_MPEG_VIDEO_HEVC_PROFILE_MAIN },
 772         { HFI_HEVC_PROFILE_MAIN_STILL_PIC, V4L2_MPEG_VIDEO_HEVC_PROFILE_MAIN_STILL_PICTURE },
 773         { HFI_HEVC_PROFILE_MAIN10, V4L2_MPEG_VIDEO_HEVC_PROFILE_MAIN_10 },
 774 };
 775
 776 static const struct id_mapping hevc_levels[] = {
 777         { HFI_HEVC_LEVEL_1, V4L2_MPEG_VIDEO_HEVC_LEVEL_1 },
 778         { HFI_HEVC_LEVEL_2, V4L2_MPEG_VIDEO_HEVC_LEVEL_2 },
 779         { HFI_HEVC_LEVEL_21, V4L2_MPEG_VIDEO_HEVC_LEVEL_2_1 },
 780         { HFI_HEVC_LEVEL_3, V4L2_MPEG_VIDEO_HEVC_LEVEL_3 },
 781         { HFI_HEVC_LEVEL_31, V4L2_MPEG_VIDEO_HEVC_LEVEL_3_1 },
 782         { HFI_HEVC_LEVEL_4, V4L2_MPEG_VIDEO_HEVC_LEVEL_4 },
 783         { HFI_HEVC_LEVEL_41, V4L2_MPEG_VIDEO_HEVC_LEVEL_4_1 },
 784         { HFI_HEVC_LEVEL_5, V4L2_MPEG_VIDEO_HEVC_LEVEL_5 },
 785         { HFI_HEVC_LEVEL_51, V4L2_MPEG_VIDEO_HEVC_LEVEL_5_1 },
 786         { HFI_HEVC_LEVEL_52, V4L2_MPEG_VIDEO_HEVC_LEVEL_5_2 },
 787         { HFI_HEVC_LEVEL_6, V4L2_MPEG_VIDEO_HEVC_LEVEL_6 },
 788         { HFI_HEVC_LEVEL_61, V4L2_MPEG_VIDEO_HEVC_LEVEL_6_1 },
 789         { HFI_HEVC_LEVEL_62, V4L2_MPEG_VIDEO_HEVC_LEVEL_6_2 },
 790 };
 791
 792 static const struct id_mapping vp8_profiles[] = {
 793         { HFI_VPX_PROFILE_VERSION_0, V4L2_MPEG_VIDEO_VP8_PROFILE_0 },
 794         { HFI_VPX_PROFILE_VERSION_1, V4L2_MPEG_VIDEO_VP8_PROFILE_1 },
 795         { HFI_VPX_PROFILE_VERSION_2, V4L2_MPEG_VIDEO_VP8_PROFILE_2 },
 796         { HFI_VPX_PROFILE_VERSION_3, V4L2_MPEG_VIDEO_VP8_PROFILE_3 },
 797 };
 798
 799 static const struct id_mapping vp9_profiles[] = {
 800         { HFI_VP9_PROFILE_P0, V4L2_MPEG_VIDEO_VP9_PROFILE_0 },
 801         { HFI_VP9_PROFILE_P2_10B, V4L2_MPEG_VIDEO_VP9_PROFILE_2 },
 802 };
 803
 804 static const struct id_mapping vp9_levels[] = {
 805         { HFI_VP9_LEVEL_1, V4L2_MPEG_VIDEO_VP9_LEVEL_1_0 },
 806         { HFI_VP9_LEVEL_11, V4L2_MPEG_VIDEO_VP9_LEVEL_1_1 },
 807         { HFI_VP9_LEVEL_2, V4L2_MPEG_VIDEO_VP9_LEVEL_2_0},
 808         { HFI_VP9_LEVEL_21, V4L2_MPEG_VIDEO_VP9_LEVEL_2_1 },
 809         { HFI_VP9_LEVEL_3, V4L2_MPEG_VIDEO_VP9_LEVEL_3_0},
 810         { HFI_VP9_LEVEL_31, V4L2_MPEG_VIDEO_VP9_LEVEL_3_1 },
 811         { HFI_VP9_LEVEL_4, V4L2_MPEG_VIDEO_VP9_LEVEL_4_0 },
 812         { HFI_VP9_LEVEL_41, V4L2_MPEG_VIDEO_VP9_LEVEL_4_1 },
 813         { HFI_VP9_LEVEL_5, V4L2_MPEG_VIDEO_VP9_LEVEL_5_0 },
 814         { HFI_VP9_LEVEL_51, V4L2_MPEG_VIDEO_VP9_LEVEL_5_1 },
 815         { HFI_VP9_LEVEL_6, V4L2_MPEG_VIDEO_VP9_LEVEL_6_0 },
 816         { HFI_VP9_LEVEL_61, V4L2_MPEG_VIDEO_VP9_LEVEL_6_1 },
 817 };
 818
 819 static u32 find_v4l2_id(u32 hfi_id, const struct id_mapping *array, unsigned int array_sz)
 820 {
 821         unsigned int i;
 822
 823         if (!array || !array_sz)
 824                 return 0;
 825
 826         for (i = 0; i < array_sz; i++)
 827                 if (hfi_id == array[i].hfi_id)
 828                         return array[i].v4l2_id;
 829
 830         return 0;
 831 }
 832
 833 static u32 find_hfi_id(u32 v4l2_id, const struct id_mapping *array, unsigned int array_sz)
 834 {
 835         unsigned int i;
 836
 837         if (!array || !array_sz)
 838                 return 0;
 839
 840         for (i = 0; i < array_sz; i++)
 841                 if (v4l2_id == array[i].v4l2_id)
 842                         return array[i].hfi_id;
 843
 844         return 0;
 845 }
 846
 847 static void
 848 v4l2_id_profile_level(u32 hfi_codec, struct hfi_profile_level *pl, u32 *profile, u32 *level)
 849 {
 850         u32 hfi_pf = pl->profile;
 851         u32 hfi_lvl = pl->level;
 852
 853         switch (hfi_codec) {
 854         case HFI_VIDEO_CODEC_H264:
 855                 *profile = find_v4l2_id(hfi_pf, h264_profiles, ARRAY_SIZE(h264_profiles));
 856                 *level = find_v4l2_id(hfi_lvl, h264_levels, ARRAY_SIZE(h264_levels));
 857                 break;
 858         case HFI_VIDEO_CODEC_MPEG2:
 859                 *profile = find_v4l2_id(hfi_pf, mpeg2_profiles, ARRAY_SIZE(mpeg2_profiles));
 860                 *level = find_v4l2_id(hfi_lvl, mpeg2_levels, ARRAY_SIZE(mpeg2_levels));
 861                 break;
 862         case HFI_VIDEO_CODEC_MPEG4:
 863                 *profile = find_v4l2_id(hfi_pf, mpeg4_profiles, ARRAY_SIZE(mpeg4_profiles));
 864                 *level = find_v4l2_id(hfi_lvl, mpeg4_levels, ARRAY_SIZE(mpeg4_levels));
 865                 break;
 866         case HFI_VIDEO_CODEC_VP8:
 867                 *profile = find_v4l2_id(hfi_pf, vp8_profiles, ARRAY_SIZE(vp8_profiles));
 868                 *level = 0;
 869                 break;
 870         case HFI_VIDEO_CODEC_VP9:
 871                 *profile = find_v4l2_id(hfi_pf, vp9_profiles, ARRAY_SIZE(vp9_profiles));
 872                 *level = find_v4l2_id(hfi_lvl, vp9_levels, ARRAY_SIZE(vp9_levels));
 873                 break;
 874         case HFI_VIDEO_CODEC_HEVC:
 875                 *profile = find_v4l2_id(hfi_pf, hevc_profiles, ARRAY_SIZE(hevc_profiles));
 876                 *level = find_v4l2_id(hfi_lvl, hevc_levels, ARRAY_SIZE(hevc_levels));
 877                 break;
 878         default:
 879                 break;
 880         }
 881 }
 882
 883 static void
 884 hfi_id_profile_level(u32 hfi_codec, u32 v4l2_pf, u32 v4l2_lvl, struct hfi_profile_level *pl)
 885 {
 886         switch (hfi_codec) {
 887         case HFI_VIDEO_CODEC_H264:
 888                 pl->profile = find_hfi_id(v4l2_pf, h264_profiles, ARRAY_SIZE(h264_profiles));
 889                 pl->level = find_hfi_id(v4l2_lvl, h264_levels, ARRAY_SIZE(h264_levels));
 890                 break;
 891         case HFI_VIDEO_CODEC_MPEG2:
 892                 pl->profile = find_hfi_id(v4l2_pf, mpeg2_profiles, ARRAY_SIZE(mpeg2_profiles));
 893                 pl->level = find_hfi_id(v4l2_lvl, mpeg2_levels, ARRAY_SIZE(mpeg2_levels));
 894                 break;
 895         case HFI_VIDEO_CODEC_MPEG4:
 896                 pl->profile = find_hfi_id(v4l2_pf, mpeg4_profiles, ARRAY_SIZE(mpeg4_profiles));
 897                 pl->level = find_hfi_id(v4l2_lvl, mpeg4_levels, ARRAY_SIZE(mpeg4_levels));
 898                 break;
 899         case HFI_VIDEO_CODEC_VP8:
 900                 pl->profile = find_hfi_id(v4l2_pf, vp8_profiles, ARRAY_SIZE(vp8_profiles));
 901                 pl->level = 0;
 902                 break;
 903         case HFI_VIDEO_CODEC_VP9:
 904                 pl->profile = find_hfi_id(v4l2_pf, vp9_profiles, ARRAY_SIZE(vp9_profiles));
 905                 pl->level = find_hfi_id(v4l2_lvl, vp9_levels, ARRAY_SIZE(vp9_levels));
 906                 break;
 907         case HFI_VIDEO_CODEC_HEVC:
 908                 pl->profile = find_hfi_id(v4l2_pf, hevc_profiles, ARRAY_SIZE(hevc_profiles));
 909                 pl->level = find_hfi_id(v4l2_lvl, hevc_levels, ARRAY_SIZE(hevc_levels));
 910                 break;
 911         default:
 912                 break;
 913         }
 914 }
 915
 916 int venus_helper_get_profile_level(struct venus_inst *inst, u32 *profile, u32 *level)
 917 {
 918         const u32 ptype = HFI_PROPERTY_PARAM_PROFILE_LEVEL_CURRENT;
 919         union hfi_get_property hprop;
 920         int ret;
 921
 922         ret = hfi_session_get_property(inst, ptype, &hprop);
 923         if (ret)
 924                 return ret;
 925
 926         v4l2_id_profile_level(inst->hfi_codec, &hprop.profile_level, profile, level);
 927
 928         return 0;
 929 }
 930 EXPORT_SYMBOL_GPL(venus_helper_get_profile_level);
 931
 932 int venus_helper_set_profile_level(struct venus_inst *inst, u32 profile, u32 level)
 933 {
 934         const u32 ptype = HFI_PROPERTY_PARAM_PROFILE_LEVEL_CURRENT;
 935         struct hfi_profile_level pl;
 936
 937         hfi_id_profile_level(inst->hfi_codec, profile, level, &pl);
 938
 939         return hfi_session_set_property(inst, ptype, &pl);
 940 }
 941 EXPORT_SYMBOL_GPL(venus_helper_set_profile_level);
 942
 943 static u32 get_framesize_raw_nv12(u32 width, u32 height)
 944 {
 945         u32 y_stride, uv_stride, y_plane;
 946         u32 y_sclines, uv_sclines, uv_plane;
 947         u32 size;
 948
 949         y_stride = ALIGN(width, 128);
 950         uv_stride = ALIGN(width, 128);
 951         y_sclines = ALIGN(height, 32);
 952         uv_sclines = ALIGN(((height + 1) >> 1), 16);
 953
 954         y_plane = y_stride * y_sclines;
 955         uv_plane = uv_stride * uv_sclines + SZ_4K;
 956         size = y_plane + uv_plane + SZ_8K;
 957
 958         return ALIGN(size, SZ_4K);
 959 }
 960
 961 static u32 get_framesize_raw_nv12_ubwc(u32 width, u32 height)
 962 {
 963         u32 y_meta_stride, y_meta_plane;
 964         u32 y_stride, y_plane;
 965         u32 uv_meta_stride, uv_meta_plane;
 966         u32 uv_stride, uv_plane;
 967         u32 extradata = SZ_16K;
 968
 969         y_meta_stride = ALIGN(DIV_ROUND_UP(width, 32), 64);
 970         y_meta_plane = y_meta_stride * ALIGN(DIV_ROUND_UP(height, 8), 16);
 971         y_meta_plane = ALIGN(y_meta_plane, SZ_4K);
 972
 973         y_stride = ALIGN(width, 128);
 974         y_plane = ALIGN(y_stride * ALIGN(height, 32), SZ_4K);
 975
 976         uv_meta_stride = ALIGN(DIV_ROUND_UP(width / 2, 16), 64);
 977         uv_meta_plane = uv_meta_stride * ALIGN(DIV_ROUND_UP(height / 2, 8), 16);
 978         uv_meta_plane = ALIGN(uv_meta_plane, SZ_4K);
 979
 980         uv_stride = ALIGN(width, 128);
 981         uv_plane = ALIGN(uv_stride * ALIGN(height / 2, 32), SZ_4K);
 982
 983         return ALIGN(y_meta_plane + y_plane + uv_meta_plane + uv_plane +
 984                      max(extradata, y_stride * 48), SZ_4K);
 985 }
 986
 987 static u32 get_framesize_raw_p010(u32 width, u32 height)
 988 {
 989         u32 y_plane, uv_plane, y_stride, uv_stride, y_sclines, uv_sclines;
 990
 991         y_stride = ALIGN(width * 2, 128);
 992         uv_stride = ALIGN(width * 2, 128);
 993         y_sclines = ALIGN(height, 32);
 994         uv_sclines = ALIGN((height + 1) >> 1, 16);
 995         y_plane = y_stride * y_sclines;
 996         uv_plane = uv_stride * uv_sclines;
 997
 998         return ALIGN((y_plane + uv_plane), SZ_4K);
 999 }
1000
1001 static u32 get_framesize_raw_p010_ubwc(u32 width, u32 height)
1002 {
1003         u32 y_stride, uv_stride, y_sclines, uv_sclines;
1004         u32 y_ubwc_plane, uv_ubwc_plane;
1005         u32 y_meta_stride, y_meta_scanlines;
1006         u32 uv_meta_stride, uv_meta_scanlines;
1007         u32 y_meta_plane, uv_meta_plane;
1008         u32 size;
1009
1010         y_stride = ALIGN(width * 2, 256);
1011         uv_stride = ALIGN(width * 2, 256);
1012         y_sclines = ALIGN(height, 16);
1013         uv_sclines = ALIGN((height + 1) >> 1, 16);
1014
1015         y_ubwc_plane = ALIGN(y_stride * y_sclines, SZ_4K);
1016         uv_ubwc_plane = ALIGN(uv_stride * uv_sclines, SZ_4K);
1017         y_meta_stride = ALIGN(DIV_ROUND_UP(width, 32), 64);
1018         y_meta_scanlines = ALIGN(DIV_ROUND_UP(height, 4), 16);
1019         y_meta_plane = ALIGN(y_meta_stride * y_meta_scanlines, SZ_4K);
1020         uv_meta_stride = ALIGN(DIV_ROUND_UP((width + 1) >> 1, 16), 64);
1021         uv_meta_scanlines = ALIGN(DIV_ROUND_UP((height + 1) >> 1, 4), 16);
1022         uv_meta_plane = ALIGN(uv_meta_stride * uv_meta_scanlines, SZ_4K);
1023
1024         size = y_ubwc_plane + uv_ubwc_plane + y_meta_plane + uv_meta_plane;
1025
1026         return ALIGN(size, SZ_4K);
1027 }
1028
1029 static u32 get_framesize_raw_yuv420_tp10_ubwc(u32 width, u32 height)
1030 {
1031         u32 y_stride, uv_stride, y_sclines, uv_sclines;
1032         u32 y_ubwc_plane, uv_ubwc_plane;
1033         u32 y_meta_stride, y_meta_scanlines;
1034         u32 uv_meta_stride, uv_meta_scanlines;
1035         u32 y_meta_plane, uv_meta_plane;
1036         u32 extradata = SZ_16K;
1037         u32 size;
1038
1039         y_stride = ALIGN(ALIGN(width, 192) * 4 / 3, 256);
1040         uv_stride = ALIGN(ALIGN(width, 192) * 4 / 3, 256);
1041         y_sclines = ALIGN(height, 16);
1042         uv_sclines = ALIGN((height + 1) >> 1, 16);
1043
1044         y_ubwc_plane = ALIGN(y_stride * y_sclines, SZ_4K);
1045         uv_ubwc_plane = ALIGN(uv_stride * uv_sclines, SZ_4K);
1046         y_meta_stride = ALIGN(DIV_ROUND_UP(width, 48), 64);
1047         y_meta_scanlines = ALIGN(DIV_ROUND_UP(height, 4), 16);
1048         y_meta_plane = ALIGN(y_meta_stride * y_meta_scanlines, SZ_4K);
1049         uv_meta_stride = ALIGN(DIV_ROUND_UP((width + 1) >> 1, 24), 64);
1050         uv_meta_scanlines = ALIGN(DIV_ROUND_UP((height + 1) >> 1, 4), 16);
1051         uv_meta_plane = ALIGN(uv_meta_stride * uv_meta_scanlines, SZ_4K);
1052
1053         size = y_ubwc_plane + uv_ubwc_plane + y_meta_plane + uv_meta_plane;
1054         size += max(extradata + SZ_8K, y_stride * 48);
1055
1056         return ALIGN(size, SZ_4K);
1057 }
1058
1059 u32 venus_helper_get_framesz_raw(u32 hfi_fmt, u32 width, u32 height)
1060 {
1061         switch (hfi_fmt) {
1062         case HFI_COLOR_FORMAT_NV12:
1063         case HFI_COLOR_FORMAT_NV21:
1064                 return get_framesize_raw_nv12(width, height);
1065         case HFI_COLOR_FORMAT_NV12_UBWC:
1066                 return get_framesize_raw_nv12_ubwc(width, height);
1067         case HFI_COLOR_FORMAT_P010:
1068                 return get_framesize_raw_p010(width, height);
1069         case HFI_COLOR_FORMAT_P010_UBWC:
1070                 return get_framesize_raw_p010_ubwc(width, height);
1071         case HFI_COLOR_FORMAT_YUV420_TP10_UBWC:
1072                 return get_framesize_raw_yuv420_tp10_ubwc(width, height);
1073         default:
1074                 return 0;
1075         }
1076 }
1077 EXPORT_SYMBOL_GPL(venus_helper_get_framesz_raw);
1078
1079 u32 venus_helper_get_framesz(u32 v4l2_fmt, u32 width, u32 height)
1080 {
1081         u32 hfi_fmt, sz;
1082         bool compressed;
1083
1084         switch (v4l2_fmt) {
1085         case V4L2_PIX_FMT_MPEG:
1086         case V4L2_PIX_FMT_H264:
1087         case V4L2_PIX_FMT_H264_NO_SC:
1088         case V4L2_PIX_FMT_H264_MVC:
1089         case V4L2_PIX_FMT_H263:
1090         case V4L2_PIX_FMT_MPEG1:
1091         case V4L2_PIX_FMT_MPEG2:
1092         case V4L2_PIX_FMT_MPEG4:
1093         case V4L2_PIX_FMT_XVID:
1094         case V4L2_PIX_FMT_VC1_ANNEX_G:
1095         case V4L2_PIX_FMT_VC1_ANNEX_L:
1096         case V4L2_PIX_FMT_VP8:
1097         case V4L2_PIX_FMT_VP9:
1098         case V4L2_PIX_FMT_HEVC:
1099                 compressed = true;
1100                 break;
1101         default:
1102                 compressed = false;
1103                 break;
1104         }
1105
1106         if (compressed) {
1107                 sz = ALIGN(height, 32) * ALIGN(width, 32) * 3 / 2 / 2;
1108                 if (width < 1280 || height < 720)
1109                         sz *= 8;
1110                 return ALIGN(sz, SZ_4K);
1111         }
1112
1113         hfi_fmt = to_hfi_raw_fmt(v4l2_fmt);
1114         if (!hfi_fmt)
1115                 return 0;
1116
1117         return venus_helper_get_framesz_raw(hfi_fmt, width, height);
1118 }
1119 EXPORT_SYMBOL_GPL(venus_helper_get_framesz);
1120
1121 int venus_helper_set_input_resolution(struct venus_inst *inst,
1122                                       unsigned int width, unsigned int height)
1123 {
1124         u32 ptype = HFI_PROPERTY_PARAM_FRAME_SIZE;
1125         struct hfi_framesize fs;
1126
1127         fs.buffer_type = HFI_BUFFER_INPUT;
1128         fs.width = width;
1129         fs.height = height;
1130
1131         return hfi_session_set_property(inst, ptype, &fs);
1132 }
1133 EXPORT_SYMBOL_GPL(venus_helper_set_input_resolution);
1134
1135 int venus_helper_set_output_resolution(struct venus_inst *inst,
1136                                        unsigned int width, unsigned int height,
1137                                        u32 buftype)
1138 {
1139         u32 ptype = HFI_PROPERTY_PARAM_FRAME_SIZE;
1140         struct hfi_framesize fs;
1141
1142         fs.buffer_type = buftype;
1143         fs.width = width;
1144         fs.height = height;
1145
1146         return hfi_session_set_property(inst, ptype, &fs);
1147 }
1148 EXPORT_SYMBOL_GPL(venus_helper_set_output_resolution);
1149
1150 static u32 venus_helper_get_work_mode(struct venus_inst *inst)
1151 {
1152         u32 mode;
1153         u32 num_mbs;
1154
1155         mode = VIDC_WORK_MODE_2;
1156         if (inst->session_type == VIDC_SESSION_TYPE_DEC) {
1157                 num_mbs = (ALIGN(inst->height, 16) * ALIGN(inst->width, 16)) / 256;
1158                 if (inst->hfi_codec == HFI_VIDEO_CODEC_MPEG2 ||
1159                     inst->pic_struct != HFI_INTERLACE_FRAME_PROGRESSIVE ||
1160                     num_mbs <= NUM_MBS_720P)
1161                         mode = VIDC_WORK_MODE_1;
1162         } else {
1163                 num_mbs = (ALIGN(inst->out_height, 16) * ALIGN(inst->out_width, 16)) / 256;
1164                 if (inst->hfi_codec == HFI_VIDEO_CODEC_VP8 &&
1165                     num_mbs <= NUM_MBS_4K)
1166                         mode = VIDC_WORK_MODE_1;
1167         }
1168
1169         return mode;
1170 }
1171
1172 int venus_helper_set_work_mode(struct venus_inst *inst)
1173 {
1174         const u32 ptype = HFI_PROPERTY_PARAM_WORK_MODE;
1175         struct hfi_video_work_mode wm;
1176         u32 mode;
1177
1178         if (!IS_V4(inst->core) && !IS_V6(inst->core))
1179                 return 0;
1180
1181         mode = venus_helper_get_work_mode(inst);
1182         wm.video_work_mode = mode;
1183         return hfi_session_set_property(inst, ptype, &wm);
1184 }
1185 EXPORT_SYMBOL_GPL(venus_helper_set_work_mode);
1186
1187 int venus_helper_set_format_constraints(struct venus_inst *inst)
1188 {
1189         const u32 ptype = HFI_PROPERTY_PARAM_UNCOMPRESSED_PLANE_ACTUAL_CONSTRAINTS_INFO;
1190         struct hfi_uncompressed_plane_actual_constraints_info pconstraint;
1191
1192         if (!IS_V6(inst->core))
1193                 return 0;
1194
1195         if (inst->opb_fmt == HFI_COLOR_FORMAT_NV12_UBWC ||
1196             inst->opb_fmt == HFI_COLOR_FORMAT_YUV420_TP10_UBWC)
1197                 return 0;
1198
1199         pconstraint.buffer_type = HFI_BUFFER_OUTPUT2;
1200         pconstraint.num_planes = 2;
1201         pconstraint.plane_format[0].stride_multiples = 128;
1202         pconstraint.plane_format[0].max_stride = 8192;
1203         pconstraint.plane_format[0].min_plane_buffer_height_multiple = 32;
1204         pconstraint.plane_format[0].buffer_alignment = 256;
1205
1206         pconstraint.plane_format[1].stride_multiples = 128;
1207         pconstraint.plane_format[1].max_stride = 8192;
1208         pconstraint.plane_format[1].min_plane_buffer_height_multiple = 16;
1209         pconstraint.plane_format[1].buffer_alignment = 256;
1210
1211         return hfi_session_set_property(inst, ptype, &pconstraint);
1212 }
1213 EXPORT_SYMBOL_GPL(venus_helper_set_format_constraints);
1214
1215 int venus_helper_set_num_bufs(struct venus_inst *inst, unsigned int input_bufs,
1216                               unsigned int output_bufs,
1217                               unsigned int output2_bufs)
1218 {
1219         u32 ptype = HFI_PROPERTY_PARAM_BUFFER_COUNT_ACTUAL;
1220         struct hfi_buffer_count_actual buf_count;
1221         int ret;
1222
1223         buf_count.type = HFI_BUFFER_INPUT;
1224         buf_count.count_actual = input_bufs;
1225
1226         ret = hfi_session_set_property(inst, ptype, &buf_count);
1227         if (ret)
1228                 return ret;
1229
1230         buf_count.type = HFI_BUFFER_OUTPUT;
1231         buf_count.count_actual = output_bufs;
1232
1233         ret = hfi_session_set_property(inst, ptype, &buf_count);
1234         if (ret)
1235                 return ret;
1236
1237         if (output2_bufs) {
1238                 buf_count.type = HFI_BUFFER_OUTPUT2;
1239                 buf_count.count_actual = output2_bufs;
1240
1241                 ret = hfi_session_set_property(inst, ptype, &buf_count);
1242         }
1243
1244         return ret;
1245 }
1246 EXPORT_SYMBOL_GPL(venus_helper_set_num_bufs);
1247
1248 int venus_helper_set_raw_format(struct venus_inst *inst, u32 hfi_format,
1249                                 u32 buftype)
1250 {
1251         const u32 ptype = HFI_PROPERTY_PARAM_UNCOMPRESSED_FORMAT_SELECT;
1252         struct hfi_uncompressed_format_select fmt;
1253
1254         fmt.buffer_type = buftype;
1255         fmt.format = hfi_format;
1256
1257         return hfi_session_set_property(inst, ptype, &fmt);
1258 }
1259 EXPORT_SYMBOL_GPL(venus_helper_set_raw_format);
1260
1261 int venus_helper_set_color_format(struct venus_inst *inst, u32 pixfmt)
1262 {
1263         u32 hfi_format, buftype;
1264
1265         if (inst->session_type == VIDC_SESSION_TYPE_DEC)
1266                 buftype = HFI_BUFFER_OUTPUT;
1267         else if (inst->session_type == VIDC_SESSION_TYPE_ENC)
1268                 buftype = HFI_BUFFER_INPUT;
1269         else
1270                 return -EINVAL;
1271
1272         hfi_format = to_hfi_raw_fmt(pixfmt);
1273         if (!hfi_format)
1274                 return -EINVAL;
1275
1276         return venus_helper_set_raw_format(inst, hfi_format, buftype);
1277 }
1278 EXPORT_SYMBOL_GPL(venus_helper_set_color_format);
1279
1280 int venus_helper_set_multistream(struct venus_inst *inst, bool out_en,
1281                                  bool out2_en)
1282 {
1283         struct hfi_multi_stream multi = {0};
1284         u32 ptype = HFI_PROPERTY_PARAM_VDEC_MULTI_STREAM;
1285         int ret;
1286
1287         multi.buffer_type = HFI_BUFFER_OUTPUT;
1288         multi.enable = out_en;
1289
1290         ret = hfi_session_set_property(inst, ptype, &multi);
1291         if (ret)
1292                 return ret;
1293
1294         multi.buffer_type = HFI_BUFFER_OUTPUT2;
1295         multi.enable = out2_en;
1296
1297         return hfi_session_set_property(inst, ptype, &multi);
1298 }
1299 EXPORT_SYMBOL_GPL(venus_helper_set_multistream);
1300
1301 int venus_helper_set_dyn_bufmode(struct venus_inst *inst)
1302 {
1303         const u32 ptype = HFI_PROPERTY_PARAM_BUFFER_ALLOC_MODE;
1304         struct hfi_buffer_alloc_mode mode;
1305         int ret;
1306
1307         if (!is_dynamic_bufmode(inst))
1308                 return 0;
1309
1310         mode.type = HFI_BUFFER_OUTPUT;
1311         mode.mode = HFI_BUFFER_MODE_DYNAMIC;
1312
1313         ret = hfi_session_set_property(inst, ptype, &mode);
1314         if (ret)
1315                 return ret;
1316
1317         mode.type = HFI_BUFFER_OUTPUT2;
1318
1319         return hfi_session_set_property(inst, ptype, &mode);
1320 }
1321 EXPORT_SYMBOL_GPL(venus_helper_set_dyn_bufmode);
1322
1323 int venus_helper_set_bufsize(struct venus_inst *inst, u32 bufsize, u32 buftype)
1324 {
1325         const u32 ptype = HFI_PROPERTY_PARAM_BUFFER_SIZE_ACTUAL;
1326         struct hfi_buffer_size_actual bufsz;
1327
1328         bufsz.type = buftype;
1329         bufsz.size = bufsize;
1330
1331         return hfi_session_set_property(inst, ptype, &bufsz);
1332 }
1333 EXPORT_SYMBOL_GPL(venus_helper_set_bufsize);
1334
1335 unsigned int venus_helper_get_opb_size(struct venus_inst *inst)
1336 {
1337         /* the encoder has only one output */
1338         if (inst->session_type == VIDC_SESSION_TYPE_ENC)
1339                 return inst->output_buf_size;
1340
1341         if (inst->opb_buftype == HFI_BUFFER_OUTPUT)
1342                 return inst->output_buf_size;
1343         else if (inst->opb_buftype == HFI_BUFFER_OUTPUT2)
1344                 return inst->output2_buf_size;
1345
1346         return 0;
1347 }
1348 EXPORT_SYMBOL_GPL(venus_helper_get_opb_size);
1349
1350 static void delayed_process_buf_func(struct work_struct *work)
1351 {
1352         struct venus_buffer *buf, *n;
1353         struct venus_inst *inst;
1354         int ret;
1355
1356         inst = container_of(work, struct venus_inst, delayed_process_work);
1357
1358         mutex_lock(&inst->lock);
1359
1360         if (!(inst->streamon_out & inst->streamon_cap))
1361                 goto unlock;
1362
1363         list_for_each_entry_safe(buf, n, &inst->delayed_process, ref_list) {
1364                 if (buf->flags & HFI_BUFFERFLAG_READONLY)
1365                         continue;
1366
1367                 ret = session_process_buf(inst, &buf->vb);
1368                 if (ret)
1369                         return_buf_error(inst, &buf->vb);
1370
1371                 list_del_init(&buf->ref_list);
1372         }
1373 unlock:
1374         mutex_unlock(&inst->lock);
1375 }
1376
1377 void venus_helper_release_buf_ref(struct venus_inst *inst, unsigned int idx)
1378 {
1379         struct venus_buffer *buf;
1380
1381         list_for_each_entry(buf, &inst->registeredbufs, reg_list) {
1382                 if (buf->vb.vb2_buf.index == idx) {
1383                         buf->flags &= ~HFI_BUFFERFLAG_READONLY;
1384                         schedule_work(&inst->delayed_process_work);
1385                         break;
1386                 }
1387         }
1388 }
1389 EXPORT_SYMBOL_GPL(venus_helper_release_buf_ref);
1390
1391 void venus_helper_acquire_buf_ref(struct vb2_v4l2_buffer *vbuf)
1392 {
1393         struct venus_buffer *buf = to_venus_buffer(vbuf);
1394
1395         buf->flags |= HFI_BUFFERFLAG_READONLY;
1396 }
1397 EXPORT_SYMBOL_GPL(venus_helper_acquire_buf_ref);
1398
1399 static int is_buf_refed(struct venus_inst *inst, struct vb2_v4l2_buffer *vbuf)
1400 {
1401         struct venus_buffer *buf = to_venus_buffer(vbuf);
1402
1403         if (buf->flags & HFI_BUFFERFLAG_READONLY) {
1404                 list_add_tail(&buf->ref_list, &inst->delayed_process);
1405                 schedule_work(&inst->delayed_process_work);
1406                 return 1;
1407         }
1408
1409         return 0;
1410 }
1411
1412 struct vb2_v4l2_buffer *
1413 venus_helper_find_buf(struct venus_inst *inst, unsigned int type, u32 idx)
1414 {
1415         struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1416
1417         if (type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
1418                 return v4l2_m2m_src_buf_remove_by_idx(m2m_ctx, idx);
1419         else
1420                 return v4l2_m2m_dst_buf_remove_by_idx(m2m_ctx, idx);
1421 }
1422 EXPORT_SYMBOL_GPL(venus_helper_find_buf);
1423
1424 void venus_helper_change_dpb_owner(struct venus_inst *inst,
1425                                    struct vb2_v4l2_buffer *vbuf, unsigned int type,
1426                                    unsigned int buf_type, u32 tag)
1427 {
1428         struct intbuf *dpb_buf;
1429
1430         if (!V4L2_TYPE_IS_CAPTURE(type) ||
1431             buf_type != inst->dpb_buftype)
1432                 return;
1433
1434         list_for_each_entry(dpb_buf, &inst->dpbbufs, list)
1435                 if (dpb_buf->dpb_out_tag == tag) {
1436                         dpb_buf->owned_by = DRIVER;
1437                         break;
1438                 }
1439 }
1440 EXPORT_SYMBOL_GPL(venus_helper_change_dpb_owner);
1441
1442 int venus_helper_vb2_buf_init(struct vb2_buffer *vb)
1443 {
1444         struct venus_inst *inst = vb2_get_drv_priv(vb->vb2_queue);
1445         struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1446         struct venus_buffer *buf = to_venus_buffer(vbuf);
1447
1448         buf->size = vb2_plane_size(vb, 0);
1449         buf->dma_addr = vb2_dma_contig_plane_dma_addr(vb, 0);
1450
1451         if (vb->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
1452                 list_add_tail(&buf->reg_list, &inst->registeredbufs);
1453
1454         return 0;
1455 }
1456 EXPORT_SYMBOL_GPL(venus_helper_vb2_buf_init);
1457
1458 int venus_helper_vb2_buf_prepare(struct vb2_buffer *vb)
1459 {
1460         struct venus_inst *inst = vb2_get_drv_priv(vb->vb2_queue);
1461         unsigned int out_buf_size = venus_helper_get_opb_size(inst);
1462         struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1463
1464         if (V4L2_TYPE_IS_OUTPUT(vb->vb2_queue->type)) {
1465                 if (vbuf->field == V4L2_FIELD_ANY)
1466                         vbuf->field = V4L2_FIELD_NONE;
1467                 if (vbuf->field != V4L2_FIELD_NONE) {
1468                         dev_err(inst->core->dev, "%s field isn't supported\n",
1469                                 __func__);
1470                         return -EINVAL;
1471                 }
1472         }
1473
1474         if (vb->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE &&
1475             vb2_plane_size(vb, 0) < out_buf_size)
1476                 return -EINVAL;
1477         if (vb->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE &&
1478             vb2_plane_size(vb, 0) < inst->input_buf_size)
1479                 return -EINVAL;
1480
1481         return 0;
1482 }
1483 EXPORT_SYMBOL_GPL(venus_helper_vb2_buf_prepare);
1484
1485 static void cache_payload(struct venus_inst *inst, struct vb2_buffer *vb)
1486 {
1487         struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1488         unsigned int idx = vbuf->vb2_buf.index;
1489
1490         if (vbuf->vb2_buf.type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
1491                 inst->payloads[idx] = vb2_get_plane_payload(vb, 0);
1492 }
1493
1494 void venus_helper_vb2_buf_queue(struct vb2_buffer *vb)
1495 {
1496         struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1497         struct venus_inst *inst = vb2_get_drv_priv(vb->vb2_queue);
1498         struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1499         int ret;
1500
1501         v4l2_m2m_buf_queue(m2m_ctx, vbuf);
1502
1503         /* Skip processing queued capture buffers after LAST flag */
1504         if (inst->session_type == VIDC_SESSION_TYPE_DEC &&
1505             V4L2_TYPE_IS_CAPTURE(vb->vb2_queue->type) &&
1506             inst->codec_state == VENUS_DEC_STATE_DRC)
1507                 return;
1508
1509         cache_payload(inst, vb);
1510
1511         if (inst->session_type == VIDC_SESSION_TYPE_ENC &&
1512             !(inst->streamon_out && inst->streamon_cap))
1513                 return;
1514
1515         if (vb2_start_streaming_called(vb->vb2_queue)) {
1516                 ret = is_buf_refed(inst, vbuf);
1517                 if (ret)
1518                         return;
1519
1520                 ret = session_process_buf(inst, vbuf);
1521                 if (ret)
1522                         return_buf_error(inst, vbuf);
1523         }
1524 }
1525 EXPORT_SYMBOL_GPL(venus_helper_vb2_buf_queue);
1526
1527 void venus_helper_buffers_done(struct venus_inst *inst, unsigned int type,
1528                                enum vb2_buffer_state state)
1529 {
1530         struct vb2_v4l2_buffer *buf;
1531
1532         if (type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE) {
1533                 while ((buf = v4l2_m2m_src_buf_remove(inst->m2m_ctx)))
1534                         v4l2_m2m_buf_done(buf, state);
1535         } else if (type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) {
1536                 while ((buf = v4l2_m2m_dst_buf_remove(inst->m2m_ctx)))
1537                         v4l2_m2m_buf_done(buf, state);
1538         }
1539 }
1540 EXPORT_SYMBOL_GPL(venus_helper_buffers_done);
1541
1542 void venus_helper_vb2_stop_streaming(struct vb2_queue *q)
1543 {
1544         struct venus_inst *inst = vb2_get_drv_priv(q);
1545         struct venus_core *core = inst->core;
1546         int ret;
1547
1548         mutex_lock(&inst->lock);
1549
1550         if (inst->streamon_out & inst->streamon_cap) {
1551                 ret = hfi_session_stop(inst);
1552                 ret |= hfi_session_unload_res(inst);
1553                 ret |= venus_helper_unregister_bufs(inst);
1554                 ret |= venus_helper_intbufs_free(inst);
1555                 ret |= hfi_session_deinit(inst);
1556
1557                 if (inst->session_error || test_bit(0, &core->sys_error))
1558                         ret = -EIO;
1559
1560                 if (ret)
1561                         hfi_session_abort(inst);
1562
1563                 venus_helper_free_dpb_bufs(inst);
1564
1565                 venus_pm_load_scale(inst);
1566                 INIT_LIST_HEAD(&inst->registeredbufs);
1567         }
1568
1569         venus_helper_buffers_done(inst, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE,
1570                                   VB2_BUF_STATE_ERROR);
1571         venus_helper_buffers_done(inst, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE,
1572                                   VB2_BUF_STATE_ERROR);
1573
1574         if (q->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
1575                 inst->streamon_out = 0;
1576         else
1577                 inst->streamon_cap = 0;
1578
1579         venus_pm_release_core(inst);
1580
1581         inst->session_error = 0;
1582
1583         mutex_unlock(&inst->lock);
1584 }
1585 EXPORT_SYMBOL_GPL(venus_helper_vb2_stop_streaming);
1586
1587 void venus_helper_vb2_queue_error(struct venus_inst *inst)
1588 {
1589         struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1590         struct vb2_queue *q;
1591
1592         q = v4l2_m2m_get_src_vq(m2m_ctx);
1593         vb2_queue_error(q);
1594         q = v4l2_m2m_get_dst_vq(m2m_ctx);
1595         vb2_queue_error(q);
1596 }
1597 EXPORT_SYMBOL_GPL(venus_helper_vb2_queue_error);
1598
1599 int venus_helper_process_initial_cap_bufs(struct venus_inst *inst)
1600 {
1601         struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1602         struct v4l2_m2m_buffer *buf, *n;
1603         int ret;
1604
1605         v4l2_m2m_for_each_dst_buf_safe(m2m_ctx, buf, n) {
1606                 ret = session_process_buf(inst, &buf->vb);
1607                 if (ret) {
1608                         return_buf_error(inst, &buf->vb);
1609                         return ret;
1610                 }
1611         }
1612
1613         return 0;
1614 }
1615 EXPORT_SYMBOL_GPL(venus_helper_process_initial_cap_bufs);
1616
1617 int venus_helper_process_initial_out_bufs(struct venus_inst *inst)
1618 {
1619         struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1620         struct v4l2_m2m_buffer *buf, *n;
1621         int ret;
1622
1623         v4l2_m2m_for_each_src_buf_safe(m2m_ctx, buf, n) {
1624                 ret = session_process_buf(inst, &buf->vb);
1625                 if (ret) {
1626                         return_buf_error(inst, &buf->vb);
1627                         return ret;
1628                 }
1629         }
1630
1631         return 0;
1632 }
1633 EXPORT_SYMBOL_GPL(venus_helper_process_initial_out_bufs);
1634
1635 int venus_helper_vb2_start_streaming(struct venus_inst *inst)
1636 {
1637         int ret;
1638
1639         ret = venus_helper_intbufs_alloc(inst);
1640         if (ret)
1641                 return ret;
1642
1643         ret = session_register_bufs(inst);
1644         if (ret)
1645                 goto err_bufs_free;
1646
1647         venus_pm_load_scale(inst);
1648
1649         ret = hfi_session_load_res(inst);
1650         if (ret)
1651                 goto err_unreg_bufs;
1652
1653         ret = hfi_session_start(inst);
1654         if (ret)
1655                 goto err_unload_res;
1656
1657         return 0;
1658
1659 err_unload_res:
1660         hfi_session_unload_res(inst);
1661 err_unreg_bufs:
1662         venus_helper_unregister_bufs(inst);
1663 err_bufs_free:
1664         venus_helper_intbufs_free(inst);
1665         return ret;
1666 }
1667 EXPORT_SYMBOL_GPL(venus_helper_vb2_start_streaming);
1668
1669 void venus_helper_m2m_device_run(void *priv)
1670 {
1671         struct venus_inst *inst = priv;
1672         struct v4l2_m2m_ctx *m2m_ctx = inst->m2m_ctx;
1673         struct v4l2_m2m_buffer *buf, *n;
1674         int ret;
1675
1676         mutex_lock(&inst->lock);
1677
1678         v4l2_m2m_for_each_dst_buf_safe(m2m_ctx, buf, n) {
1679                 ret = session_process_buf(inst, &buf->vb);
1680                 if (ret)
1681                         return_buf_error(inst, &buf->vb);
1682         }
1683
1684         v4l2_m2m_for_each_src_buf_safe(m2m_ctx, buf, n) {
1685                 ret = session_process_buf(inst, &buf->vb);
1686                 if (ret)
1687                         return_buf_error(inst, &buf->vb);
1688         }
1689
1690         mutex_unlock(&inst->lock);
1691 }
1692 EXPORT_SYMBOL_GPL(venus_helper_m2m_device_run);
1693
1694 void venus_helper_m2m_job_abort(void *priv)
1695 {
1696         struct venus_inst *inst = priv;
1697
1698         v4l2_m2m_job_finish(inst->m2m_dev, inst->m2m_ctx);
1699 }
1700 EXPORT_SYMBOL_GPL(venus_helper_m2m_job_abort);
1701
1702 int venus_helper_session_init(struct venus_inst *inst)
1703 {
1704         enum hfi_version version = inst->core->res->hfi_version;
1705         u32 session_type = inst->session_type;
1706         u32 codec;
1707         int ret;
1708
1709         codec = inst->session_type == VIDC_SESSION_TYPE_DEC ?
1710                         inst->fmt_out->pixfmt : inst->fmt_cap->pixfmt;
1711
1712         ret = hfi_session_init(inst, codec);
1713         if (ret)
1714                 return ret;
1715
1716         inst->clk_data.vpp_freq = hfi_platform_get_codec_vpp_freq(version, codec,
1717                                                                   session_type);
1718         inst->clk_data.vsp_freq = hfi_platform_get_codec_vsp_freq(version, codec,
1719                                                                   session_type);
1720         inst->clk_data.low_power_freq = hfi_platform_get_codec_lp_freq(version, codec,
1721                                                                        session_type);
1722
1723         return 0;
1724 }
1725 EXPORT_SYMBOL_GPL(venus_helper_session_init);
1726
1727 void venus_helper_init_instance(struct venus_inst *inst)
1728 {
1729         if (inst->session_type == VIDC_SESSION_TYPE_DEC) {
1730                 INIT_LIST_HEAD(&inst->delayed_process);
1731                 INIT_WORK(&inst->delayed_process_work,
1732                           delayed_process_buf_func);
1733         }
1734 }
1735 EXPORT_SYMBOL_GPL(venus_helper_init_instance);
1736
1737 static bool find_fmt_from_caps(struct hfi_plat_caps *caps, u32 buftype, u32 fmt)
1738 {
1739         unsigned int i;
1740
1741         for (i = 0; i < caps->num_fmts; i++) {
1742                 if (caps->fmts[i].buftype == buftype &&
1743                     caps->fmts[i].fmt == fmt)
1744                         return true;
1745         }
1746
1747         return false;
1748 }
1749
1750 int venus_helper_get_out_fmts(struct venus_inst *inst, u32 v4l2_fmt,
1751                               u32 *out_fmt, u32 *out2_fmt, bool ubwc)
1752 {
1753         struct venus_core *core = inst->core;
1754         struct hfi_plat_caps *caps;
1755         u32 ubwc_fmt, fmt = to_hfi_raw_fmt(v4l2_fmt);
1756         bool found, found_ubwc;
1757
1758         *out_fmt = *out2_fmt = 0;
1759
1760         if (!fmt)
1761                 return -EINVAL;
1762
1763         caps = venus_caps_by_codec(core, inst->hfi_codec, inst->session_type);
1764         if (!caps)
1765                 return -EINVAL;
1766
1767         if (ubwc) {
1768                 ubwc_fmt = fmt | HFI_COLOR_FORMAT_UBWC_BASE;
1769                 found_ubwc = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT,
1770                                                 ubwc_fmt);
1771                 found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT2, fmt);
1772
1773                 if (found_ubwc && found) {
1774                         *out_fmt = ubwc_fmt;
1775                         *out2_fmt = fmt;
1776                         return 0;
1777                 }
1778         }
1779
1780         found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT, fmt);
1781         if (found) {
1782                 *out_fmt = fmt;
1783                 *out2_fmt = 0;
1784                 return 0;
1785         }
1786
1787         found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT2, fmt);
1788         if (found) {
1789                 *out_fmt = 0;
1790                 *out2_fmt = fmt;
1791                 return 0;
1792         }
1793
1794         return -EINVAL;
1795 }
1796 EXPORT_SYMBOL_GPL(venus_helper_get_out_fmts);
1797
1798 bool venus_helper_check_format(struct venus_inst *inst, u32 v4l2_pixfmt)
1799 {
1800         struct venus_core *core = inst->core;
1801         u32 fmt = to_hfi_raw_fmt(v4l2_pixfmt);
1802         struct hfi_plat_caps *caps;
1803         bool found;
1804
1805         if (!fmt)
1806                 return false;
1807
1808         caps = venus_caps_by_codec(core, inst->hfi_codec, inst->session_type);
1809         if (!caps)
1810                 return false;
1811
1812         found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT, fmt);
1813         if (found)
1814                 goto done;
1815
1816         found = find_fmt_from_caps(caps, HFI_BUFFER_OUTPUT2, fmt);
1817 done:
1818         return found;
1819 }
1820 EXPORT_SYMBOL_GPL(venus_helper_check_format);
1821
1822 int venus_helper_set_stride(struct venus_inst *inst,
1823                             unsigned int width, unsigned int height)
1824 {
1825         const u32 ptype = HFI_PROPERTY_PARAM_UNCOMPRESSED_PLANE_ACTUAL_INFO;
1826
1827         struct hfi_uncompressed_plane_actual_info plane_actual_info;
1828
1829         plane_actual_info.buffer_type = HFI_BUFFER_INPUT;
1830         plane_actual_info.num_planes = 2;
1831         plane_actual_info.plane_format[0].actual_stride = width;
1832         plane_actual_info.plane_format[0].actual_plane_buffer_height = height;
1833         plane_actual_info.plane_format[1].actual_stride = width;
1834         plane_actual_info.plane_format[1].actual_plane_buffer_height = height / 2;
1835
1836         return hfi_session_set_property(inst, ptype, &plane_actual_info);
1837 }
1838 EXPORT_SYMBOL_GPL(venus_helper_set_stride);