h8300h.c

澳洲人写的Cortex,包括uC_IP协议栈

    Mask_a &amp;= hrdi_Environ_g.Defined;   <font color="#6920ac">/* mask out not registerd vectors */</font>

    hrdi_Environ_g.Enabled |= Mask_a;   <font color="#6920ac">/* enable interrupts */</font>

    <a href="H83H_IER.FIND-DEF">H83H_IER</a> |= (<i>crtx_Byte_t</i>)(Mask_a &amp; 0xFF);

    <b>return</b>;

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

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

<font color="#6920ac">/* Initialise LISR stack frame. CPU specific implementation */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_MakeLisrStackFrame">hrdi_MakeLisrStackFrame</a></font></b>(<i>hrdi_ISRCB_t</i> *pLisr_a)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a> <i>crtx_Void_t</i>  **pStack;
    <a href="CRTX_REG_2.FIND-DEF">CRTX_REG_2</a> <i>crtx_Int_t</i>   StackSize;
    <a href="CRTX_REG_3.FIND-DEF">CRTX_REG_3</a> <i>crtx_Int_t</i>   StartAdjust;

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

    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLisr_a)

    <b>if</b> ((pLisr_a-&gt;Attr.pStack != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) &amp;&amp; 
        pLisr_a-&gt;Attr.StackSize &gt; (<i>crtx_Int_t</i>)<a href="HRDI_MIN_STACK_SIZE.FIND-DEF">HRDI_MIN_STACK_SIZE</a>)
    {
        <font color="#6920ac">/* Adjust beginning of the stack */</font>
        StartAdjust = (<i>crtx_Int_t</i>)pLisr_a-&gt;Attr.pStack &amp; 3;
        <b>if</b> (StartAdjust)
            StartAdjust = 4 - StartAdjust;
        <font color="#6920ac">/* Adjust stack size */</font>
        StackSize = (pLisr_a-&gt;Attr.StackSize &amp; ~3) - StartAdjust;
        <font color="#6920ac">/* Adjust stack address */</font>
        pLisr_a-&gt;pStackBase = (<i>crtx_Uint32_t</i>*)
            (((<i>crtx_Uint32_t</i>)pLisr_a-&gt;Attr.pStack + 3) &amp; ~3ul);
        pLisr_a-&gt;pStackTop = (<i>crtx_Uint32_t</i>*)
            ((<i>crtx_Byte_t</i>*)pLisr_a-&gt;pStackBase + StackSize - 
             <i>sizeof</i>(<i>crtx_Uint32_t</i>*));
        *pLisr_a-&gt;pStackTop  = <a href="HRDI_STACK_STAMP.FIND-DEF">HRDI_STACK_STAMP</a>;        <font color="#6920ac">/* STACK STAMP */</font>
        *pLisr_a-&gt;pStackBase = <a href="HRDI_STACK_STAMP.FIND-DEF">HRDI_STACK_STAMP</a>;        <font color="#6920ac">/* STACK STAMP */</font>
        pStack = (<i>crtx_Void_t</i>**)pLisr_a-&gt;pStackTop;
        *(pStack-1) = (<i>crtx_Void_t</i>*)<a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;          <font color="#6920ac">/* Old SP */</font>
<font color="#6920ac">#if 0
        *(pStack-2) = (crtx_Void_t*)pLisr_a-&gt;pArg1;     /* argument 1 */
        *(pStack-3) = (crtx_Void_t*)pLisr_a-&gt;pArg0;     /* argument 0 */
        *(pStack-5) = (crtx_Void_t*)pLisr_a-&gt;Handler;   /* LISR handler */
#endif</font> <font color="#6920ac">/* 0 */</font>
        *(pStack-4) = (<i>crtx_Void_t</i>*)hrdi_RestoreStack;  <font color="#6920ac">/* restore stack */</font>

        pLisr_a-&gt;pSP = (<i>crtx_Void_t</i>*)(pStack-5);
        <font color="#6920ac">/* individual stack required */</font>
        pLisr_a-&gt;Flags |= <a href="HRDI_FLAG_SWITCH_STACK.FIND-DEF">HRDI_FLAG_SWITCH_STACK</a>;
    }
    <b>else</b>
    {
        pLisr_a-&gt;pSP = <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;       <font color="#6920ac">/* perform no stack switch */</font>
        pLisr_a-&gt;pStackTop = pLisr_a-&gt;pStackBase = <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;
    }

    <b>return</b>;

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

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

