nt9856x/code/vos/drivers/source/kwrap/linux/rtos_os_mem.c
2023-03-28 15:07:53 +08:00

120 lines
4.1 KiB
C
Executable File

/*-----------------------------------------------------------------------------*/
/* Include Header Files */
/*-----------------------------------------------------------------------------*/
#include <linux/module.h>
#if defined (__aarch64__)
#include <linux/soc/nvt/fmem.h>
#else
#include <mach/fmem.h>
#endif
#define __MODULE__ rtos_mem
#define __DBGLVL__ 8 // 0=FATAL, 1=ERR, 2=WRN, 3=UNIT, 4=FUNC, 5=IND, 6=MSG, 7=VALUE, 8=USER
#define __DBGFLT__ "*"
#include <kwrap/debug.h>
#include <kwrap/mem.h>
/*-----------------------------------------------------------------------------*/
/* Local Types Declarations */
/*-----------------------------------------------------------------------------*/
#define RTOS_MEM_INITED_TAG MAKEFOURCC('R', 'M', 'E', 'M') ///< a key value
#define VOS_MEM_CMA_INDEX 0
#if defined(__LINUX)
#elif defined(__FREERTOS)
#else
#error Not supported OS
#endif
/*-----------------------------------------------------------------------------*/
/* Local Global Variables */
/*-----------------------------------------------------------------------------*/
unsigned int rtos_mem_debug_level = NVT_DBG_WRN;
module_param_named(rtos_mem_debug_level, rtos_mem_debug_level, int, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(rtos_mem_debug_level, "Debug message level");
/*-----------------------------------------------------------------------------*/
/* Interface Functions */
/*-----------------------------------------------------------------------------*/
void rtos_mem_init(void *param)
{
STATIC_ASSERT(sizeof(struct vos_mem_cma_info_t) == sizeof(struct nvt_fmem_mem_info_t));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, type) == sizeof_field(struct nvt_fmem_mem_info_t, type));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, reserved1) == sizeof_field(struct nvt_fmem_mem_info_t, dev));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, paddr) == sizeof_field(struct nvt_fmem_mem_info_t, paddr));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, reserved2) == sizeof_field(struct nvt_fmem_mem_info_t, pages));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, reserved3) == sizeof_field(struct nvt_fmem_mem_info_t, page_count));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, vaddr) == sizeof_field(struct nvt_fmem_mem_info_t, vaddr));
STATIC_ASSERT(sizeof_field(struct vos_mem_cma_info_t, size) == sizeof_field(struct nvt_fmem_mem_info_t, size));
STATIC_ASSERT((VOS_MEM_CMA_TYPE_CACHE - NVT_FMEM_ALLOC_CACHE) == 0);
STATIC_ASSERT((VOS_MEM_CMA_TYPE_NONCACHE - NVT_FMEM_ALLOC_NONCACHE) == 0);
STATIC_ASSERT((VOS_MEM_CMA_TYPE_BUFFER - NVT_FMEM_ALLOC_BUFFER) == 0);
}
void rtos_mem_exit(void)
{
}
int vos_mem_init_cma_info(struct vos_mem_cma_info_t *p_info, VOS_MEM_CMA_TYPE type, UINT32 size)
{
if (NULL == p_info) {
DBG_ERR("p_info is NULL\r\n");
return -1;
}
if (0 != nvt_fmem_mem_info_init((struct nvt_fmem_mem_info_t *)p_info, (nvt_fmem_alloc_type_t)type, size, NULL)) {
DBG_ERR("nvt_fmem_mem_info_init failed\r\n");
return -1;
}
return 0;
}
VOS_MEM_CMA_HDL vos_mem_alloc_from_cma(struct vos_mem_cma_info_t *p_info)
{
void *p_alloc;
if (NULL == p_info) {
DBG_ERR("p_info is NULL\r\n");
return NULL;
}
if (0 == p_info->size) {
DBG_ERR("size is 0\r\n");
return NULL;
}
p_alloc = fmem_alloc_from_cma((struct nvt_fmem_mem_info_t *)p_info, VOS_MEM_CMA_INDEX);
if (NULL == p_alloc) {
DBG_ERR("fmem_alloc_from_cma %ld bytes failed\r\n", (ULONG)p_info->size);
return NULL;
}
return (VOS_MEM_CMA_HDL)p_alloc;
}
int vos_mem_release_from_cma(VOS_MEM_CMA_HDL p_hdl)
{
int ret;
if (NULL == p_hdl) {
DBG_ERR("p_hdl is NULL\r\n");
return -1;
}
ret = fmem_release_from_cma((void *)p_hdl, VOS_MEM_CMA_INDEX);
if (0 != ret) {
DBG_ERR("fmem_release_from_cma failed, ret %d\r\n", ret);
}
return ret;
}
EXPORT_SYMBOL(vos_mem_init_cma_info);
EXPORT_SYMBOL(vos_mem_alloc_from_cma);
EXPORT_SYMBOL(vos_mem_release_from_cma);