drivers/amvdec_ports/aml_vcodec_util.c

/*
* Copyright (C) 2017 Amlogic, Inc. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
* more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
*
* Description:
*/
#include <linux/module.h>

#include "aml_vcodec_drv.h"
#include "aml_vcodec_util.h"

void __iomem *aml_vcodec_get_reg_addr(struct aml_vcodec_ctx *data,
					unsigned int reg_idx)
{
	struct aml_vcodec_ctx *ctx = (struct aml_vcodec_ctx *)data;

	if (!data || reg_idx >= NUM_MAX_VCODEC_REG_BASE) {
		v4l_dbg(ctx, V4L_DEBUG_CODEC_ERROR,
			"Invalid arguments, reg_idx=%d\n", reg_idx);
		return NULL;
	}
	return ctx->dev->reg_base[reg_idx];
}
EXPORT_SYMBOL(aml_vcodec_get_reg_addr);

int aml_vcodec_mem_alloc(struct aml_vcodec_ctx *data,
			struct aml_vcodec_mem *mem)
{
	unsigned long size = mem->size;
	struct aml_vcodec_ctx *ctx = (struct aml_vcodec_ctx *)data;
	struct device *dev = &ctx->dev->plat_dev->dev;

	mem->vaddr = dma_alloc_coherent(dev, size, &mem->dma_addr, GFP_KERNEL);
	//mem->vaddr = codec_mm_dma_alloc_coherent(dev_name(dev), size,
	//		&mem->dma_addr, GFP_KERNEL, 0);
	if (!mem->vaddr) {
		v4l_dbg(ctx, V4L_DEBUG_CODEC_ERROR,
			"%s dma_alloc size=%ld failed!\n", dev_name(dev),
			     size);
		return -ENOMEM;
	}

	memset(mem->vaddr, 0, size);

	v4l_dbg(ctx, V4L_DEBUG_CODEC_PRINFO, "va: %p\n", mem->vaddr);
	v4l_dbg(ctx, V4L_DEBUG_CODEC_PRINFO, "dma: 0x%lx\n", (ulong) mem->dma_addr);
	v4l_dbg(ctx, V4L_DEBUG_CODEC_PRINFO, "size: 0x%lx\n", size);

	return 0;
}
EXPORT_SYMBOL(aml_vcodec_mem_alloc);

void aml_vcodec_mem_free(struct aml_vcodec_ctx *data,
			struct aml_vcodec_mem *mem)
{
	unsigned long size = mem->size;
	struct aml_vcodec_ctx *ctx = (struct aml_vcodec_ctx *)data;
	struct device *dev = &ctx->dev->plat_dev->dev;

	if (!mem->vaddr) {
		v4l_dbg(ctx, V4L_DEBUG_CODEC_ERROR,
			"%s dma_free size=%ld failed!\n", dev_name(dev),
			     size);
		return;
	}

	v4l_dbg(ctx, V4L_DEBUG_CODEC_PRINFO, "va: %p\n", mem->vaddr);
	v4l_dbg(ctx, V4L_DEBUG_CODEC_PRINFO, "dma: 0x%lx\n", (ulong) mem->dma_addr);
	v4l_dbg(ctx, V4L_DEBUG_CODEC_PRINFO, "size: 0x%lx\n", size);

	dma_free_coherent(dev, size, mem->vaddr, mem->dma_addr);
	mem->vaddr = NULL;
	mem->dma_addr = 0;
	mem->size = 0;
}
EXPORT_SYMBOL(aml_vcodec_mem_free);

void aml_vcodec_set_curr_ctx(struct aml_vcodec_dev *dev,
	struct aml_vcodec_ctx *ctx)
{
	unsigned long flags;

	spin_lock_irqsave(&dev->irqlock, flags);
	dev->curr_ctx = ctx;
	spin_unlock_irqrestore(&dev->irqlock, flags);
}
EXPORT_SYMBOL(aml_vcodec_set_curr_ctx);

struct aml_vcodec_ctx *aml_vcodec_get_curr_ctx(struct aml_vcodec_dev *dev)
{
	unsigned long flags;
	struct aml_vcodec_ctx *ctx;

	spin_lock_irqsave(&dev->irqlock, flags);
	ctx = dev->curr_ctx;
	spin_unlock_irqrestore(&dev->irqlock, flags);
	return ctx;
}
EXPORT_SYMBOL(aml_vcodec_get_curr_ctx);