📄 mempool.c
字号:
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/tests/rrl_test/src/mempool.c</TITLE></HEAD><BODY><pre><font color="#6920ac">/*************************************************************************/</font><font color="#6920ac">/* */</font><font color="#6920ac">/* Copyright (c) 1997-1999 Australian Real Time Embedded Systems */</font><font color="#6920ac">/* */</font><font color="#6920ac">/* PROPRIETARY RIGHTS of Australian Real Time Embedded Systems */</font><font color="#6920ac">/* are involved in the subject matter of this material. All reproduction,*/</font><font color="#6920ac">/* manufacturing, use, and sales rights pertaining to this subject matter*/</font><font color="#6920ac">/* are governed by the license agreement. The recipient of this software */</font><font color="#6920ac">/* implicitly accepts the terms of the license. */</font><font color="#6920ac">/* */</font><font color="#6920ac">/*************************************************************************/</font><b><font color='DarkGreen'>#include</font></b> <a href="mempool.h.FIND-INC"><font color="blue">"mempool.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="prn_defs.h.FIND-INC"><font color="blue">"prn_defs.h"</font></a><font color="#6920ac">/* create protected fixed size memory pool */</font><font size="+1"><i>crtx_Status_t</i> <b><font color="azure1"><a name="MemPoolCreate">MemPoolCreate</a></font></b>(MemPool_t *pPool_a, <i>crtx_Int_t</i> NrBlocks_a, <i>crtx_Int_t</i> Size_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <font color="#6920ac">/* None */</font><font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pPool_a) <font color="#6920ac">/* create memory pool */</font> pPool_a->pPool = <a href="fsmp_Create.FIND-FUNC">fsmp_Create</a>(NrBlocks_a, Size_a, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); <b>if</b> (pPool_a->pPool == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) <b>return</b> <a href="MEM_POOL_ERR_ALLOC.FIND-DEF">MEM_POOL_ERR_ALLOC</a>; <font color="#6920ac">/* initialise resource lock */</font> <a href="rrlc_Create.FIND-FUNC">rrlc_Create</a>(&pPool_a->Lock, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); pPool_a->EntryCntr = 0; pPool_a->AllocCntr = 0; pPool_a->FreeCntr = 0; pPool_a->LockCntr = 0; <b>return</b> <a href="MEM_POOL_SUCCESS.FIND-DEF">MEM_POOL_SUCCESS</a>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* destroy protected fixed size memory pool */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="MemPoolDelete">MemPoolDelete</a></font></b>(MemPool_t *pPool_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <font color="#6920ac">/* None */</font><font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <font color="#6920ac">/* delete pool */</font> <a href="fsmp_Delete.FIND-FUNC">fsmp_Delete</a>(pPool_a->pPool); <font color="#6920ac">/* delete lock */</font> <a href="rrlc_Delete.FIND-FUNC">rrlc_Delete</a>(&pPool_a->Lock); <b>return</b>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* allocate block */</font><font size="+1"><i>crtx_Void_t</i> *<b><font color="azure1"><a name="MemPoolAllocate">MemPoolAllocate</a></font></b>(MemPool_t *pPool_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>crtx_Void_t</i> *pBlock;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pPool_a) <a href="#MemPoolLock">MemPoolLock</a>(pPool_a); <font color="#6920ac">/* validate pool before update */</font> <b>if</b> (<a href="fsmp_Validate.FIND-FUNC">fsmp_Validate</a>(pPool_a->pPool) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: fsmp_Validate: failed on pool %p\n"</font>, <a href="task_GetName.FIND-FUNC">task_GetName</a>(<a href="task_Self.FIND-FUNC">task_Self</a>()), <a href="task_Self.FIND-FUNC">task_Self</a>(), <a href="__FILE__.FIND-DEF">__FILE__</a>, <a href="__LINE__.FIND-DEF">__LINE__</a>, pPool_a); } pBlock = <a href="fsmp_Allocate.FIND-FUNC">fsmp_Allocate</a>(pPool_a->pPool); <font color="#6920ac">/* validate pool after update */</font> <b>if</b> (<a href="fsmp_Validate.FIND-FUNC">fsmp_Validate</a>(pPool_a->pPool) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: fsmp_Validate: failed on pool %p\n"</font>, <a href="task_GetName.FIND-FUNC">task_GetName</a>(<a href="task_Self.FIND-FUNC">task_Self</a>()), <a href="task_Self.FIND-FUNC">task_Self</a>(), <a href="__FILE__.FIND-DEF">__FILE__</a>, <a href="__LINE__.FIND-DEF">__LINE__</a>, pPool_a); } pPool_a->EntryCntr++; pPool_a->AllocCntr++; <a href="#MemPoolUnlock">MemPoolUnlock</a>(pPool_a); <b>return</b> pBlock;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* free block */</font><font size="+1"><i>crtx_Status_t</i> <b><font color="azure1"><a name="MemPoolFree">MemPoolFree</a></font></b>(MemPool_t *pPool_a, <i>crtx_Void_t</i> *pBlock_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>crtx_Status_t</i> Status;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="#MemPoolLock">MemPoolLock</a>(pPool_a); <font color="#6920ac">/* validate pool before update */</font> <b>if</b> (<a href="fsmp_Validate.FIND-FUNC">fsmp_Validate</a>(pPool_a->pPool) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: fsmp_Validate: failed on pool %p\n"</font>, <a href="task_GetName.FIND-FUNC">task_GetName</a>(<a href="task_Self.FIND-FUNC">task_Self</a>()), <a href="task_Self.FIND-FUNC">task_Self</a>(), <a href="__FILE__.FIND-DEF">__FILE__</a>, <a href="__LINE__.FIND-DEF">__LINE__</a>, pPool_a); } Status = <a href="fsmp_Free.FIND-FUNC">fsmp_Free</a>(pPool_a->pPool, pBlock_a); <b>if</b> (Status != <a href="FSMP_SUCCESS.FIND-DEF">FSMP_SUCCESS</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: fsmp_Free: block %p on pool %p:"</font> <font color="DarkGreen">" ErrNo=%ld\n"</font>, <a href="task_GetName.FIND-FUNC">task_GetName</a>(<a href="task_Self.FIND-FUNC">task_Self</a>()), <a href="task_Self.FIND-FUNC">task_Self</a>(), <a href="__FILE__.FIND-DEF">__FILE__</a>, <a href="__LINE__.FIND-DEF">__LINE__</a>, pBlock_a, pPool_a, Status); } <font color="#6920ac">/* validate pool after update */</font> <b>if</b> (<a href="fsmp_Validate.FIND-FUNC">fsmp_Validate</a>(pPool_a->pPool) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: fsmp_Validate: failed on pool %p\n"</font>, <a href="task_GetName.FIND-FUNC">task_GetName</a>(<a href="task_Self.FIND-FUNC">task_Self</a>()), <a href="task_Self.FIND-FUNC">task_Self</a>(), <a href="__FILE__.FIND-DEF">__FILE__</a>, <a href="__LINE__.FIND-DEF">__LINE__</a>, pPool_a); } pPool_a->EntryCntr++; pPool_a->FreeCntr++; <a href="#MemPoolUnlock">MemPoolUnlock</a>(pPool_a); <b>return</b> Status;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* lock pool */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="MemPoolLock">MemPoolLock</a></font></b>(MemPool_t *pPool_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>crtx_Boolean_t</i> LockTryFlag;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <b>while</b>(<a href="CRTX_TRUE.FIND-DEF">CRTX_TRUE</a>) { LockTryFlag = <a href="hrdi_Inc.FIND-FUNC">hrdi_Inc</a>(&pPool_a->LockCntr) & 0x1; <b>switch</b> (LockTryFlag) { <b>case</b> 0: <font color="#6920ac">/* use rrlc_Lock */</font> <a href="rrlc_Lock.FIND-FUNC">rrlc_Lock</a>(&pPool_a->Lock); <b>return</b>; <b>case</b> 1: <font color="#6920ac">/* use rrlc_Try */</font> <b>if</b> (<a href="rrlc_Try.FIND-FUNC">rrlc_Try</a>(&pPool_a->Lock) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="task_Sleep.FIND-FUNC">task_Sleep</a>(0); <b>break</b>; } <b>else</b> { <b>return</b>; } } }<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* unlock pool */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="MemPoolUnlock">MemPoolUnlock</a></font></b>(MemPool_t *pPool_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <font color="#6920ac">/* None */</font><font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="rrlc_Unlock.FIND-FUNC">rrlc_Unlock</a>(&pPool_a->Lock);<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -