📄 h8300h.c
字号:
* 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->Handler) { *(pBase+pDisr_a->Vector) = 0x5e000000ul + (<i>crtx_Uint32_t</i>)&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){</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->Attr.Dispatcher) { *(pBase+pLisr_a->Vector) = 0x5e000000ul + ((<i>crtx_Uint32_t</i>)pLisr_a->Attr.Dispatcher & 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){</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->Attr.Dispatcher) { *(pBase+pLisr_a->Vector) = 0x5e000000ul + (<i>crtx_Uint32_t</i>)&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; <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>(pHisr_a) <b>if</b> ((pHisr_a->Attr.pStack != <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>) && pHisr_a->Attr.StackSize > (<i>crtx_Int_t</i>)<a href="SFTI_MIN_STACK_SIZE.FIND-DEF">SFTI_MIN_STACK_SIZE</a>) { <font color="#6920ac">/* Adjust beginning of the stack */</font> StartAdjust = (<i>crtx_Int_t</i>)pHisr_a->Attr.pStack & 3; <b>if</b> (StartAdjust) StartAdjust = 4 - StartAdjust; <font color="#6920ac">/* Adjust stack size */</font> StackSize = (pHisr_a->Attr.StackSize & ~3) - StartAdjust; <font color="#6920ac">/* Adjust stack address */</font> pHisr_a->pStackBase = (<i>crtx_Uint32_t</i>*) (((<i>crtx_Uint32_t</i>)pHisr_a->Attr.pStack + 3) & ~3ul); pHisr_a->pStackTop = (<i>crtx_Uint32_t</i>*) ((<i>crtx_Byte_t</i>*)pHisr_a->pStackBase + StackSize - <i>sizeof</i>(<i>crtx_Uint32_t</i>*)); *pHisr_a->pStackTop = <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_STACK_STAMP</a>; <font color="#6920ac">/* STACK STAMP */</font> *pHisr_a->pStackBase = <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_STACK_STAMP</a>; <font color="#6920ac">/* STACK STAMP */</font> pStack = (<i>crtx_Void_t</i>**)pHisr_a->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*)pHisr_a->pArg1; /* argument 1 */ *(pStack-3) = (crtx_Void_t*)pHisr_a->pArg0; /* argument 0 */ *(pStack-5) = (crtx_Void_t*)pHisr_a->Handler; /* HISR handler */#endif</font> <font color="#6920ac">/* 0 */</font> *(pStack-4) = (<i>crtx_Void_t</i>*)sfti_RestoreStack; <font color="#6920ac">/* restore stack */</font> pHisr_a->pSP = (<i>crtx_Void_t</i>*)(pStack-5); <font color="#6920ac">/* individual stack required */</font> pHisr_a->Flags |= <a href="SFTI_FLAG_SWITCH_STACK.FIND-DEF">SFTI_FLAG_SWITCH_STACK</a>; } <b>else</b> { pHisr_a->pSP = <a href="CRTX_NULL.FIND-DEF">CRTX_NULL</a>; <font color="#6920ac">/* perform no stack switch */</font> pHisr_a->pStackTop = pHisr_a->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->pStackTop; *(pStack-2) = (<i>crtx_Void_t</i>*)pHisr_a->pArg1; <font color="#6920ac">/* argument 1 */</font> *(pStack-3) = (<i>crtx_Void_t</i>*)pHisr_a->pArg0; <font color="#6920ac">/* argument 0 */</font> *(pStack-5) = (<i>crtx_Void_t</i>*)pHisr_a->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 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->Flags & <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->pStackTop; <b>if</b> ((*pHisr_a->pStackBase != <a href="SFTI_STACK_STAMP.FIND-DEF">SFTI_STACK_STAMP</a>) || (*pHisr_a->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->pArg1) || (*(pStack-3) != pHisr_a->pArg0)) return CRTX_FALSE; /* incorrect arguments */ if (*(pStack-5) != (crtx_Void_t*)pHisr_a->Handler) return CRTX_FALSE; /* incorrect handler */#endif</font> <font color="#6920ac">/* 0 */</font> <b>if</b> (pHisr_a->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 HISR 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> StackSize; <a href="CRTX_REG_3.FIND-DEF">CRTX_REG_3</a> <i>crtx_Int_t</i> StartAdjust; <a href="CRTX_REG_4.FIND-DEF">CRTX_REG_4</a> <i>crtx_Int_t</i> i; <a href="CRTX_REG_4.FIND-DEF">CRTX_REG_4</a> <i>crtx_Uint32_t</i> *pPtr;<font color="#6920ac">/********************* * PROCEDURE LOGIC * *********************/</font> <a href="CRTX_ASSERT.FIND-DEF">CRTX_ASSERT</a>(pTCB_a) <font color="#6920ac">/* Adjust beginning of the stack */</font> StartAdjust = (<i>crtx_Int_t</i>)pTCB_a->pStack & 3; <b>if</b> (StartAdjust) StartAdjust = 4 - StartAdjust; <font color="#6920ac">/* Adjust stack size */</font> StackSize = (pTCB_a->StackSize & ~3) - StartAdjust; <font color="#6920ac">/* Adjust stack address */</font> pTCB_a->pStackBase = (<i>crtx_Uint32_t</i>*) (((<i>crtx_Uint32_t</i>)pTCB_a->pStack + 3) & ~3ul); pTCB_a->pStackTop = (<i>crtx_Uint32_t</i>*) ((<i>crtx_Byte_t</i>*)pTCB_a->pStackBase + StackSize - <i>sizeof</i>(<i>crtx_Uint32_t</i>*)); <font color="#6920ac">/* initialise stack with predefined pattern */</font> <b>for</b> (pPtr = pTCB_a->pStackBase; pPtr < pTCB_a->pStackTop; pPtr++) *pPtr = <a href="THRD_STACK_PATTERN.FIND-DEF">THRD_STACK_PATTERN</a>; *pTCB_a->pStackTop = <a href="THRD_STACK_STAMP.FIND-DEF">THRD_STACK_STAMP</a>; <font color="#6920ac">/* STACK STAMP */</font> *pTCB_a->pStackBase = <a href="THRD_STACK_STAMP.FIND-DEF">THRD_STACK_⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -