rrl_core.c

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

        pLock-&gt;Owner = <a href="thrd_SelfID.FIND-FUNC">thrd_SelfID</a>();
    }
    <b>else</b>
    {
        <font color="#6920ac">/* if here place is taken */</font>
        Myself = <a href="thrd_SelfID.FIND-FUNC">thrd_SelfID</a>();
        <b>if</b> (pLock-&gt;Owner == Myself)
        {
            <font color="#6920ac">/* lock has been reentered by the same task */</font>
            pLock-&gt;EntryCounter++;
        }
        <b>else</b>
        {
            <font color="#6920ac">/* other tasks are competing for the lock */</font>
            <a href="thrd_Protect.FIND-FUNC">thrd_Protect</a>();
            SuspendPolicy = <a href="RRLC_GET_SUSP_POLICY.FIND-DEF">RRLC_GET_SUSP_POLICY</a>(pLock);
            <b>if</b> (--pLock-&gt;Waiting &lt; 0)
            {
                <font color="#6920ac">/* suspend thread */</font><b><font color='DarkGreen'>
#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>
                <a href="RRLC_INIT_SUSPEND_BLOCK.FIND-DEF">RRLC_INIT_SUSPEND_BLOCK</a>(pLock, SuspendBlock, Myself);
                <a href="thrd_PreemptToBlocked.FIND-FUNC">thrd_PreemptToBlocked</a>(&amp;pLock-&gt;WaitingList,      <font color="#6920ac">/* queue */</font>
                                                                <font color="#6920ac">/* arg */</font>
                                      (<i>rque_Argument_t</i>)&amp;SuspendBlock,
                                      SuspendPolicy);           <font color="#6920ac">/* policy */</font><b><font color='DarkGreen'>
#else</font></b><font color="maroon"></font>
                <a href="thrd_PreemptToBlocked.FIND-FUNC">thrd_PreemptToBlocked</a>(&amp;pLock-&gt;WaitingList,      <font color="#6920ac">/* queue */</font>
                                      (<i>rque_Argument_t</i>)Myself,  <font color="#6920ac">/* arg */</font>
                                      SuspendPolicy);           <font color="#6920ac">/* policy */</font><b><font color='DarkGreen'>
#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>
            }
            pLock-&gt;EntryCounter = 1;
            pLock-&gt;Owner = Myself;
            <a href="thrd_Unprotect.FIND-FUNC">thrd_Unprotect</a>();
        }
    }

    <b>return</b>;

<font color="#6920ac">/************************
 *  EXCEPTION HANDLING  *
 ************************/</font>

    <font color="#6920ac">/* None */</font>
}

<font color="#6920ac">/* try to obtain lock */</font><font size="+1">
<i>crtx_Boolean_t</i> <b><font color="azure1"><a name="rrlc_Try">rrlc_Try</a></font></b>
(
    <i>rrlc_Lock_t</i> *pLock_a
)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a>  <i>rrlc_Lock_t</i> *pLock = pLock_a;
    <a href="CRTX_REG_2.FIND-DEF">CRTX_REG_2</a>  <i>thrd_ID_t</i>   Myself;

<font color="#6920ac">/*********************
 *  PROCEDURE LOGIC  *
 *********************/</font>


    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLock_a)
<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="RRLC_CHECK_LOCK_ID.FIND-DEF">RRLC_CHECK_LOCK_ID</a>(pLock_a))<b><font color='DarkGreen'>
#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>

    <b>if</b> (<a href="hrdi_Inc.FIND-FUNC">hrdi_Inc</a>(&amp;pLock-&gt;LockCounter) == 0)
    {
        <font color="#6920ac">/* if here lock is available. Grab it! */</font>
        pLock-&gt;EntryCounter = 1;
        pLock-&gt;Owner = <a href="thrd_SelfID.FIND-FUNC">thrd_SelfID</a>();
    }
    <b>else</b>
    {
        <font color="#6920ac">/* if here place is taken */</font>
        Myself = <a href="thrd_SelfID.FIND-FUNC">thrd_SelfID</a>();
        <b>if</b> (pLock-&gt;Owner == Myself)
        {
            <font color="#6920ac">/* lock has been reentered by the same task */</font>
            pLock-&gt;EntryCounter++;
        }
        <b>else</b>
        {
            <a href="thrd_Protect.FIND-FUNC">thrd_Protect</a>();
            <b>if</b> (--pLock-&gt;Waiting &lt; 0)
            {
                pLock-&gt;Waiting++;
                pLock-&gt;LockCounter--;
                <a href="thrd_Unprotect.FIND-FUNC">thrd_Unprotect</a>();
                <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>;
            }
            pLock-&gt;EntryCounter = 1;
            pLock-&gt;Owner = Myself;
            <a href="thrd_Unprotect.FIND-FUNC">thrd_Unprotect</a>();
        }
    }

    <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">/* relinquish lock */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="rrlc_Unlock">rrlc_Unlock</a></font></b>
