comqueue.c
来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 329 行
C
329 行
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/tests/sem_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="sema_Create.FIND-FUNC">sema_Create</a>(&pQueue_a->NotEmpty, 0, Size_a, <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>); <a href="sema_Create.FIND-FUNC">sema_Create</a>(&pQueue_a->NotFull, Size_a, Size_a, <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="sema_Delete.FIND-FUNC">sema_Delete</a>(&pQueue_a->NotEmpty); <a href="sema_Delete.FIND-FUNC">sema_Delete</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 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>crtx_Boolean_t</i> WaitTryFlag;<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> WaitTryFlag = pQueue_a->EntryCntr & 0x1; <b>switch</b> (WaitTryFlag) { <b>case</b> 0: <font color="#6920ac">/* use sema_Wait */</font> <a href="sema_Wait.FIND-FUNC">sema_Wait</a>(&pQueue_a->NotFull); <b>break</b>; <b>case</b> 1: <font color="#6920ac">/* use sema_Try */</font> <b>if</b> (<a href="sema_Try.FIND-FUNC">sema_Try</a>(&pQueue_a->NotFull) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>; } <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> pQueue_a->Length++; <b>if</b> (pQueue_a->Size < pQueue_a->Length) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: too many messages on queue %p (%d/%d)\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->Length, pQueue_a->Size); <a href="syst_Fatal.FIND-FUNC">syst_Fatal</a>(<font color="DarkGreen">"Too many messages queued!"</font>); } <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pQueue_a->Length>0 && pQueue_a->Length<=pQueue_a->Size) <font color="#6920ac">/* validate queue 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); <a href="sema_Post.FIND-FUNC">sema_Post</a>(&pQueue_a->NotEmpty); <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">/* 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; <i>crtx_Boolean_t</i> WaitTryFlag;<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> WaitTryFlag = pQueue_a->EntryCntr & 0x1; <b>switch</b> (WaitTryFlag) { <b>case</b> 0: <font color="#6920ac">/* use sema_Wait */</font> <a href="sema_Wait.FIND-FUNC">sema_Wait</a>(&pQueue_a->NotEmpty); <b>break</b>; <b>case</b> 1: <font color="#6920ac">/* use sema_Try */</font> <b>if</b> (<a href="sema_Try.FIND-FUNC">sema_Try</a>(&pQueue_a->NotEmpty) == <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) <b>return</b> <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>; } <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); <b>if</b> (pNode == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) { <a href="printf.FIND-FUNC">printf</a>(<font color="DarkGreen">"%s[%d]:ERROR: %s: %d: queue %p is empty\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); <a href="syst_Fatal.FIND-FUNC">syst_Fatal</a>(<font color="DarkGreen">"Communication queue is empty!"</font>); } <font color="#6920ac">/* validate queue 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); } <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pQueue_a->Length>0 && pQueue_a->Length<=pQueue_a->Size) pQueue_a->Length--; pQueue_a->EntryCntr++; pQueue_a->GetCntr++; <a href="#ComQueueUnlock">ComQueueUnlock</a>(pQueue_a); <a href="sema_Post.FIND-FUNC">sema_Post</a>(&pQueue_a->NotFull); <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 mutx_Lock */</font> <a href="mutx_Lock.FIND-FUNC">mutx_Lock</a>(&pQueue_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>(&pQueue_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 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="mutx_Unlock.FIND-FUNC">mutx_Unlock</a>(&pQueue_a->Mutex);<font color="#6920ac">/************************ * EXCEPTION HANDLING * ************************/</font> <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?