mnt_core.c

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

C
294
字号
<HTML><HEAD><TITLE>/home/asysweb/public_html/cortex/kernel/src/mnt_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><font color="#6920ac">/************************************************************************* * * FILE NAME * *      mnt_core.c * * SYSTEM COMPONENT * *      Monitor Compenent (MNTR) * * DESCRIPTION * *      This file contains all core services for Monitors * * SERVICES * *      mntr_Create *      mntr_Delete *      mntr_Enter *      mntr_Exit * * SCCS HISTORY * *      @(#)mnt_core.c  1.8, 12/22/99, 16:01:07 * * AUTHOR * *      Vadim N. Azarovsky * * CREATED * *      24-Apr-1998         by Vadim N. Azarovsky * * REVISION HISTORY * *      NAME                DATE                    REMARKS * **************************************************************************/</font><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="swi_priv.h.FIND-INC"><font color="blue">"swi_priv.h"</font></a><b><font color='DarkGreen'>#include</font></b> <a href="ass_defs.h.FIND-INC"><font color="blue">"ass_defs.h"</font></a><font color="#6920ac">/* create monitor */</font><font size="+1"><i>mntr_Monitor_t</i> *<b><font color="azure1"><a name="mntr_Create">mntr_Create</a></font></b>(    <i>mntr_Monitor_t</i>  *pMonitor_a,     <i>mntr_Attr_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>(mntr_Initialised_g)    <b>if</b> (pAttr_a == <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)        pAttr_a = &amp;mntr_AttrDefault_g;    <b>if</b> (pMonitor_a != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)    {        <font color="#6920ac">/* initialise monitor control block */</font>        pMonitor_a-&gt;Flags = <a href="MNTR_FLAG_INIT.FIND-DEF">MNTR_FLAG_INIT</a>;    }    <b>else</b>    {        <b>if</b> ((pAttr_a-&gt;DeviceFlag==<a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) || (pAttr_a-&gt;DisableMask==0))        {            <font color="#6920ac">/* use global monitor for all non-device monitors */</font>            <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="MNTR_CHECK_MONITOR_ID.FIND-DEF">MNTR_CHECK_MONITOR_ID</a>(&amp;mntr_Monitor_g))            <b>return</b> &amp;mntr_Monitor_g;        }        <font color="#6920ac">/* device monitor shall be allocated */</font>        pMonitor_a = (<i>mntr_Monitor_t</i>*)<a href="dmem_Alloc.FIND-FUNC">dmem_Alloc</a>(pAttr_a-&gt;Segment,                                                 <i>sizeof</i>(<i>mntr_Monitor_t</i>),                                                 <i>sizeof</i>(<i>crtx_Unsigned_t</i>));        <b>if</b> ((<i>crtx_Void_t</i>*)pMonitor_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;        }        pMonitor_a-&gt;Segment = pAttr_a-&gt;Segment;        pMonitor_a-&gt;Flags = <a href="MNTR_FLAG_INIT.FIND-DEF">MNTR_FLAG_INIT</a> | <a href="MNTR_FLAG_MONITOR_ALLOC.FIND-DEF">MNTR_FLAG_MONITOR_ALLOC</a>;    }    pMonitor_a-&gt;EnableMask = 0;    <b>if</b> (pAttr_a-&gt;DeviceFlag)    {        pMonitor_a-&gt;DisableMask = pAttr_a-&gt;DisableMask;    }    <b>else</b>    {        pMonitor_a-&gt;DisableMask = 0;    }<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>    <a href="MNTR_SET_MONITOR_ID.FIND-DEF">MNTR_SET_MONITOR_ID</a>(pMonitor_a);    pMonitor_a-&gt;EntryCntr = 0;<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> pMonitor_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 monitor */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="mntr_Delete">mntr_Delete</a></font></b>(    <i>mntr_Monitor_t</i> *pMonitor_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>(mntr_Initialised_g)    <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> (pMonitor_a == &amp;mntr_Monitor_g)        <b>return</b>;    <b>if</b> (pMonitor_a-&gt;Flags &amp; <a href="MNTR_FLAG_MONITOR_ALLOC.FIND-DEF">MNTR_FLAG_MONITOR_ALLOC</a>)    {        <font color="#6920ac">/* release internaly allocated control block */</font>        <a href="dmem_Free.FIND-FUNC">dmem_Free</a>(pMonitor_a-&gt;Segment, (<i>crtx_Void_t</i>*)pMonitor_a,                  <i>sizeof</i>(<i>mntr_Monitor_t</i>));    }    <b>else</b>    {        pMonitor_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>(pMonitor_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>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* enter monitor */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="mntr_Enter">mntr_Enter</a></font></b>(    <i>mntr_Monitor_t</i> *pMonitor_a){</font><font color="#6920ac">/********************* *  LOCAL VARIABLES  * *********************/</font>    <i>crtx_Mask_t</i> OldMask;<font color="#6920ac">/********************* *  PROCEDURE LOGIC  * *********************/</font>    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(mntr_Initialised_g)    <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> (pMonitor_a-&gt;DisableMask == 0)    {        <font color="#6920ac">/* entering non-device monitor */</font>        <font color="#6920ac">/* disable thread preemption */</font>        <a href="thrd_Disable.FIND-FUNC">thrd_Disable</a>();     }    <b>else</b>    {        <font color="#6920ac">/* entering device monitor */</font>        <font color="#6920ac">/* disable thread preemption */</font>        <a href="thrd_Disable.FIND-FUNC">thrd_Disable</a>();         <font color="#6920ac">/* disable specified software interrupt sources */</font>        OldMask = <a href="sfti_Disable.FIND-FUNC">sfti_Disable</a>(pMonitor_a-&gt;DisableMask);<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>        <font color="#6920ac">/* increment entry counter */</font>        pMonitor_a-&gt;EntryCntr++;        <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pMonitor_a-&gt;EntryCntr==1)<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>        <font color="#6920ac">/* save old software interrupt mask */</font>        pMonitor_a-&gt;EnableMask = OldMask;    }    <b>return</b>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}<font color="#6920ac">/* exit monitor */</font><font size="+1"><i>crtx_Void_t</i> <b><font color="azure1"><a name="mntr_Exit">mntr_Exit</a></font></b>(    <i>mntr_Monitor_t</i> *pMonitor_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>(mntr_Initialised_g)    <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> (pMonitor_a-&gt;DisableMask == 0)    {        <font color="#6920ac">/* exiting non-device monitor */</font>        <font color="#6920ac">/* enable task preemption */</font>        <a href="thrd_Enable.FIND-FUNC">thrd_Enable</a>();    }    <b>else</b>    {        <font color="#6920ac">/* disable global software interrupts flag */</font>        <a href="sfti_GlobalForbid.FIND-FUNC">sfti_GlobalForbid</a>();        <font color="#6920ac">/* exiting device monitor */</font><b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>        <font color="#6920ac">/* increment entry counter */</font>        pMonitor_a-&gt;EntryCntr--;        <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pMonitor_a-&gt;EntryCntr==0)<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>        <font color="#6920ac">/* restore software interrupts (can use a macro because global software         * interrupts are disabled) */</font>        <a href="SFTI_ENABLE.FIND-DEF">SFTI_ENABLE</a>(pMonitor_a-&gt;EnableMask);        <font color="#6920ac">/* enable task preemption (can use a macro because global software         * interrupts are disabled) */</font>        <a href="THRD_ENABLE.FIND-DEF">THRD_ENABLE</a>();        <font color="#6920ac">/* enable global interrupts flag */</font>        <a href="sfti_GlobalPermit.FIND-FUNC">sfti_GlobalPermit</a>();    }    <b>return</b>;<font color="#6920ac">/************************ *  EXCEPTION HANDLING  * ************************/</font>    <font color="#6920ac">/* None */</font>}</pre></BODY></HTML>

⌨️ 快捷键说明

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