int s5p_mfc_init_shm(struct s5p_mfc_ctx *ctx)
{
struct s5p_mfc_dev *dev = ctx->dev;
struct s5p_mfc_buf_size_v5 *buf_size = dev->variant->buf_size->buf;
void *shm_alloc_ctx = dev->alloc_ctx[MFC_CMA_BANK1_ALLOC_CTX];
ctx->shm.alloc = s5p_mfc_mem_alloc(shm_alloc_ctx, buf_size->shared_buf);
if (IS_ERR(ctx->shm.alloc)) {
mfc_err("failed to allocate shared memory\n");
return PTR_ERR(ctx->shm.alloc);
}
/* shm_ofs only keeps the offset from base (port a) */
ctx->shm.ofs = s5p_mfc_mem_daddr(ctx->shm.alloc) - dev->port_a;
ctx->shm.virt = s5p_mfc_mem_vaddr(ctx->shm.alloc);
if (!ctx->shm.virt) {
s5p_mfc_mem_free(ctx->shm.alloc);
ctx->shm.ofs = 0;
ctx->shm.alloc = NULL;
mfc_err("failed to virt addr of shared memory\n");
return -ENOMEM;
}
memset((void *)ctx->shm.virt, 0, buf_size->shared_buf);
s5p_mfc_cache_clean_priv(ctx->shm.alloc);
mfc_debug(2, "shm info addr: 0x%08x, phys: 0x%08lx\n",
(unsigned int)ctx->shm.virt, ctx->shm.ofs);
return 0;
}
/* Release firmware memory */
int s5p_mfc_release_firmware(struct s5p_mfc_dev *dev)
{
/* Before calling this function one has to make sure
* that MFC is no longer processing */
if (!s5p_mfc_bitproc_buf)
return -EINVAL;
/*
if (s5p_mfc_bitproc_dma)
dma_unmap_single(dev->v4l2_dev.dev, s5p_mfc_bitproc_dma,
FIRMWARE_CODE_SIZE, DMA_TO_DEVICE);
*/
s5p_mfc_mem_free(s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_virt = 0;
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
/*
s5p_mfc_bitproc_dma = 0;
*/
return 0;
}
/* Allocate firmware */
int s5p_mfc_alloc_firmware(struct s5p_mfc_dev *dev)
{
#if defined(CONFIG_S5P_MFC_VB2_CMA)
int err;
struct cma_info mem_info_f, mem_info_a, mem_info_b;
#endif
unsigned int base_align = dev->variant->buf_align->mfc_base_align;
unsigned int firmware_size = dev->variant->buf_size->firmware_code;
mfc_debug_enter();
#if !defined(CONFIG_S5P_MFC_VB2_ION)
if (s5p_mfc_bitproc_buf) {
mfc_err("Attempting to allocate firmware when it seems that it is already loaded.\n");
return -ENOMEM;
}
#else
if (s5p_mfc_bitproc_buf)
return 0;
#endif
/* Get memory region information and check if it is correct */
#if defined(CONFIG_S5P_MFC_VB2_CMA)
err = cma_info(&mem_info_f, dev->v4l2_dev.dev, MFC_CMA_FW);
mfc_debug(3, "Area \"%s\" is from %08x to %08x and has size %08x", "f",
mem_info_f.lower_bound, mem_info_f.upper_bound,
mem_info_f.total_size);
if (err) {
mfc_err("Couldn't get memory information from CMA.\n");
return -EINVAL;
}
err = cma_info(&mem_info_a, dev->v4l2_dev.dev, MFC_CMA_BANK1);
mfc_debug(3, "Area \"%s\" is from %08x to %08x and has size %08x", "a",
mem_info_a.lower_bound, mem_info_a.upper_bound,
mem_info_a.total_size);
if (err) {
mfc_err("Couldn't get memory information from CMA.\n");
return -EINVAL;
}
if (mem_info_f.upper_bound > mem_info_a.lower_bound) {
mfc_err("Firmware has to be "
"allocated before memory for buffers (bank A).\n");
return -EINVAL;
}
mfc_debug(2, "Allocating memory for firmware.\n");
s5p_mfc_bitproc_buf = s5p_mfc_mem_allocate(
dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX], firmware_size);
if (IS_ERR(s5p_mfc_bitproc_buf)) {
s5p_mfc_bitproc_buf = 0;
printk(KERN_ERR "Allocating bitprocessor buffer failed\n");
return -ENOMEM;
}
s5p_mfc_bitproc_phys = s5p_mfc_mem_dma_addr(s5p_mfc_bitproc_buf);
if (s5p_mfc_bitproc_phys & ((1 << base_align) - 1)) {
mfc_err("The base memory is not aligned to %dBytes.\n",
(1 << base_align));
s5p_mfc_mem_free(s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
return -EIO;
}
dev->port_a = s5p_mfc_bitproc_phys;
s5p_mfc_bitproc_virt = s5p_mfc_mem_vaddr(s5p_mfc_bitproc_buf);
mfc_debug(2, "Virtual address for FW: %08lx\n",
(long unsigned int)s5p_mfc_bitproc_virt);
if (!s5p_mfc_bitproc_virt) {
mfc_err("Bitprocessor memory remap failed\n");
s5p_mfc_mem_free(s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
return -EIO;
}
if (HAS_PORTNUM(dev) && IS_TWOPORT(dev)) {
err = cma_info(&mem_info_b, dev->v4l2_dev.dev, MFC_CMA_BANK2);
mfc_debug(3, "Area \"%s\" is from %08x to %08x and has size %08x", "b",
mem_info_b.lower_bound, mem_info_b.upper_bound,
mem_info_b.total_size);
if (err) {
mfc_err("Couldn't get memory information from CMA.\n");
return -EINVAL;
}
dev->port_b = mem_info_b.lower_bound;
mfc_debug(2, "Port A: %08x Port B: %08x (FW: %08x size: %08x)\n",
dev->port_a, dev->port_b, s5p_mfc_bitproc_phys,
firmware_size);
} else {
mfc_debug(2, "Port : %08x (FW: %08x size: %08x)\n",
dev->port_a, s5p_mfc_bitproc_phys,
firmware_size);
}
#elif defined(CONFIG_S5P_MFC_VB2_SDVMM)
mfc_debug(2, "Allocating memory for firmware.\n");
s5p_mfc_bitproc_buf = s5p_mfc_mem_alloc(
dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX], firmware_size);
if (IS_ERR(s5p_mfc_bitproc_buf)) {
s5p_mfc_bitproc_buf = 0;
printk(KERN_ERR "Allocating bitprocessor buffer failed\n");
return -ENOMEM;
}
s5p_mfc_bitproc_phys = s5p_mfc_mem_cookie(
dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX], s5p_mfc_bitproc_buf);
if (s5p_mfc_bitproc_phys & ((1 << base_align) - 1)) {
mfc_err("The base memory is not aligned to %dBytes.\n",
(1 << base_align));
s5p_mfc_mem_put(dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX],
s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
return -EIO;
}
s5p_mfc_bitproc_virt = s5p_mfc_mem_vaddr(
dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX], s5p_mfc_bitproc_buf);
mfc_debug(2, "Virtual address for FW: %08lx\n",
(long unsigned int)s5p_mfc_bitproc_virt);
if (!s5p_mfc_bitproc_virt) {
mfc_err("Bitprocessor memory remap failed\n");
s5p_mfc_mem_put(dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX],
s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
return -EIO;
}
dev->port_a = s5p_mfc_bitproc_phys;
dev->port_b = s5p_mfc_bitproc_phys;
mfc_debug(2, "Port A: %08x Port B: %08x (FW: %08x size: %08x)\n",
dev->port_a, dev->port_b,
s5p_mfc_bitproc_phys,
firmware_size);
#elif defined(CONFIG_S5P_MFC_VB2_ION)
mfc_debug(2, "Allocating memory for firmware.\n");
s5p_mfc_bitproc_buf = s5p_mfc_mem_allocate(
dev->alloc_ctx[MFC_CMA_FW_ALLOC_CTX], firmware_size);
if (IS_ERR(s5p_mfc_bitproc_buf)) {
s5p_mfc_bitproc_buf = 0;
printk(KERN_ERR "Allocating bitprocessor buffer failed\n");
return -ENOMEM;
}
s5p_mfc_bitproc_phys = s5p_mfc_mem_dma_addr(s5p_mfc_bitproc_buf);
if (s5p_mfc_bitproc_phys & ((1 << base_align) - 1)) {
mfc_err("The base memory is not aligned to %dBytes.\n",
(1 << base_align));
s5p_mfc_mem_free(s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
return -EIO;
}
s5p_mfc_bitproc_virt = s5p_mfc_mem_vaddr(s5p_mfc_bitproc_buf);
mfc_debug(2, "Virtual address for FW: %08lx\n",
(long unsigned int)s5p_mfc_bitproc_virt);
if (!s5p_mfc_bitproc_virt) {
mfc_err("Bitprocessor memory remap failed\n");
s5p_mfc_mem_free(s5p_mfc_bitproc_buf);
s5p_mfc_bitproc_phys = 0;
s5p_mfc_bitproc_buf = 0;
return -EIO;
}
dev->port_a = s5p_mfc_bitproc_phys;
dev->port_b = s5p_mfc_bitproc_phys;
mfc_debug(2, "Port A: %08x Port B: %08x (FW: %08x size: %08x)\n",
dev->port_a, dev->port_b,
s5p_mfc_bitproc_phys,
firmware_size);
#endif
mfc_debug_leave();
return 0;
}