mnt_cond.c

来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 511 行 · 第 1/2 页

C
511
字号
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/kernel/src/mnt_cond.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><font color="#6920ac">/************************************************************************** * * FILE NAME * *      mnt_cond.c * * SYSTEM COMPONENT * *      Conditions Component * * DESCRIPTION * *      This file contains the core services for Monitor's Conditions *      Component. * * SERVICES * *      mntr_CondCreate     create/initialise condition object *      mntr_CondDelete     destroy condition *      mntr_Signal         signal on condition  *      mntr_Broadcast      broadcast on condition  *      mntr_SignalByKey    signal by key value *      mntr_BroadcastByKey broadcast by key value *      mntr_Wait           wait on condition * * SCCS HISTORY * *      @(#)mnt_cond.c  1.13, 03/16/99, 19:33:39 * * AUTHOR * *      Vadim N. Azarovsky * * CREATED * *      28-Feb-1998         by Vadim N. Azarovsky * * REVISION HISTORY * *      NAME                DATE                    REMARKS * **************************************************************************/</font><b><font color='DarkGreen'>#include</font></b> <a href="ass_defs.h.FIND-INC"><font color="blue">"ass_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="swi_defs.h.FIND-INC"><font color="blue">"swi_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="hwi_defs.h.FIND-INC"><font color="blue">"hwi_defs.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="thr_priv.h.FIND-INC"><font color="blue">"thr_priv.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="mnt_priv.h.FIND-INC"><font color="blue">"mnt_priv.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="stdarg.h.FIND-INC">&lt;<font color="blue">stdarg.h</font>&gt;</a><font color="#6920ac">/* create/initialise condition */</font><font size="+1"><i>mntr_Condition_t</i> *<b><font color="azure1"><a name="mntr_CondCreate">mntr_CondCreate</a></font></b>(    <i>mntr_Condition_t</i>    *pCondition_a,    <i>mntr_Monitor_t</i>      *pMonitor_a,     <i>mntr_CondAttr_t</i>     *pAttr_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>(pMonitor_a)    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_MONITOR_ID.FIND-DEF">MNTR_CHECK_MONITOR_ID</a>(pMonitor_a))    <b>if</b> (pAttr_a == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)        pAttr_a = &amp;mntr_CondAttrDefault_g;    <b>if</b> (pCondition_a == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)    {        pCondition_a = (<i>mntr_Condition_t</i>*)<a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(pAttr_a-&gt;Segment,                                                     <i>sizeof</i>(<i>mntr_Condition_t</i>),                                                     <i>sizeof</i>(<i>crtx_Unsigned_t</i>));        <b>if</b> ((<i>crtx_Void_t</i>*)pCondition_a == (<i>crtx_Void_t</i>*)<a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>)        {   <font color="#6920ac">/* memory allocation error */</font>            <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> MemAllocError_Exc;        }        pCondition_a-&gt;Flags = <a href="MNTR_FLAG_INIT.FIND-DEF">MNTR_FLAG_INIT</a> | <a href="MNTR_FLAG_COND_ALLOC.FIND-DEF">MNTR_FLAG_COND_ALLOC</a>;    }    <b>else</b>    {        pCondition_a-&gt;Flags = <a href="MNTR_FLAG_INIT.FIND-DEF">MNTR_FLAG_INIT</a>;    }    <font color="#6920ac">/* initialise condition */</font>    <a href="MNTR_SET_COND_SUSP_POLICY.FIND-DEF">MNTR_SET_COND_SUSP_POLICY</a>(pCondition_a, pAttr_a);    pCondition_a-&gt;pMonitor = pMonitor_a;    pCondition_a-&gt;Segment  = pAttr_a-&gt;Segment;    <a href="RQUE_INIT_QUEUE.FIND-DEF">RQUE_INIT_QUEUE</a>(&amp;pCondition_a-&gt;WaitingList);    <b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>    <a href="MNTR_SET_CONDITION_ID.FIND-DEF">MNTR_SET_CONDITION_ID</a>(pCondition_a);<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>    <b>return</b> pCondition_a;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font><font color="blue">MemAllocError_Exc:</font>        <font color="#6920ac">/* memory allocation error exception */</font>    <b>return</b> <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;}<font color="#6920ac">/* delete condition */</font><font size="+1"><i>crtx_Status_t</i> <b><font color="azure1"><a name="mntr_CondDelete">mntr_CondDelete</a></font></b>(    <i>mntr_Condition_t</i> *pCondition_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>(pCondition_a)    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_CONDITION_ID.FIND-DEF">MNTR_CHECK_CONDITION_ID</a>(pCondition_a))    <b>if</b> (pCondition_a-&gt;Flags &amp; <a href="MNTR_FLAG_COND_ALLOC.FIND-DEF">MNTR_FLAG_COND_ALLOC</a>)    {        <font color="#6920ac">/* release internaly allocated control block */</font>        <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(pCondition_a-&gt;Segment, (<i>crtx_Void_t</i>*)pCondition_a,                  <i>sizeof</i>(<i>mntr_Condition_t</i>));    }    <b>else</b>    {        pCondition_a-&gt;Flags = <a href="MNTR_FLAG_INIT.FIND-DEF">MNTR_FLAG_INIT</a>;<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>        <a href="CRTX_SET_NO_ID.FIND-DEF">CRTX_SET_NO_ID</a>(pCondition_a);           <font color="#6920ac">/* no id */</font><b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>    }    <b>return</b> <a href="CRTX_SUCCESS.FIND-DEF">CRTX_SUCCESS</a>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* signal on condition (returns number signalled tasks) */</font><font size="+1"><i>crtx_Int_t</i> <b><font color="azure1"><a name="mntr_Signal">mntr_Signal</a></font></b>(    <i>mntr_Condition_t</i> *pCondition_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a> <i>crtx_Int_t</i>           Signalled = 0;    <a href="CRTX_REG_2.FIND-DEF">CRTX_REG_2</a> <i>mntr_SuspendBlock_t</i>  *pSuspendBlock;    <a href="CRTX_REG_3.FIND-DEF">CRTX_REG_3</a> <i>rque_Queue_t</i>         *pWaitingList;<font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pCondition_a)    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_CONDITION_ID.FIND-DEF">MNTR_CHECK_CONDITION_ID</a>(pCondition_a))    pWaitingList = &amp;pCondition_a-&gt;WaitingList;    <b>if</b> (!<a href="RQUE_IS_EMPTY.FIND-DEF">RQUE_IS_EMPTY</a>(pWaitingList))    {        <a href="thrd_Protect.FIND-FUNC">thrd_Protect</a>();        <font color="#6920ac">/* check again to avoid race conditions */</font>        <b>if</b> (!<a href="RQUE_IS_EMPTY.FIND-DEF">RQUE_IS_EMPTY</a>(pWaitingList))        {            pSuspendBlock =                 (<i>mntr_SuspendBlock_t</i>*)<a href="RQUE_GET_TAIL_ARG.FIND-DEF">RQUE_GET_TAIL_ARG</a>(pWaitingList);            <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pSuspendBlock)<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL&gt;0</font>            <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_SUSPEND_BLOCK_ID.FIND-DEF">MNTR_CHECK_SUSPEND_BLOCK_ID</a>(pSuspendBlock))            <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_CONDITION_REF.FIND-DEF">MNTR_CHECK_CONDITION_REF</a>(pSuspendBlock,pCondition_a))<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL&gt;0 */</font></font>            <a href="thrd_Resume.FIND-FUNC">thrd_Resume</a>(pSuspendBlock-&gt;ThreadID);            Signalled = 1;        }        <a href="thrd_Unprotect.FIND-FUNC">thrd_Unprotect</a>();    }    <b>return</b> Signalled;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* signal on condition by key value (returns number signalled tasks) */</font><font size="+1"><i>crtx_Int_t</i> <b><font color="azure1"><a name="mntr_SignalByKey">mntr_SignalByKey</a></font></b>(    <i>mntr_Condition_t</i>    *pCondition_a,     <i>mntr_KeyCompFunc_t</i>  CompFunc_a,     <i>mntr_Key_t</i>          Key_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a> <i>crtx_Int_t</i>           Signalled = 0;    <a href="CRTX_REG_2.FIND-DEF">CRTX_REG_2</a> <i>mntr_SuspendBlock_t</i>  *pSuspendBlock;    <a href="CRTX_REG_3.FIND-DEF">CRTX_REG_3</a> <i>rque_Node_t</i>          *pNode;               <i>rque_Cursor_t</i>        Cursor;<font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pCondition_a)    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_CONDITION_ID.FIND-DEF">MNTR_CHECK_CONDITION_ID</a>(pCondition_a))    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(CompFunc_a)    <b>if</b> (!<a href="RQUE_IS_EMPTY.FIND-DEF">RQUE_IS_EMPTY</a>(&amp;pCondition_a-&gt;WaitingList))    {        <a href="thrd_Protect.FIND-FUNC">thrd_Protect</a>();        <a href="rque_CursorInit.FIND-FUNC">rque_CursorInit</a>(&amp;pCondition_a-&gt;WaitingList, &amp;Cursor);        <b>while</b> ((pNode = <a href="rque_CursorNext.FIND-FUNC">rque_CursorNext</a>(&amp;Cursor)) != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)        {            pSuspendBlock =                 (<i>mntr_SuspendBlock_t</i>*)<a href="RQUE_GET_NODE_ARG.FIND-DEF">RQUE_GET_NODE_ARG</a>(pNode);

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?