<font color="#6920ac">/* prepare LISR-stack immediately before switching to LISR */</font>
<font color="#6920ac">/* FIX ME: must be inline */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_PrepareStack">hrdi_PrepareStack</a></font></b>(<i>hrdi_ISRCB_t</i> *pLisr_a)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a> <i>crtx_Void_t</i>  **pStack;

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

    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLisr_a)

    pStack = (<i>crtx_Void_t</i>**)pLisr_a-&gt;pStackTop;
    *(pStack-2) = (<i>crtx_Void_t</i>*)pLisr_a-&gt;pArg1;     <font color="#6920ac">/* argument 1 */</font>
    *(pStack-3) = (<i>crtx_Void_t</i>*)pLisr_a-&gt;pArg0;     <font color="#6920ac">/* argument 0 */</font>
    *(pStack-5) = (<i>crtx_Void_t</i>*)pLisr_a-&gt;Handler;   <font color="#6920ac">/* LISR handler */</font>

    <b>return</b>;

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

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

<font color="#6920ac">/* Check LISR stack frame. CPU specific */</font><font size="+1">
<i>crtx_Bool_t</i> <b><font color="azure1"><a name="hrdi_CheckStack">hrdi_CheckStack</a></font></b>(<i>hrdi_ISRCB_t</i> *pLisr_a)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a> <i>crtx_Void_t</i>  **pStack;

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

    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLisr_a)

    <b>if</b> (!(pLisr_a-&gt;Flags &amp; <a href="HRDI_FLAG_SWITCH_STACK.FIND-DEF">HRDI_FLAG_SWITCH_STACK</a>))
        <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>;

    pStack = (<i>crtx_Void_t</i>**)pLisr_a-&gt;pStackTop;

    <b>if</b> ((*pLisr_a-&gt;pStackBase != <a href="HRDI_STACK_STAMP.FIND-DEF">HRDI_STACK_STAMP</a>) ||
        (*pLisr_a-&gt;pStackTop  != <a href="HRDI_STACK_STAMP.FIND-DEF">HRDI_STACK_STAMP</a>))
        <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>;      <font color="#6920ac">/* STACK STAMPS corrupted */</font>
<font color="#6920ac">#if 0
    if ((*(pStack-2) != pLisr_a-&gt;pArg1) || (*(pStack-3) != pLisr_a-&gt;pArg0))
        return CRTX_FALSE;      /* incorrect arguments */
    if (*(pStack-5) != (crtx_Void_t*)pLisr_a-&gt;Handler)
        return CRTX_FALSE;      /* incorrect handler */
#endif</font> <font color="#6920ac">/* 0 */</font>
    <b>if</b> (pLisr_a-&gt;pSP != (<i>crtx_Void_t</i>*)(pStack-5))
        <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>;      <font color="#6920ac">/* incorrect stack pointer */</font>
    
    <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">/* check for nested interrupts */</font>
<i>extern</i> <i>long</i> hrdi_Nested;<font size="+1">
<i>crtx_Boolean_t</i> <b><font color="azure1"><a name="hrdi_IsNested">hrdi_IsNested</a></font></b>(<i>crtx_Void_t</i>)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

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

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

<font color="#6920ac">#if 0
    if (hrdi_Nested != 0)
        return CRTX_TRUE;
    else
#endif</font>
        <b>return</b> <a href="CRTX_FALSE.FIND-DEF">CRTX_FALSE</a>;      <font color="#6920ac">/* hrdi_Dispatcher checks for nested 
                                 * interrupts */</font>

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

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

