comqueue.c
来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 365 行 · 第 1/2 页
C
365 行
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/tests/cnd_test/src/comqueue.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="comqueue.h.FIND-INC"><font color="blue">"comqueue.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 queue */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="ComQueueCreate">ComQueueCreate</a></font></b>( ComQueue_t *pQueue_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>(pQueue_a) <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(Size_a) <font color="#6920ac">/* initialise queue control structure */</font> <a href="rque_CreateQueue.FIND-FUNC">rque_CreateQueue</a>(&pQueue_a->Queue, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); <font color="#6920ac">/* initialise mutex */</font> <a href="mutx_Create.FIND-FUNC">mutx_Create</a>(&pQueue_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>(&pQueue_a->NotEmpty, &pQueue_a->Mutex, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); <a href="mutx_CondCreate.FIND-FUNC">mutx_CondCreate</a>(&pQueue_a->NotFull, &pQueue_a->Mutex, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); pQueue_a->Size = Size_a; pQueue_a->Length = 0; pQueue_a->EntryCntr = 0; pQueue_a->GetCntr = 0; pQueue_a->PutCntr = 0; pQueue_a->LockCntr = 0; <b>return</b>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* destroy protected queue */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="ComQueueDelete">ComQueueDelete</a></font></b>(ComQueue_t *pQueue_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="rque_DestroyQueue.FIND-FUNC">rque_DestroyQueue</a>(&pQueue_a->Queue); <font color="#6920ac">/* delete mutex's condition */</font> <a href="mutx_CondDelete.FIND-FUNC">mutx_CondDelete</a>(&pQueue_a->NotEmpty); <a href="mutx_CondDelete.FIND-FUNC">mutx_CondDelete</a>(&pQueue_a->NotFull); <font color="#6920ac">/* delete mutex */</font> <a href="mutx_Delete.FIND-FUNC">mutx_Delete</a>(&pQueue_a->Mutex); <b>return</b>;<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">/* put message on queue */</font><font size="+1"><i>crtx_Boolean_t</i> <b><font color="azure1"><a name="ComQueuePut">ComQueuePut</a></font></b>(ComQueue_t *pQueue_a, <i>rque_Node_t</i> *pNode_a, <i>rlst_Key_t</i> Key_a __attribute__((unused))){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>tick_Timeout_t</i> Timeout;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pQueue_a) <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pNode_a)<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL > 0</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="RQUE_CHECK_QUEUE_ID.FIND-DEF">RQUE_CHECK_QUEUE_ID</a>(&pQueue_a->Queue))<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL > 0 */</font></font> <a href="#ComQueueLock">ComQueueLock</a>(pQueue_a); <font color="#6920ac">/* validate pool before update */</font> <b>if</b> (<a href="rque_Validate.FIND-FUNC">rque_Validate</a>(&pQueue_a->Queue) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: rque_Validate: failed on %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>, pQueue_a); } Timeout = <a href="rand.FIND-FUNC">rand</a>() & 0x7; <b>while</b>(pQueue_a->Size == pQueue_a->Length) { <font color="#6920ac">/* wait for a "Not Full" signal */</font> pQueue_a->WaitCntr++; <b>if</b> (<a href="mutx_Wait.FIND-FUNC">mutx_Wait</a>(&pQueue_a->NotFull, &Timeout) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="#ComQueueUnlock">ComQueueUnlock</a>(pQueue_a); <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>; } } <font color="#6920ac">/* put node on queue */</font><font color="#6920ac">#if 0 rque_EnqueueByKey(&pQueue_a->Queue, pNode_a, Key_a);#else rque_AddHead(&pQueue_a->Queue, pNode_a);#endif</font> pQueue_a->Length++; <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pQueue_a->Length>0 && pQueue_a->Length<=pQueue_a->Size) <font color="#6920ac">/* validate pool after update */</font> <b>if</b> (<a href="rque_Validate.FIND-FUNC">rque_Validate</a>(&pQueue_a->Queue) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: qeue_Validate: failed on %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>, pQueue_a);⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?