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 = &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->Flags = <a href="MNTR_FLAG_INIT.FIND-DEF">MNTR_FLAG_INIT</a>; } <b>else</b> { <b>if</b> ((pAttr_a->DeviceFlag==<a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>) || (pAttr_a->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>(&mntr_Monitor_g)) <b>return</b> &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->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->Segment = pAttr_a->Segment; pMonitor_a->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->EnableMask = 0; <b>if</b> (pAttr_a->DeviceFlag) { pMonitor_a->DisableMask = pAttr_a->DisableMask; } <b>else</b> { pMonitor_a->DisableMask = 0; }<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL > 0</font> <a href="MNTR_SET_MONITOR_ID.FIND-DEF">MNTR_SET_MONITOR_ID</a>(pMonitor_a); pMonitor_a->EntryCntr = 0;<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL > 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 == &mntr_Monitor_g) <b>return</b>; <b>if</b> (pMonitor_a->Flags & <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->Segment, (<i>crtx_Void_t</i>*)pMonitor_a, <i>sizeof</i>(<i>mntr_Monitor_t</i>)); } <b>else</b> { pMonitor_a->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 > 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 > 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->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->DisableMask);<b><font color='DarkGreen'>#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL > 0</font> <font color="#6920ac">/* increment entry counter */</font> pMonitor_a->EntryCntr++; <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pMonitor_a->EntryCntr==1)<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL > 0 */</font></font> <font color="#6920ac">/* save old software interrupt mask */</font> pMonitor_a->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->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 > 0</font> <font color="#6920ac">/* increment entry counter */</font> pMonitor_a->EntryCntr--; <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pMonitor_a->EntryCntr==0)<b><font color='DarkGreen'>#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL > 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->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 + -
显示快捷键?