<font color="#6920ac">/* hardware isr shell */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_Shell">hrdi_Shell</a></font></b>
(
    <i>hrdi_Vector_t</i> Vector_a
)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <a href="CRTX_REG_1.FIND-DEF">CRTX_REG_1</a>  <i>hrdi_ISRCB_t</i>    *pLisr;     <font color="#6920ac">/* ISR control block */</font>
    <a href="CRTX_REG_2.FIND-DEF">CRTX_REG_2</a>  <i>hrdi_Mask_t</i>     OldMask;    <font color="#6920ac">/* old interrupt mask */</font>

<font color="#6920ac">/*********************
 *  PROCEDURE LOGIC  *
 *********************/</font>
<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> (HRDI_INTR_VECTORS != HRDI_NUM_LISR)</font>
    pLisr = &amp;hrdi_LISRs_g[hrdi_RegVectorsTab_g[Vector_a]];<b><font color='DarkGreen'>
#else</font></b><font color="maroon"></font>
    pLisr = &amp;hrdi_LISRs_g[Vector_a];<b><font color='DarkGreen'>
#endif</font></b><font color="maroon"> <font color="#6920ac">/* (HRDI_INTR_VECTORS != HRDI_NUM_LISR) */</font></font>

    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pLisr-&gt;Handler)
<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> ENVI_CRTX_ERR_CHECK_LEVEL &gt; 1</font>
    pLisr-&gt;IntrCntr++;<b><font color='DarkGreen'>
#endif</font></b><font color="maroon"> <font color="#6920ac">/* ENVI_CRTX_ERR_CHECK_LEVEL &gt; 1 */</font></font>

    OldMask = <a href="#hrdi_SetLisrIntrMask">hrdi_SetLisrIntrMask</a>(pLisr-&gt;Attr.Mask);

    <b>if</b> (pLisr-&gt;pSP != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>)
    {
        <a href="#hrdi_PrepareStack">hrdi_PrepareStack</a>(pLisr);
        <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(<a href="#hrdi_CheckStack">hrdi_CheckStack</a>(pLisr))
        <font color="#6920ac">/* switch to LISR stack and execute handler */</font>
        <a href="hrdi_SwitchStack.FIND-FUNC">hrdi_SwitchStack</a>(pLisr-&gt;pSP);
        <font color="#6920ac">/* return here after LISR completion (within original stack) */</font>
    }
    <b>else</b>
    {
        <font color="#6920ac">/* execute LISR */</font>
        pLisr-&gt;<a href="Handler.FIND-FUNC">Handler</a>(pLisr-&gt;pArg0, pLisr-&gt;pArg1);
    }

    <a href="#hrdi_RestoreLisrIntrMask">hrdi_RestoreLisrIntrMask</a>(OldMask);      <font color="#6920ac">/* restore interrutps */</font>

    <b>return</b>;

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

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

<font color="#6920ac">/* register direct isr */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_RegisterDISR">hrdi_RegisterDISR</a></font></b>
(
    <i>hrdi_ISRCB_t</i> *pDisr_a
)
{</font>
<font color="#6920ac">/*********************
 *  LOCAL VARIABLES  *
 *********************/</font>

    <i>crtx_Uint32_t</i>   *pBase = (<i>crtx_Uint32_t</i>*)hrdi_VectorBase_g;

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

    <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pDisr_a)
<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> HRDI_SCNDRY_INTR_TBL_IN_RAM == 1</font>
    <b>if</b> (pDisr_a-&gt;Handler)
    {
        *(pBase+pDisr_a-&gt;Vector) = 0x5a000000ul + 
            ((<i>crtx_Uint32_t</i>)pDisr_a-&gt;Handler &amp; 0x00fffffful);
    }<b><font color='DarkGreen'>
#endif</font></b><font color="maroon">  <font color="#6920ac">/* HRDI_SCNDRY_INTR_TBL_IN_RAM == 1 */</font></font>

    <b>return</b>;

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

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

<font color="#6920ac">/* unregister direct isr */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_UnregisterDISR">hrdi_UnregisterDISR</a></font></b>
(
    <i>hrdi_ISRCB_t</i> *pDisr_a
)
{</font>
<font color="#6920ac">/*********************