unsigned int mfc_mem_hole_size(void)
{
if (mfc_mem_data_size(1))
return mfc_mem_data_base(1) -
(mfc_mem_data_base(0) + mfc_mem_data_size(0));
else
return 0;
}
unsigned long mfc_mem_data_ofs(unsigned long addr, int contig)
{
unsigned int offset;
int i;
int port;
port = mfc_mem_addr_port(addr);
if (port < 0)
return 0;
offset = addr - mfc_mem_data_base(port);
if (contig) {
for (i = 0; i < port; i++)
offset += mfc_mem_data_size(i);
}
return offset;
}
unsigned int mfc_mem_data_ofs(unsigned int addr, int contig)
{
unsigned int offset;
int i;
int port;
#ifdef CONFIG_EXYNOS4_CONTENT_PATH_PROTECTION
port = 0;
#else
port = mfc_mem_addr_port(addr);
#endif
if (port < 0)
return 0;
offset = addr - mfc_mem_data_base(port);
if (contig) {
for (i = 0; i < port; i++)
offset += mfc_mem_data_size(i);
}
return offset;
}
static int mfc_mmap(struct file *file, struct vm_area_struct *vma)
{
unsigned long user_size = vma->vm_end - vma->vm_start;
unsigned long real_size;
struct mfc_inst_ctx *mfc_ctx;
#if !(defined(CONFIG_VIDEO_MFC_VCM_UMP) || defined(CONFIG_S5P_VMEM))
/* mmap support */
unsigned long pfn;
unsigned long remap_offset, remap_size;
struct mfc_dev *dev;
#ifdef SYSMMU_MFC_ON
/* kernel virtual memory allocator */
char *ptr;
unsigned long start, size;
#endif
#endif
mfc_ctx = (struct mfc_inst_ctx *)file->private_data;
if (!mfc_ctx)
return -EINVAL;
#if !(defined(CONFIG_VIDEO_MFC_VCM_UMP) || defined(CONFIG_S5P_VMEM))
dev = mfc_ctx->dev;
#endif
mfc_dbg("vm_start: 0x%08lx, vm_end: 0x%08lx, size: %ld(%ldMB)\n",
vma->vm_start, vma->vm_end, user_size, (user_size >> 20));
real_size = (unsigned long)(mfc_mem_data_size(0) + mfc_mem_data_size(1));
mfc_dbg("port 0 size: %d, port 1 size: %d, total: %ld\n",
mfc_mem_data_size(0),
mfc_mem_data_size(1),
real_size);
/*
* if memory size required from appl. mmap() is bigger than max data memory
* size allocated in the driver.
*/
if (user_size > real_size) {
mfc_err("user requeste mem(%ld) is bigger than available mem(%ld)\n",
user_size, real_size);
return -EINVAL;
}
#ifdef SYSMMU_MFC_ON
#if (defined(CONFIG_VIDEO_MFC_VCM_UMP) || defined(CONFIG_S5P_VMEM))
vma->vm_flags |= VM_RESERVED | VM_IO;
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
vma->vm_ops = &mfc_vm_ops;
vma->vm_private_data = mfc_ctx;
mfc_ctx->userbase = vma->vm_start;
#else /* not CONFIG_VIDEO_MFC_VCM_UMP && not CONFIG_S5P_VMEM */
/* kernel virtual memory allocator */
if (dev->mem_ports == 1) {
remap_offset = 0;
remap_size = user_size;
vma->vm_flags |= VM_RESERVED | VM_IO;
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
/*
* Port 0 mapping for stream buf & frame buf (chroma + MV + luma)
*/
ptr = (char *)mfc_mem_data_base(0);
start = remap_offset;
size = remap_size;
while (size > 0) {
pfn = vmalloc_to_pfn(ptr);
if (remap_pfn_range(vma, vma->vm_start + start, pfn,
PAGE_SIZE, vma->vm_page_prot)) {
mfc_err("failed to remap port 0\n");
return -EAGAIN;
}
start += PAGE_SIZE;
ptr += PAGE_SIZE;
size -= PAGE_SIZE;
}
} else {
remap_offset = 0;
remap_size = min((unsigned long)mfc_mem_data_size(0), user_size);
vma->vm_flags |= VM_RESERVED | VM_IO;
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
/*
* Port 0 mapping for stream buf & frame buf (chroma + MV)
*/
ptr = (char *)mfc_mem_data_base(0);
start = remap_offset;
size = remap_size;
while (size > 0) {
pfn = vmalloc_to_pfn(ptr);
if (remap_pfn_range(vma, vma->vm_start + start, pfn,
PAGE_SIZE, vma->vm_page_prot)) {
mfc_err("failed to remap port 0\n");
return -EAGAIN;
}
start += PAGE_SIZE;
ptr += PAGE_SIZE;
size -= PAGE_SIZE;
}
remap_offset = remap_size;
remap_size = min((unsigned long)mfc_mem_data_size(1),
user_size - remap_offset);
vma->vm_flags |= VM_RESERVED | VM_IO;
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
/*
* Port 1 mapping for frame buf (luma)
*/
ptr = (void *)mfc_mem_data_base(1);
start = remap_offset;
size = remap_size;
while (size > 0) {
pfn = vmalloc_to_pfn(ptr);
if (remap_pfn_range(vma, vma->vm_start + start, pfn,
PAGE_SIZE, vma->vm_page_prot)) {
mfc_err("failed to remap port 1\n");
return -EAGAIN;
}
start += PAGE_SIZE;
ptr += PAGE_SIZE;
size -= PAGE_SIZE;
}
}
mfc_ctx->userbase = vma->vm_start;
mfc_dbg("user request mem = %ld, available data mem = %ld\n",
user_size, real_size);
if ((remap_offset + remap_size) < real_size)
mfc_warn("The MFC reserved memory dose not mmap fully [%ld: %ld]\n",
real_size, (remap_offset + remap_size));
#endif /* end of CONFIG_VIDEO_MFC_VCM_UMP */
#else /* not SYSMMU_MFC_ON */
/* early allocator */
/* CMA or bootmem(memblock) */
if (dev->mem_ports == 1) {
remap_offset = 0;
remap_size = user_size;
vma->vm_flags |= VM_RESERVED | VM_IO;
if(mfc_ctx->buf_cache_type == NO_CACHE){
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
mfc_info("CONFIG_VIDEO_MFC_CACHE is not enabled\n");
}else
mfc_info("CONFIG_VIDEO_MFC_CACHE is enabled\n");
/*
* Port 0 mapping for stream buf & frame buf (chroma + MV + luma)
*/
pfn = __phys_to_pfn(mfc_mem_data_base(0));
if (remap_pfn_range(vma, vma->vm_start + remap_offset, pfn,
remap_size, vma->vm_page_prot)) {
mfc_err("failed to remap port 0\n");
return -EINVAL;
}
} else {
remap_offset = 0;
remap_size = min((unsigned long)mfc_mem_data_size(0), user_size);
vma->vm_flags |= VM_RESERVED | VM_IO;
if(mfc_ctx->buf_cache_type == NO_CACHE){
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
mfc_info("CONFIG_VIDEO_MFC_CACHE is not enabled\n");
}else
mfc_info("CONFIG_VIDEO_MFC_CACHE is enabled\n");
/*
* Port 0 mapping for stream buf & frame buf (chroma + MV)
*/
pfn = __phys_to_pfn(mfc_mem_data_base(0));
if (remap_pfn_range(vma, vma->vm_start + remap_offset, pfn,
remap_size, vma->vm_page_prot)) {
mfc_err("failed to remap port 0\n");
return -EINVAL;
}
remap_offset = remap_size;
remap_size = min((unsigned long)mfc_mem_data_size(1),
user_size - remap_offset);
vma->vm_flags |= VM_RESERVED | VM_IO;
if(mfc_ctx->buf_cache_type == NO_CACHE)
vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
/*
* Port 1 mapping for frame buf (luma)
*/
pfn = __phys_to_pfn(mfc_mem_data_base(1));
if (remap_pfn_range(vma, vma->vm_start + remap_offset, pfn,
remap_size, vma->vm_page_prot)) {
mfc_err("failed to remap port 1\n");
return -EINVAL;
}
}
mfc_ctx->userbase = vma->vm_start;
mfc_dbg("user request mem = %ld, available data mem = %ld\n",
user_size, real_size);
if ((remap_offset + remap_size) < real_size)
mfc_warn("The MFC reserved memory dose not mmap fully [%ld: %ld]\n",
real_size, (remap_offset + remap_size));
#endif /* end of SYSMMU_MFC_ON */
return 0;
}
unsigned int mfc_mem_hole_size(void)
{
return mfc_mem_data_base(1) -
(mfc_mem_data_base(0) + mfc_mem_data_size(0));
}
