tms320c3.c

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

        <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">/* 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>

<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>

    <a href="hrdi_SetLisrIntrMask.FIND-FUNC">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);
    }

    <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       __attribute__((__unused__))
)
{</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*2) = 0x60000000ul + 
            ((<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       __attribute__((__unused__))
)
{</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*2) = 0x62000000ul + 
            (<i>crtx_Uint32_t</i>)&amp;hrdi_Dispatcher;
    }<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">/* register isr dispatcher */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_RegisterDispatcher">hrdi_RegisterDispatcher</a></font></b>
(
    <i>hrdi_ISRCB_t</i> *pLisr_a       __attribute__((__unused__))
)
{</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>(pLisr_a)
<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> HRDI_SCNDRY_INTR_TBL_IN_RAM == 1</font>
    <b>if</b> (pLisr_a-&gt;Attr.Dispatcher)
    {
        *(pBase+pLisr_a-&gt;Vector*2) = 0x62000000ul + 
            ((<i>crtx_Uint32_t</i>)pLisr_a-&gt;Attr.Dispatcher &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 isr dispatcher */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="hrdi_UnregisterDispatcher">hrdi_UnregisterDispatcher</a></font></b>
(
    <i>hrdi_ISRCB_t</i> *pLisr_a       __attribute__((__unused__))
)
{</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>(pLisr_a)
<b><font color='DarkGreen'>
#if</font></b><font color="maroon"> HRDI_SCNDRY_INTR_TBL_IN_RAM == 1</font>
    <b>if</b> (pLisr_a-&gt;Attr.Dispatcher)
    {
        *(pBase+pLisr_a-&gt;Vector*2) = 0x62000000ul + 
            (<i>crtx_Uint32_t</i>)&amp;hrdi_Dispatcher;
    }<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">/* Initialise HISR stack frame. CPU specific implementation */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="sfti_MakeHisrStackFrame">sfti_MakeHisrStackFrame</a></font></b>(<i>sfti_ISRCB_t</i> *pHisr_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>(pHisr_a)

    <b>if</b> ((pHisr_a-&gt;Attr.pStack != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) &amp;&amp; 
        pHisr_a-&gt;Attr.StackSize &gt; <a href="SFTI_MIN_STACK_SIZE.FIND-DEF">SFTI_MIN_STACK_SIZE</a>)
    {
        pStack = (<i>crtx_Void_t</i>**)pHisr_a-&gt;Attr.pStack;
        pHisr_a-&gt;pStackBase = (<i>crtx_Uint32_t</i>*)pStack;
        pHisr_a-&gt;pStackTop  = (<i>crtx_Uint32_t</i>*)pStack+pHisr_a-&gt;Attr.StackSize-1;
        *pHisr_a-&gt;pStackTop = <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_STACK_STAMP</a>;         <font color="#6920ac">/* STACK STAMP */</font>
        *pHisr_a-&gt;pStackBase = <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_STACK_STAMP</a>;        <font color="#6920ac">/* STACK STAMP */</font>
        *(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*)pHisr_a-&gt;pArg1;     /* argument 1 */
        *(pStack+3) = (crtx_Void_t*)pHisr_a-&gt;pArg0;     /* argument 0 */
        *(pStack+5) = (crtx_Void_t*)pHisr_a-&gt;Handler;   /* LISR handler */
#endif</font> <font color="#6920ac">/* 0 */</font>
                                        <font color="#6920ac">/* routine to switch stack back */</font>
        *(pStack+4) = (<i>crtx_Void_t</i>*)sfti_RestoreStack;  
        pHisr_a-&gt;pSP = (<i>crtx_Void_t</i>*)(pStack+5);
        <font color="#6920ac">/* individual stack required */</font>
        pHisr_a-&gt;Flags |= <a href="SFTI_FLAG_SWITCH_STACK.FIND-DEF">SFTI_FLAG_SWITCH_STACK</a>;
    }
    <b>else</b>
    {
        pHisr_a-&gt;pSP = <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>;       <font color="#6920ac">/* perform no stack switch */</font>
        pHisr_a-&gt;pStackTop = pHisr_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 HISR-stack immediately before switching to HISR */</font>
<font color="#6920ac">/* FIX ME: must be inline */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="sfti_PrepareStack">sfti_PrepareStack</a></font></b>(<i>sfti_ISRCB_t</i> *pHisr_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>(pHisr_a)

    pStack = (<i>crtx_Void_t</i>**)pHisr_a-&gt;pStackBase;
    *(pStack+2) = (<i>crtx_Void_t</i>*)pHisr_a-&gt;pArg1;     <font color="#6920ac">/* argument 1 */</font>
    *(pStack+3) = (<i>crtx_Void_t</i>*)pHisr_a-&gt;pArg0;     <font color="#6920ac">/* argument 0 */</font>
    *(pStack+4) = (<i>crtx_Void_t</i>*)sfti_RestoreStack;  <font color="#6920ac">/* restire stack */</font>
    *(pStack+5) = (<i>crtx_Void_t</i>*)pHisr_a-&gt;Handler;   <font color="#6920ac">/* HISR handler */</font>

    <b>return</b>;

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

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

<font color="#6920ac">/* Check HISR stack frame. CPU specific */</font><font size="+1">
<i>crtx_Bool_t</i> <b><font color="azure1"><a name="sfti_CheckStack">sfti_CheckStack</a></font></b>(<i>sfti_ISRCB_t</i> *pHisr_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>(pHisr_a)

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

    pStack = (<i>crtx_Void_t</i>**)pHisr_a-&gt;pStackBase;

    <b>if</b> ((*pHisr_a-&gt;pStackBase != <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_STACK_STAMP</a>) ||
        (*pHisr_a-&gt;pStackTop  != <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_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) != pHisr_a-&gt;pArg1) || (*(pStack+3) != pHisr_a-&gt;pArg0))
        return CRTX_FALSE;      /* incorrect arguments */
    if (*(pStack+5) != (crtx_Void_t*)pHisr_a-&gt;Handler)
        return CRTX_FALSE;      /* incorrect handler */
#endif</font> <font color="#6920ac">/* 0 */</font>
    <b>if</b> (pHisr_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">/* Initialise thread stack frame. CPU specific implementation */</font><font size="+1">
<i>crtx_Void_t</i> <b><font color="azure1"><a name="thrd_MakeThreadStackFrame">thrd_MakeThreadStackFrame</a></font></b>(<i>thrd_TCB_t</i> *pTCB_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>    i;
    <a href="CRTX_REG_3.FIND-DEF">CRTX_REG_3</a> <i>crtx_Uint32_t</i> *pPtr;