smt_core.c

来自「澳洲人写的Cortex,包括uC_IP协议栈」· C语言 代码 · 共 198 行

C
198
字号
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/examples/exmpl4/src/smt_core.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="smt_defs.h.FIND-INC"><font color="blue">"smt_defs.h"</font></a><font color="#6920ac">/* create/initialise semaphore */</font><font size="+1"><i>semt_Semaphore_t</i> *<b><font color="azure1"><a name="semt_Create">semt_Create</a></font></b>(    <i>crtx_Int_t</i> InitValue_a,    <i>crtx_Int_t</i> MaxValue_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <i>semt_Semaphore_t</i>    *pSemaphore;<font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <font color="#6920ac">/* allocate semaphore descriptor block */</font>    pSemaphore = (<i>semt_Semaphore_t</i>*)<a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(<a href="DMEM_STD_SEGMENT.FIND-DEF">DMEM_STD_SEGMENT</a>,                                               <i>sizeof</i>(<i>semt_Semaphore_t</i>),                                               <i>sizeof</i>(<i>crtx_Uint32_t</i>));    <b>if</b> ((<i>crtx_Void_t</i>*)pSemaphore == <a href="DMEM_ILLEGAL.FIND-DEF">DMEM_ILLEGAL</a>)        <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> MemAllocFailed_Exc;    <b>if</b> ((pSemaphore-&gt;pMutex = <a href="mutx_Create.FIND-FUNC">mutx_Create</a>(<a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>, <a href="NULL.FIND-DEF">NULL</a>)) ==         (<i>mutx_Mutex_t</i>*)<a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)        <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> MutexCreateFailed_Exc;    <b>if</b> ((pSemaphore-&gt;pNonZero = <a href="mutx_CondCreate.FIND-FUNC">mutx_CondCreate</a>(<a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>, pSemaphore-&gt;pMutex,                                                <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>))        == (<i>mutx_Condition_t</i> *)<a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)        <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> ConditionCreateFailed_Exc;    pSemaphore-&gt;Value = InitValue_a;    pSemaphore-&gt;MaxValue = MaxValue_a;    <b>return</b> pSemaphore;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font><font color="blue">ConditionCreateFailed_Exc:</font>    <a href="mutx_Delete.FIND-FUNC">mutx_Delete</a>(pSemaphore-&gt;pMutex);    <font color="#6920ac">/* FALL-THROUGH */</font><font color="blue">MutexCreateFailed_Exc:</font>    <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(<a href="DMEM_STD_SEGMENT.FIND-DEF">DMEM_STD_SEGMENT</a>, (<i>crtx_Void_t</i>*)pSemaphore,               <i>sizeof</i>(<i>semt_Semaphore_t</i>));    <font color="#6920ac">/* FALL-THROUGH */</font><font color="blue">MemAllocFailed_Exc:</font>    <b>return</b> <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;}<font color="#6920ac">/* destroy semaphore */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="semt_Delete">semt_Delete</a></font></b>(<i>semt_Semaphore_t</i> *pSemaphore_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <font color="#6920ac">/* None */</font><font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <a href="mutx_CondDelete.FIND-FUNC">mutx_CondDelete</a>(pSemaphore_a-&gt;pNonZero);    <a href="mutx_Delete.FIND-FUNC">mutx_Delete</a>(pSemaphore_a-&gt;pMutex);    <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(<a href="DMEM_STD_SEGMENT.FIND-DEF">DMEM_STD_SEGMENT</a>, (<i>crtx_Void_t</i>*)pSemaphore_a,               <i>sizeof</i>(<i>semt_Semaphore_t</i>));    <b>return</b>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* increment semaphore */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="semt_Post">semt_Post</a></font></b>(<i>semt_Semaphore_t</i> *pSemaphore_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <font color="#6920ac">/* None */</font><font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <a href="mutx_Lock.FIND-FUNC">mutx_Lock</a>(pSemaphore_a-&gt;pMutex);    <b>if</b> (pSemaphore_a-&gt;Value &lt; pSemaphore_a-&gt;MaxValue) {        pSemaphore_a-&gt;Value++;        <a href="mutx_Signal.FIND-FUNC">mutx_Signal</a>(pSemaphore_a-&gt;pNonZero);    }    <a href="mutx_Unlock.FIND-FUNC">mutx_Unlock</a>(pSemaphore_a-&gt;pMutex);    <b>return</b>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* wait on a semaphore (with timeout) */</font><font size="+1"><i>crtx_Boolean_t</i> <b><font color="azure1"><a name="semt_Wait">semt_Wait</a></font></b>(    <i>semt_Semaphore_t</i> *pSemaphore_a,    <i>tick_Timeout_t</i> *pTimeout_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <font color="#6920ac">/* None */</font><font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <a href="mutx_Lock.FIND-FUNC">mutx_Lock</a>(pSemaphore_a-&gt;pMutex);    <b>while</b> (pSemaphore_a-&gt;Value == 0)    {        <b>if</b> (!<a href="mutx_Wait.FIND-FUNC">mutx_Wait</a>(pSemaphore_a-&gt;pNonZero, pTimeout_a))        {            <a href="CRTX_EXCEPTION.FIND-DEF">CRTX_EXCEPTION</a> Timeout_Exc;        }    }    pSemaphore_a-&gt;Value--;    <a href="mutx_Unlock.FIND-FUNC">mutx_Unlock</a>(pSemaphore_a-&gt;pMutex);    <b>return</b> <a href="CRTX_TRUE.FIND-DEF">CRTX_TRUE</a>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font><font color="blue">Timeout_Exc:</font>    <a href="mutx_Unlock.FIND-FUNC">mutx_Unlock</a>(pSemaphore_a-&gt;pMutex);    <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>;}<font color="#6920ac">/* try to decrement semaphore */</font><font size="+1"><i>crtx_Boolean_t</i> <b><font color="azure1"><a name="semt_Try">semt_Try</a></font></b>(<i>semt_Semaphore_t</i> *pSemaphore_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <i>tick_Timeout_t</i> Timeout;<font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    Timeout = 0;    <b>return</b> <a href="#semt_Wait">semt_Wait</a>(pSemaphore_a, &amp;Timeout);<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>

⌨️ 快捷键说明

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