root/drivers/media/platform/mediatek/vcodec/common/mtk_vcodec_util.c
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2016 MediaTek Inc.
* Author: PC Chen <pc.chen@mediatek.com>
*       Tiffany Lin <tiffany.lin@mediatek.com>
*/

#include <linux/module.h>
#include <linux/of.h>
#include <linux/regmap.h>

#include "../decoder/mtk_vcodec_dec_drv.h"
#include "../encoder/mtk_vcodec_enc_drv.h"
#include "../decoder/mtk_vcodec_dec_hw.h"

#if defined(CONFIG_DEBUG_FS)
int mtk_vcodec_dbg;
EXPORT_SYMBOL(mtk_vcodec_dbg);

int mtk_v4l2_dbg_level;
EXPORT_SYMBOL(mtk_v4l2_dbg_level);
#endif

void __iomem *mtk_vcodec_get_reg_addr(void __iomem **reg_base, unsigned int reg_idx)
{
        if (reg_idx >= NUM_MAX_VCODEC_REG_BASE) {
                pr_err(MTK_DBG_V4L2_STR "Invalid arguments, reg_idx=%d", reg_idx);
                return NULL;
        }
        return reg_base[reg_idx];
}
EXPORT_SYMBOL(mtk_vcodec_get_reg_addr);

int mtk_vcodec_write_vdecsys(struct mtk_vcodec_dec_ctx *ctx, unsigned int reg,
                             unsigned int val)
{
        struct mtk_vcodec_dec_dev *dev = ctx->dev;

        if (dev->vdecsys_regmap)
                return regmap_write(dev->vdecsys_regmap, reg, val);

        writel(val, dev->reg_base[VDEC_SYS] + reg);

        return 0;
}
EXPORT_SYMBOL(mtk_vcodec_write_vdecsys);

int mtk_vcodec_mem_alloc(void *priv, struct mtk_vcodec_mem *mem)
{
        enum mtk_instance_type inst_type = *((unsigned int *)priv);
        struct platform_device *plat_dev;
        int id;

        if (inst_type == MTK_INST_ENCODER) {
                struct mtk_vcodec_enc_ctx *enc_ctx = priv;

                plat_dev = enc_ctx->dev->plat_dev;
                id = enc_ctx->id;
        } else {
                struct mtk_vcodec_dec_ctx *dec_ctx = priv;

                plat_dev = dec_ctx->dev->plat_dev;
                id = dec_ctx->id;
        }

        mem->va = dma_alloc_attrs(&plat_dev->dev, mem->size, &mem->dma_addr,
                                  GFP_KERNEL, DMA_ATTR_ALLOC_SINGLE_PAGES);
        if (!mem->va) {
                mtk_v4l2_err(plat_dev, "%s dma_alloc size=0x%zx failed!",
                             __func__, mem->size);
                return -ENOMEM;
        }

        mtk_v4l2_debug(plat_dev, 3, "[%d] - va = %p dma = 0x%lx size = 0x%zx", id, mem->va,
                       (unsigned long)mem->dma_addr, mem->size);

        return 0;
}
EXPORT_SYMBOL(mtk_vcodec_mem_alloc);

void mtk_vcodec_mem_free(void *priv, struct mtk_vcodec_mem *mem)
{
        enum mtk_instance_type inst_type = *((unsigned int *)priv);
        struct platform_device *plat_dev;
        int id;

        if (inst_type == MTK_INST_ENCODER) {
                struct mtk_vcodec_enc_ctx *enc_ctx = priv;

                plat_dev = enc_ctx->dev->plat_dev;
                id = enc_ctx->id;
        } else {
                struct mtk_vcodec_dec_ctx *dec_ctx = priv;

                plat_dev = dec_ctx->dev->plat_dev;
                id = dec_ctx->id;
        }

        if (!mem->va) {
                mtk_v4l2_err(plat_dev, "%s: Tried to free a NULL VA", __func__);
                if (mem->size)
                        mtk_v4l2_err(plat_dev, "Failed to free %zu bytes", mem->size);
                return;
        }

        mtk_v4l2_debug(plat_dev, 3, "[%d] - va = %p dma = 0x%lx size = 0x%zx", id, mem->va,
                       (unsigned long)mem->dma_addr, mem->size);

        dma_free_coherent(&plat_dev->dev, mem->size, mem->va, mem->dma_addr);
        mem->va = NULL;
        mem->dma_addr = 0;
        mem->size = 0;
}
EXPORT_SYMBOL(mtk_vcodec_mem_free);

void *mtk_vcodec_get_hw_dev(struct mtk_vcodec_dec_dev *dev, int hw_idx)
{
        if (hw_idx >= MTK_VDEC_HW_MAX || hw_idx < 0 || !dev->subdev_dev[hw_idx]) {
                dev_err(&dev->plat_dev->dev, "hw idx is out of range:%d", hw_idx);
                return NULL;
        }

        return dev->subdev_dev[hw_idx];
}
EXPORT_SYMBOL(mtk_vcodec_get_hw_dev);

void mtk_vcodec_set_curr_ctx(struct mtk_vcodec_dec_dev *vdec_dev,
                             struct mtk_vcodec_dec_ctx *ctx, int hw_idx)
{
        unsigned long flags;
        struct mtk_vdec_hw_dev *subdev_dev;

        spin_lock_irqsave(&vdec_dev->irqlock, flags);
        if (vdec_dev->vdec_pdata->is_subdev_supported) {
                subdev_dev = mtk_vcodec_get_hw_dev(vdec_dev, hw_idx);
                if (!subdev_dev) {
                        dev_err(&vdec_dev->plat_dev->dev, "Failed to get hw dev");
                        spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
                        return;
                }
                subdev_dev->curr_ctx = ctx;
        } else {
                vdec_dev->curr_ctx = ctx;
        }
        spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
}
EXPORT_SYMBOL(mtk_vcodec_set_curr_ctx);

struct mtk_vcodec_dec_ctx *mtk_vcodec_get_curr_ctx(struct mtk_vcodec_dec_dev *vdec_dev,
                                                   unsigned int hw_idx)
{
        unsigned long flags;
        struct mtk_vcodec_dec_ctx *ctx;
        struct mtk_vdec_hw_dev *subdev_dev;

        spin_lock_irqsave(&vdec_dev->irqlock, flags);
        if (vdec_dev->vdec_pdata->is_subdev_supported) {
                subdev_dev = mtk_vcodec_get_hw_dev(vdec_dev, hw_idx);
                if (!subdev_dev) {
                        dev_err(&vdec_dev->plat_dev->dev, "Failed to get hw dev");
                        spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
                        return NULL;
                }
                ctx = subdev_dev->curr_ctx;
        } else {
                ctx = vdec_dev->curr_ctx;
        }
        spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
        return ctx;
}
EXPORT_SYMBOL(mtk_vcodec_get_curr_ctx);

MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("Mediatek video codec driver");