mempool.c
来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 315 行
C
315 行
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/tests/cnd_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 mutex */</font> <a href="mutx_Create.FIND-FUNC">mutx_Create</a>(&pPool_a->Mutex, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); <font color="#6920ac">/* initialise mutex's condition */</font> <a href="mutx_CondCreate.FIND-FUNC">mutx_CondCreate</a>(&pPool_a->NotEmpty, &pPool_a->Mutex, <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 mutex's condition */</font> <a href="mutx_CondDelete.FIND-FUNC">mutx_CondDelete</a>(&pPool_a->NotEmpty); <font color="#6920ac">/* delete mutex */</font> <a href="mutx_Delete.FIND-FUNC">mutx_Delete</a>(&pPool_a->Mutex); <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; <i>tick_Timeout_t</i> Timeout;<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); } Timeout = <a href="rand.FIND-FUNC">rand</a>() & 0x7; <b>while</b> ((pBlock = <a href="fsmp_Allocate.FIND-FUNC">fsmp_Allocate</a>(pPool_a->pPool)) == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { <font color="#6920ac">/* wait for a "Not Empty" signal */</font> pPool_a->WaitCntr++; <b>if</b> (<a href="mutx_Wait.FIND-FUNC">mutx_Wait</a>(&pPool_a->NotEmpty, &Timeout) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) <b>break</b>; } <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 size="+1"><i>static</i> <i>crtx_Boolean_t</i> <b><font color="azure1"><a name="KeyCompFunc">KeyCompFunc</a></font></b>(<i>mutx_Key_t</i> WaitKey_a, <i>mutx_Key_t</i> ArgKey_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>mutx_Key_t</i> WaitKey; <i>mutx_Key_t</i> ArgKey;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> WaitKey = WaitKey_a; ArgKey = ArgKey_a; <b>return</b> <a href="CRTX_TRUE.FIND-DEF">CRTX_TRUE</a>; <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:"</font> <font color="DarkGreen">" fsmp_Free: block %p on pool %p: 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); } <b>switch</b>(pPool_a->EntryCntr & 0x3) { <b>case</b> 0: <a href="mutx_Signal.FIND-FUNC">mutx_Signal</a>(&pPool_a->NotEmpty); <b>break</b>; <b>case</b> 1: <a href="mutx_Broadcast.FIND-FUNC">mutx_Broadcast</a>(&pPool_a->NotEmpty); <b>break</b>; <font color="blue"><b>default</b>:</font> <a href="mutx_SignalByKey.FIND-FUNC">mutx_SignalByKey</a>(&pPool_a->NotEmpty, KeyCompFunc, (<i>mutx_Key_t</i>)pPool_a->EntryCntr); <b>break</b>; } 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 mutx_Lock */</font> <a href="mutx_Lock.FIND-FUNC">mutx_Lock</a>(&pPool_a->Mutex); <b>return</b>; <b>case</b> 1: <font color="#6920ac">/* use mutx_Try */</font> <b>if</b> (<a href="mutx_Try.FIND-FUNC">mutx_Try</a>(&pPool_a->Mutex) == <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="mutx_Unlock.FIND-FUNC">mutx_Unlock</a>(&pPool_a->Mutex);<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?