| // 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/of_device.h> |
| |
| #include "mtk_vcodec_dec_hw.h" |
| #include "mtk_vcodec_drv.h" |
| #include "mtk_vcodec_util.h" |
| |
| void __iomem *mtk_vcodec_get_reg_addr(struct mtk_vcodec_ctx *data, |
| unsigned int reg_idx) |
| { |
| struct mtk_vcodec_ctx *ctx = (struct mtk_vcodec_ctx *)data; |
| |
| if (!data || reg_idx >= NUM_MAX_VCODEC_REG_BASE) { |
| mtk_v4l2_err("Invalid arguments, reg_idx=%d", reg_idx); |
| return NULL; |
| } |
| return ctx->dev->reg_base[reg_idx]; |
| } |
| EXPORT_SYMBOL(mtk_vcodec_get_reg_addr); |
| |
| int mtk_vcodec_mem_alloc(struct mtk_vcodec_ctx *data, |
| struct mtk_vcodec_mem *mem) |
| { |
| unsigned long size = mem->size; |
| struct mtk_vcodec_ctx *ctx = (struct mtk_vcodec_ctx *)data; |
| struct device *dev = &ctx->dev->plat_dev->dev; |
| |
| mem->va = dma_alloc_coherent(dev, size, &mem->dma_addr, GFP_KERNEL); |
| if (!mem->va) { |
| mtk_v4l2_err("%s dma_alloc size=%ld failed!", dev_name(dev), |
| size); |
| return -ENOMEM; |
| } |
| |
| mtk_v4l2_debug(3, "[%d] - va = %p", ctx->id, mem->va); |
| mtk_v4l2_debug(3, "[%d] - dma = 0x%lx", ctx->id, |
| (unsigned long)mem->dma_addr); |
| mtk_v4l2_debug(3, "[%d] size = 0x%lx", ctx->id, size); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL(mtk_vcodec_mem_alloc); |
| |
| void mtk_vcodec_mem_free(struct mtk_vcodec_ctx *data, |
| struct mtk_vcodec_mem *mem) |
| { |
| unsigned long size = mem->size; |
| struct mtk_vcodec_ctx *ctx = (struct mtk_vcodec_ctx *)data; |
| struct device *dev = &ctx->dev->plat_dev->dev; |
| |
| if (!mem->va) { |
| mtk_v4l2_err("%s dma_free size=%ld failed!", dev_name(dev), |
| size); |
| return; |
| } |
| |
| mtk_v4l2_debug(3, "[%d] - va = %p", ctx->id, mem->va); |
| mtk_v4l2_debug(3, "[%d] - dma = 0x%lx", ctx->id, |
| (unsigned long)mem->dma_addr); |
| mtk_v4l2_debug(3, "[%d] size = 0x%lx", ctx->id, size); |
| |
| dma_free_coherent(dev, 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_dev *dev, int hw_idx) |
| { |
| if (hw_idx >= MTK_VDEC_HW_MAX || hw_idx < 0 || !dev->subdev_dev[hw_idx]) { |
| mtk_v4l2_err("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_dev *vdec_dev, |
| struct mtk_vcodec_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) { |
| mtk_v4l2_err("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_ctx *mtk_vcodec_get_curr_ctx(struct mtk_vcodec_dev *vdec_dev, |
| unsigned int hw_idx) |
| { |
| unsigned long flags; |
| struct mtk_vcodec_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) { |
| mtk_v4l2_err("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"); |