comqueue.c
来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 266 行
C
266 行
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/tests/rrl_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){</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) <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 resource lock */</font> <a href="rrlc_Create.FIND-FUNC">rrlc_Create</a>(&pQueue_a->Lock, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); 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 lock */</font> <a href="rrlc_Delete.FIND-FUNC">rrlc_Delete</a>(&pQueue_a->Lock); <b>return</b>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* put message on queue */</font><font size="+1"><i>crtx_Void_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> <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>(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); } <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> <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); } pQueue_a->EntryCntr++; pQueue_a->PutCntr++; <a href="#ComQueueUnlock">ComQueueUnlock</a>(pQueue_a); <b>return</b>;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* get message from queue */</font><font size="+1"><i>rque_Node_t</i> *<b><font color="azure1"><a name="ComQueueGet">ComQueueGet</a></font></b>(ComQueue_t *pQueue_a){</font><font color="#6920ac">/********************* * LOCAL VARIABLES * *********************/</font> <i>rque_Node_t</i> *pNode;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pQueue_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); } <font color="#6920ac">/* get node from queue */</font> pNode = <a href="rque_RemoveTail.FIND-FUNC">rque_RemoveTail</a>(&pQueue_a->Queue); <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); } pQueue_a->EntryCntr++; pQueue_a->GetCntr++; <a href="#ComQueueUnlock">ComQueueUnlock</a>(pQueue_a); <b>return</b> pNode;<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* lock queue */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="ComQueueLock">ComQueueLock</a></font></b>(ComQueue_t *pQueue_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>(&pQueue_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>(&pQueue_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>(&pQueue_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 queue */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="ComQueueUnlock">ComQueueUnlock</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> <a href="rrlc_Unlock.FIND-FUNC">rrlc_Unlock</a>(&pQueue_a->Lock);<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?