cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

mtk_vcodec_util.c (3743B)

      1// SPDX-License-Identifier: GPL-2.0
      2/*
      3* Copyright (c) 2016 MediaTek Inc.
      4* Author: PC Chen <pc.chen@mediatek.com>
      5*	Tiffany Lin <tiffany.lin@mediatek.com>
      6*/
      7
      8#include <linux/module.h>
      9#include <linux/of.h>
     10#include <linux/of_device.h>
     11
     12#include "mtk_vcodec_dec_hw.h"
     13#include "mtk_vcodec_drv.h"
     14#include "mtk_vcodec_util.h"
     15
     16void __iomem *mtk_vcodec_get_reg_addr(struct mtk_vcodec_ctx *data,
     17					unsigned int reg_idx)
     18{
     19	struct mtk_vcodec_ctx *ctx = (struct mtk_vcodec_ctx *)data;
     20
     21	if (!data || reg_idx >= NUM_MAX_VCODEC_REG_BASE) {
     22		mtk_v4l2_err("Invalid arguments, reg_idx=%d", reg_idx);
     23		return NULL;
     24	}
     25	return ctx->dev->reg_base[reg_idx];
     26}
     27EXPORT_SYMBOL(mtk_vcodec_get_reg_addr);
     28
     29int mtk_vcodec_mem_alloc(struct mtk_vcodec_ctx *data,
     30			struct mtk_vcodec_mem *mem)
     31{
     32	unsigned long size = mem->size;
     33	struct mtk_vcodec_ctx *ctx = (struct mtk_vcodec_ctx *)data;
     34	struct device *dev = &ctx->dev->plat_dev->dev;
     35
     36	mem->va = dma_alloc_coherent(dev, size, &mem->dma_addr, GFP_KERNEL);
     37	if (!mem->va) {
     38		mtk_v4l2_err("%s dma_alloc size=%ld failed!", dev_name(dev),
     39			     size);
     40		return -ENOMEM;
     41	}
     42
     43	mtk_v4l2_debug(3, "[%d]  - va      = %p", ctx->id, mem->va);
     44	mtk_v4l2_debug(3, "[%d]  - dma     = 0x%lx", ctx->id,
     45		       (unsigned long)mem->dma_addr);
     46	mtk_v4l2_debug(3, "[%d]    size = 0x%lx", ctx->id, size);
     47
     48	return 0;
     49}
     50EXPORT_SYMBOL(mtk_vcodec_mem_alloc);
     51
     52void mtk_vcodec_mem_free(struct mtk_vcodec_ctx *data,
     53			struct mtk_vcodec_mem *mem)
     54{
     55	unsigned long size = mem->size;
     56	struct mtk_vcodec_ctx *ctx = (struct mtk_vcodec_ctx *)data;
     57	struct device *dev = &ctx->dev->plat_dev->dev;
     58
     59	if (!mem->va) {
     60		mtk_v4l2_err("%s dma_free size=%ld failed!", dev_name(dev),
     61			     size);
     62		return;
     63	}
     64
     65	mtk_v4l2_debug(3, "[%d]  - va      = %p", ctx->id, mem->va);
     66	mtk_v4l2_debug(3, "[%d]  - dma     = 0x%lx", ctx->id,
     67		       (unsigned long)mem->dma_addr);
     68	mtk_v4l2_debug(3, "[%d]    size = 0x%lx", ctx->id, size);
     69
     70	dma_free_coherent(dev, size, mem->va, mem->dma_addr);
     71	mem->va = NULL;
     72	mem->dma_addr = 0;
     73	mem->size = 0;
     74}
     75EXPORT_SYMBOL(mtk_vcodec_mem_free);
     76
     77void *mtk_vcodec_get_hw_dev(struct mtk_vcodec_dev *dev, int hw_idx)
     78{
     79	if (hw_idx >= MTK_VDEC_HW_MAX || hw_idx < 0 || !dev->subdev_dev[hw_idx]) {
     80		mtk_v4l2_err("hw idx is out of range:%d", hw_idx);
     81		return NULL;
     82	}
     83
     84	return dev->subdev_dev[hw_idx];
     85}
     86EXPORT_SYMBOL(mtk_vcodec_get_hw_dev);
     87
     88void mtk_vcodec_set_curr_ctx(struct mtk_vcodec_dev *vdec_dev,
     89			     struct mtk_vcodec_ctx *ctx, int hw_idx)
     90{
     91	unsigned long flags;
     92	struct mtk_vdec_hw_dev *subdev_dev;
     93
     94	spin_lock_irqsave(&vdec_dev->irqlock, flags);
     95	if (vdec_dev->vdec_pdata->is_subdev_supported) {
     96		subdev_dev = mtk_vcodec_get_hw_dev(vdec_dev, hw_idx);
     97		if (!subdev_dev) {
     98			mtk_v4l2_err("Failed to get hw dev");
     99			spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
    100			return;
    101		}
    102		subdev_dev->curr_ctx = ctx;
    103	} else {
    104		vdec_dev->curr_ctx = ctx;
    105	}
    106	spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
    107}
    108EXPORT_SYMBOL(mtk_vcodec_set_curr_ctx);
    109
    110struct mtk_vcodec_ctx *mtk_vcodec_get_curr_ctx(struct mtk_vcodec_dev *vdec_dev,
    111					       unsigned int hw_idx)
    112{
    113	unsigned long flags;
    114	struct mtk_vcodec_ctx *ctx;
    115	struct mtk_vdec_hw_dev *subdev_dev;
    116
    117	spin_lock_irqsave(&vdec_dev->irqlock, flags);
    118	if (vdec_dev->vdec_pdata->is_subdev_supported) {
    119		subdev_dev = mtk_vcodec_get_hw_dev(vdec_dev, hw_idx);
    120		if (!subdev_dev) {
    121			mtk_v4l2_err("Failed to get hw dev");
    122			spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
    123			return NULL;
    124		}
    125		ctx = subdev_dev->curr_ctx;
    126	} else {
    127		ctx = vdec_dev->curr_ctx;
    128	}
    129	spin_unlock_irqrestore(&vdec_dev->irqlock, flags);
    130	return ctx;
    131}
    132EXPORT_SYMBOL(mtk_vcodec_get_curr_ctx);
    133
    134MODULE_LICENSE("GPL v2");
    135MODULE_DESCRIPTION("Mediatek video codec driver");