(
    <i>rrlc_Lock_t</i> *pLock_a
)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a>  <i>rrlc_Lock_t</i> *pLock = pLock_a;
    <a href="CRTX_REG_2.FIND-DEF">CRTX_REG_2</a>  <i>thrd_ID_t</i>   Myself = <a href="thrd_SelfID.FIND-FUNC">thrd_SelfID</a>(); <font color="#6920ac">/* myself */</font>
    <a href="CRTX_REG_3.FIND-DEF">CRTX_REG_3</a>  <i>thrd_ID_t</i>   ResumeTask;             <font color="#6920ac">/* task to resume */</font>
    <a href="CRTX_REG_4.FIND-DEF">CRTX_REG_4</a>  <i>hrdi_GlobalIntrCookie_t</i> GlobalIntrCookie;<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>
    <i>rrlc_SuspendBlock_t</i>     *pSuspendBlock;<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">/*********************
 *  PROCEDURE LOGIC  *
 *********************/</font>

    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLock)
    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLock-&gt;Owner == Myself)
<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="RRLC_CHECK_LOCK_ID.FIND-DEF">RRLC_CHECK_LOCK_ID</a>(pLock))<b><font color='DarkGreen'>
#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0 */</font></font>

    <b>if</b> (pLock-&gt;Owner == Myself)
    {
        <b>if</b> (--pLock-&gt;EntryCounter != 0)
        {
            <font color="#6920ac">/* still keep a lock */</font>
            <a href="hrdi_Dec.FIND-FUNC">hrdi_Dec</a>(&amp;pLock-&gt;LockCounter);
        }
        <b>else</b>
        {
            <font color="#6920ac">/* release lock */</font>
            pLock-&gt;Owner = <a href="THRD_ILLEGAL_ID.FIND-DEF">THRD_ILLEGAL_ID</a>;
            GlobalIntrCookie = <a href="hrdi_GlobalIntrDisable.FIND-FUNC">hrdi_GlobalIntrDisable</a>();
            <b>if</b> (--pLock-&gt;LockCounter &gt;= 0)
            {
                <font color="#6920ac">/* there are competing tasks */</font>
                <a href="thrd_Protect.FIND-FUNC">thrd_Protect</a>();
                <a href="hrdi_GlobalIntrEnable.FIND-FUNC">hrdi_GlobalIntrEnable</a>(GlobalIntrCookie);
                <b>if</b> (pLock-&gt;Waiting++ &lt; 0)
                {
                    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(!<a href="RQUE_IS_EMPTY.FIND-DEF">RQUE_IS_EMPTY</a>(&amp;pLock-&gt;WaitingList))<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 0</font>
                    pSuspendBlock = (<i>rrlc_SuspendBlock_t</i>*)
                        <a href="RQUE_GET_TAIL_ARG.FIND-DEF">RQUE_GET_TAIL_ARG</a>(&amp;pLock-&gt;WaitingList);
                    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pSuspendBlock)
                    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="RRLC_CHECK_SUSPEND_BLOCK_ID.FIND-DEF">RRLC_CHECK_SUSPEND_BLOCK_ID</a>(pSuspendBlock))
                    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="RRLC_CHECK_LOCK_REF.FIND-DEF">RRLC_CHECK_LOCK_REF</a>(pSuspendBlock,pLock))
                    ResumeTask = pSuspendBlock-&gt;ThreadID;<b><font color='DarkGreen'>
#else</font></b><font color="maroon"></font>
                    ResumeTask = 
                        (<i>thrd_ID_t</i>)<a href="RQUE_GET_TAIL_ARG.FIND-DEF">RQUE_GET_TAIL_ARG</a>(&amp;pLock-&gt;WaitingList);<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>(ResumeTask);
                }
                <a href="thrd_Unprotect.FIND-FUNC">thrd_Unprotect</a>();
            }
            <b>else</b>
            {
                <a href="hrdi_GlobalIntrEnable.FIND-FUNC">hrdi_GlobalIntrEnable</a>(GlobalIntrCookie);
            }
        }
    }

    <b>return</b>;

<font color="#6920ac">/************************
 *  EXCEPTION HANDLING  *
 ************************/</font>

    <font color="#6920ac">/* None */</font>
}

</pre>
</BODY></HTML>