📄 lib_mem.c
字号:
return;
}
}
if (blk_nbr < 1) {
*perr = LIB_MEM_ERR_INVALID_BLK_NBR;
return;
}
if (blk_size < 1) {
*perr = LIB_MEM_ERR_INVALID_BLK_SIZE;
return;
}
if (blk_align < 1) {
blk_align = 1;
}
/* ------------ VALIDATE MEM POOL TBL ------------- */
if (Mem_PoolTbl == (MEM_POOL *)0) {
*perr = LIB_MEM_ERR_HEAP_NOT_FOUND;
return;
}
/*$PAGE*/
/* ---------------- CREATE MEM POOL --------------- */
pmem_pool_heap = (MEM_POOL *)&Mem_PoolHeap;
CPU_CRITICAL_ENTER();
if (pmem_base_addr == (void *)0) { /* If no base addr, cfg mem pool from heap. */
pmem_pool_blk = pmem_pool_heap;
pmem_pool_prev = pmem_pool_heap;
pmem_pool_next = pmem_pool_heap;
/* --------------- VALIDATE MEM SEG --------------- */
/* Calc tot mem size for mem pool ptrs. */
pmem_addr_ptrs = (CPU_INT08U *)pmem_pool_heap->SegAddrNextAvail;
size_tot_ptrs = Mem_PoolSegCalcTotSize((void *)pmem_addr_ptrs,
(CPU_SIZE_T)blk_nbr,
(CPU_SIZE_T)sizeof(void *),
(CPU_SIZE_T)sizeof(void *));
/* Calc tot mem size for mem blks. */
pmem_addr_pool = pmem_addr_ptrs + size_tot_ptrs; /* Adj next avail addr for mem pool blks. */
size_tot_pool = Mem_PoolSegCalcTotSize((void *)pmem_addr_pool,
(CPU_SIZE_T)blk_nbr,
(CPU_SIZE_T)blk_size,
(CPU_SIZE_T)blk_align);
size_tot = size_tot_ptrs + size_tot_pool;
size_rem = pmem_pool_heap->SegSizeRem;
if (size_tot > size_rem) { /* If tot size > rem size, ... */
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_HEAP_EMPTY;
if (poctets_reqd != (CPU_SIZE_T *)0) {
*poctets_reqd = size_tot - size_rem; /* ... rtn add'l size needed. */
}
return;
}
} else { /* Else cfg mem pool from dedicated mem. */
/* -------- SRCH ALL MEM SEGS FOR MEM POOL -------- */
pmem_base_addr_start = (CPU_INT08U *)pmem_base_addr;
pmem_base_addr_end = (CPU_INT08U *)pmem_base_addr + mem_size - 1;
pmem_pool_blk = (MEM_POOL *)0;
pmem_pool_prev = (MEM_POOL *)0;
pmem_pool_next = Mem_PoolTbl;
while (pmem_pool_next != (MEM_POOL *)0) { /* Srch tbl for mem seg with same base addr/size. */
if ((pmem_base_addr == pmem_pool_next->SegAddr) &&
(mem_size == pmem_pool_next->SegSizeTot)) {
pmem_pool_blk = pmem_pool_next;
pmem_pool_prev = pmem_pool_next;
break;
} else {
pmem_seg_addr_start = (CPU_INT08U *)pmem_pool_next->SegAddr;
pmem_seg_addr_end = (CPU_INT08U *)pmem_pool_next->SegAddr + pmem_pool_next->SegSizeTot - 1;
/* Seg not found. */
if (pmem_base_addr_end < pmem_seg_addr_start) {
break;
/* New mem seg overlaps cur mem seg. */
} else if (((pmem_base_addr_start <= pmem_seg_addr_start) &&
(pmem_base_addr_end >= pmem_seg_addr_start)) ||
((pmem_base_addr_start >= pmem_seg_addr_start) &&
(pmem_base_addr_end <= pmem_seg_addr_end )) ||
((pmem_base_addr_start <= pmem_seg_addr_end ) &&
(pmem_base_addr_end >= pmem_seg_addr_end ))) {
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_INVALID_SEG_OVERLAP;
return;
}
}
/* If mem seg NOT found, adv to next mem seg. */
pmem_pool_prev = pmem_pool_next;
pmem_pool_next = pmem_pool_next->SegNextPtr;
}
if (pmem_pool_blk == (MEM_POOL *)0) { /* If mem seg NOT found, add new mem seg. */
pmem_pool_blk = pmem_pool;
pmem_pool->SegAddr = pmem_base_addr;
pmem_pool->SegAddrNextAvail = pmem_base_addr;
pmem_pool->SegSizeTot = mem_size;
pmem_pool->SegSizeRem = mem_size;
}
/*$PAGE*/
/* --------------- VALIDATE MEM SEG --------------- */
/* Calc tot mem size for mem pool ptrs. */
pmem_addr_ptrs = (CPU_INT08U *)pmem_pool_heap->SegAddrNextAvail;
size_tot_ptrs = Mem_PoolSegCalcTotSize((void *)pmem_addr_ptrs,
(CPU_SIZE_T)blk_nbr,
(CPU_SIZE_T)sizeof(void *),
(CPU_SIZE_T)sizeof(void *));
size_rem = pmem_pool_heap->SegSizeRem;
if (size_tot_ptrs > size_rem) { /* If ptr size > rem size, ... */
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_HEAP_EMPTY;
if (poctets_reqd != (CPU_SIZE_T *)0) {
*poctets_reqd = size_tot_ptrs - size_rem; /* ... rtn add'l size needed. */
}
return;
}
/* Calc tot mem size for mem blks. */
pmem_addr_pool = (CPU_INT08U *)pmem_pool_blk->SegAddrNextAvail;
size_tot_pool = Mem_PoolSegCalcTotSize((void *)pmem_addr_pool,
(CPU_SIZE_T)blk_nbr,
(CPU_SIZE_T)blk_size,
(CPU_SIZE_T)blk_align);
size_rem = pmem_pool_blk->SegSizeRem;
if (size_tot_pool > size_rem) { /* If tot size > rem size, ... */
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_SEG_EMPTY;
if (poctets_reqd != (CPU_SIZE_T *)0) {
*poctets_reqd = size_tot_pool - size_rem; /* ... rtn add'l size needed. */
}
return;
}
}
/* ---------------- ALLOC MEM BLKs ---------------- */
size_pool_ptrs = blk_nbr * sizeof(void *);
/* Alloc stk of ptrs for mem blks from heap. */
ppool_ptr = (void **)Mem_PoolSegAlloc((MEM_POOL *)pmem_pool_heap,
(CPU_SIZE_T)size_pool_ptrs,
(CPU_SIZE_T)sizeof(void *));
for (i = 0; i < blk_nbr; i++) { /* Alloc mem blks from blk seg ptr. */
pmem_blk = (void *)Mem_PoolSegAlloc(pmem_pool_blk, blk_size, blk_align);
if (pmem_blk == (void *)0) {
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_SEG_EMPTY;
if (poctets_reqd != (CPU_SIZE_T *)0) {
*poctets_reqd = (blk_nbr - i) * sizeof(void *);
}
return;
}
ppool_ptr[i] = pmem_blk;
}
/*$PAGE*/
/* ------------- UPDATE MEM POOL TBL -------------- */
if (pmem_pool_prev == pmem_pool_next) { /* Add new mem seg to list. */
pmem_pool_next = pmem_pool_blk->PoolNextPtr;
pmem_pool->PoolPrevPtr = pmem_pool_blk;
pmem_pool->PoolNextPtr = pmem_pool_next;
pmem_pool_blk->PoolNextPtr = pmem_pool;
if (pmem_pool_next != (MEM_POOL *)0) {
pmem_pool_next->PoolPrevPtr = pmem_pool;
}
} else { /* Add new mem pool to mem seg. */
pmem_pool->SegPrevPtr = pmem_pool_prev;
pmem_pool->SegNextPtr = pmem_pool_next;
if (pmem_pool_prev != (MEM_POOL *)0) { /* Update prev mem pool link. */
pmem_pool_prev->SegNextPtr = pmem_pool;
} else {
Mem_PoolTbl = pmem_pool; /* Update mem pool head. */
}
if (pmem_pool_next != (MEM_POOL *)0) { /* Update next mem pool link. */
pmem_pool_next->SegPrevPtr = pmem_pool;
}
}
/* ----------------- CFG MEM POOL ----------------- */
pmem_pool->Type = (LIB_MEM_TYPE) LIB_MEM_TYPE_POOL;
pmem_pool->PoolAddrStart = (void *) pmem_addr_pool;
pmem_pool->PoolAddrEnd = (void *)(pmem_addr_pool + size_tot_pool - 1);
pmem_pool->PoolPtrs = (void **) ppool_ptr;
pmem_pool->PoolSize = (CPU_SIZE_T ) size_tot_pool;
pmem_pool->BlkAlign = (CPU_SIZE_T ) blk_align;
pmem_pool->BlkSize = (CPU_SIZE_T ) blk_size;
pmem_pool->BlkNbr = (CPU_SIZE_T ) blk_nbr;
pmem_pool->BlkIx = (MEM_POOL_IX ) blk_nbr;
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_NONE;
}
#endif
/*$PAGE*/
/*
*********************************************************************************************************
* Mem_PoolBlkGet()
*
* Description : Get a memory block from memory pool.
*
* Argument(s) : pmem_pool Pointer to memory pool to get memory block from.
*
* size Size of requested memory (in octets).
*
* perr Pointer to variable that will receive the return error code from this function :
*
* LIB_MEM_ERR_NONE Memory block successfully returned.
* LIB_MEM_ERR_POOL_EMPTY NO memory blocks available in memory pool.
*
* LIB_MEM_ERR_NULL_PTR Argument 'pmem_pool' passed a NULL pointer.
* LIB_MEM_ERR_INVALID_POOL Invalid memory pool type.
* LIB_MEM_ERR_INVALID_BLK_SIZE Invalid memory pool block size requested.
* LIB_MEM_ERR_INVALID_BLK_IX Invalid memory pool block index.
*
* Return(s) : Pointer to memory block, if NO errors.
*
* Pointer to NULL, otherwise.
*
* Caller(s) : Application.
*
* Note(s) : none.
*********************************************************************************************************
*/
#if (LIB_MEM_CFG_ALLOC_EN == DEF_ENABLED)
void *Mem_PoolBlkGet (MEM_POOL *pmem_pool,
CPU_SIZE_T size,
LIB_ERR *perr)
{
#if (CPU_CFG_CRITICAL_METHOD == CPU_CRITICAL_METHOD_STATUS_LOCAL)
CPU_SR cpu_sr;
#endif
void *pmem_blk;
/* ------------ VALIDATE MEM POOL GET ------------- */
if (pmem_pool == (MEM_POOL *)0) {
*perr = LIB_MEM_ERR_NULL_PTR;
return ((void *)0);
}
CPU_CRITICAL_ENTER();
if (pmem_pool->Type != LIB_MEM_TYPE_POOL) {
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_INVALID_POOL;
return ((void *)0);
}
if (size > pmem_pool->BlkSize) {
CPU_CRITICAL_EXIT();
*perr = LIB_MEM_ERR_INVALID_BLK_SIZE;
return ((void *)0);
}
if (pmem_pool->BlkIx < 1) {
CPU_CRITICAL_EXIT();
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -