diff --git a/bsp/m16c62p/interrupts.asm b/bsp/m16c62p/interrupts.asm index 20340612e2..75e87ad874 100644 --- a/bsp/m16c62p/interrupts.asm +++ b/bsp/m16c62p/interrupts.asm @@ -15,55 +15,55 @@ * Toolchain : IAR's EW for M16C v3.401 */ - PUBLIC rt_hw_timer_handler - PUBLIC rt_hw_uart0_receive_handler + PUBLIC rt_hw_timer_handler + PUBLIC rt_hw_uart0_receive_handler - EXTERN rt_thread_switch_interrput_flag - EXTERN rt_interrupt_from_thread - EXTERN rt_interrupt_to_thread - EXTERN rt_interrupt_enter - EXTERN rt_interrupt_leave - EXTERN rt_tick_increase - EXTERN u0rec_handler + EXTERN rt_thread_switch_interrput_flag + EXTERN rt_interrupt_from_thread + EXTERN rt_interrupt_to_thread + EXTERN rt_interrupt_enter + EXTERN rt_interrupt_leave + EXTERN rt_tick_increase + EXTERN u0rec_handler - RSEG CSTACK - RSEG ISTACK - RSEG CODE:CODE:NOROOT(2) + RSEG CSTACK + RSEG ISTACK + RSEG CODE:CODE:NOROOT(2) rt_hw_context_switch_interrupt_do - MOV.W #0, rt_thread_switch_interrput_flag - MOV.W rt_interrupt_from_thread, A0 - STC ISP, [A0] + MOV.W #0, rt_thread_switch_interrput_flag + MOV.W rt_interrupt_from_thread, A0 + STC ISP, [A0] - MOV.W rt_interrupt_to_thread, A0 - LDC [A0], ISP - POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore all processor registers from the new task's stack + MOV.W rt_interrupt_to_thread, A0 + LDC [A0], ISP + POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore all processor registers from the new task's stack REIT .EVEN rt_hw_timer_handler: - PUSHM R0,R1,R2,R3,A0,A1,SB,FB ; Save current task's registers - JSR rt_interrupt_enter - JSR rt_tick_increase - JSR rt_interrupt_leave + PUSHM R0,R1,R2,R3,A0,A1,SB,FB ; Save current task's registers + JSR rt_interrupt_enter + JSR rt_tick_increase + JSR rt_interrupt_leave - CMP.W #1,rt_thread_switch_interrput_flag - JEQ rt_hw_context_switch_interrupt_do + CMP.W #1, rt_thread_switch_interrput_flag + JEQ rt_hw_context_switch_interrupt_do - POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore current task's registers - REIT ; Return from interrup + POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore current task's registers + REIT ; Return from interrup .EVEN rt_hw_uart0_receive_handler: - PUSHM R0,R1,R2,R3,A0,A1,SB,FB ; Save current task's registers - JSR rt_interrupt_enter - JSR u0rec_handler - JSR rt_interrupt_leave + PUSHM R0,R1,R2,R3,A0,A1,SB,FB ; Save current task's registers + JSR rt_interrupt_enter + JSR u0rec_handler + JSR rt_interrupt_leave - CMP.W #1, rt_thread_switch_interrput_flag - JEQ rt_hw_context_switch_interrupt_do + CMP.W #1, rt_thread_switch_interrput_flag + JEQ rt_hw_context_switch_interrupt_do - POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore current task's registers - REIT ; Return from interrup + POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore current task's registers + REIT ; Return from interrup - END + END diff --git a/libcpu/m16c/m16c62p/context_iar.S b/libcpu/m16c/m16c62p/context_iar.S index 29c8656ba7..f326817ffb 100644 --- a/libcpu/m16c/m16c62p/context_iar.S +++ b/libcpu/m16c/m16c62p/context_iar.S @@ -15,76 +15,70 @@ * * For : Renesas M16C * Toolchain : IAR's EW for M16C v3.401 -*/ + */ - RSEG CSTACK + RSEG CSTACK - RSEG ISTACK + RSEG ISTACK - RSEG CODE(1) + RSEG CODE(1) - EXTERN rt_thread_switch_interrput_flag - EXTERN rt_interrupt_from_thread - EXTERN rt_interrupt_to_thread + EXTERN rt_thread_switch_interrput_flag + EXTERN rt_interrupt_from_thread + EXTERN rt_interrupt_to_thread - PUBLIC rt_hw_interrupt_disable - PUBLIC rt_hw_interrupt_enable - PUBLIC rt_hw_context_switch_to - PUBLIC rt_hw_context_switch - PUBLIC rt_hw_context_switch_interrupt - PUBLIC os_context_switch + PUBLIC rt_hw_interrupt_disable + PUBLIC rt_hw_interrupt_enable + PUBLIC rt_hw_context_switch_to + PUBLIC rt_hw_context_switch + PUBLIC rt_hw_context_switch_interrupt + PUBLIC os_context_switch -rt_hw_interrupt_disable - STC FLG, R0 ;fify 20100419 - FCLR I +rt_hw_interrupt_disable: + STC FLG, R0 ;fify 20100419 + FCLR I RTS -rt_hw_interrupt_enable - LDC R0, FLG ;fify 20100419 +rt_hw_interrupt_enable: + LDC R0, FLG ;fify 20100419 RTS .EVEN os_context_switch: - PUSHM R0,R1,R2,R3,A0,A1,SB,FB - CMP.W #0,rt_thread_switch_interrput_flag - JEQ exit - MOV.W #0, rt_thread_switch_interrput_flag - MOV.W rt_interrupt_from_thread, A0 - STC ISP, [A0] - MOV.W rt_interrupt_to_thread, A0 - LDC [A0], ISP -exit - POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore registers from the new task's stack - REIT ; Return from interrup + PUSHM R0,R1,R2,R3,A0,A1,SB,FB + + MOV.W rt_interrupt_from_thread, A0 + STC ISP, [A0] + MOV.W rt_interrupt_to_thread, A0 + LDC [A0], ISP + + POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore registers from the new task's stack + REIT ; Return from interrup /* * void rt_hw_context_switch_to(rt_uint32 to); * r0 --> to * this fucntion is used to perform the first thread switch */ -rt_hw_context_switch_to - MOV.W R0, A0 - LDC [A0], ISP - POPM R0,R1,R2,R3,A0,A1,SB,FB +rt_hw_context_switch_to: + MOV.W R0, A0 + LDC [A0], ISP + POPM R0,R1,R2,R3,A0,A1,SB,FB REIT -rt_hw_context_switch - CMP.W #1,rt_thread_switch_interrput_flag - JEQ jump1 - MOV.W #1,rt_thread_switch_interrput_flag - MOV.W R0, rt_interrupt_from_thread -jump1 - MOV.W R1, rt_interrupt_to_thread - INT #0 +rt_hw_context_switch: + MOV.W R0, rt_interrupt_from_thread + MOV.W R1, rt_interrupt_to_thread + INT #0 ;software interrupt 0 RTS -rt_hw_context_switch_interrupt - CMP.W #1,rt_thread_switch_interrput_flag - JEQ jump - MOV.W #1,rt_thread_switch_interrput_flag - MOV.W R0, rt_interrupt_from_thread +rt_hw_context_switch_interrupt: + CMP.W #1, rt_thread_switch_interrput_flag + JEQ jump + MOV.W #1, rt_thread_switch_interrput_flag + MOV.W R0, rt_interrupt_from_thread jump - MOV.W R1, rt_interrupt_to_thread + MOV.W R1, rt_interrupt_to_thread RTS END diff --git a/libcpu/m16c/m16c62p/context_iar.asm b/libcpu/m16c/m16c62p/context_iar.asm index 52dea18cae..f326817ffb 100644 --- a/libcpu/m16c/m16c62p/context_iar.asm +++ b/libcpu/m16c/m16c62p/context_iar.asm @@ -17,74 +17,68 @@ * Toolchain : IAR's EW for M16C v3.401 */ - RSEG CSTACK + RSEG CSTACK - RSEG ISTACK + RSEG ISTACK - RSEG CODE(1) + RSEG CODE(1) - EXTERN rt_thread_switch_interrput_flag - EXTERN rt_interrupt_from_thread - EXTERN rt_interrupt_to_thread + EXTERN rt_thread_switch_interrput_flag + EXTERN rt_interrupt_from_thread + EXTERN rt_interrupt_to_thread - PUBLIC rt_hw_interrupt_disable - PUBLIC rt_hw_interrupt_enable - PUBLIC rt_hw_context_switch_to - PUBLIC rt_hw_context_switch - PUBLIC rt_hw_context_switch_interrupt - PUBLIC os_context_switch + PUBLIC rt_hw_interrupt_disable + PUBLIC rt_hw_interrupt_enable + PUBLIC rt_hw_context_switch_to + PUBLIC rt_hw_context_switch + PUBLIC rt_hw_context_switch_interrupt + PUBLIC os_context_switch -rt_hw_interrupt_disable - STC FLG, R0 ;fify 20100419 - FCLR I +rt_hw_interrupt_disable: + STC FLG, R0 ;fify 20100419 + FCLR I RTS -rt_hw_interrupt_enable - LDC R0, FLG ;fify 20100419 +rt_hw_interrupt_enable: + LDC R0, FLG ;fify 20100419 RTS .EVEN os_context_switch: - PUSHM R0,R1,R2,R3,A0,A1,SB,FB - CMP.W #0,rt_thread_switch_interrput_flag - JEQ exit - MOV.W #0, rt_thread_switch_interrput_flag - MOV.W rt_interrupt_from_thread, A0 - STC ISP, [A0] - MOV.W rt_interrupt_to_thread, A0 - LDC [A0], ISP -exit - POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore registers from the new task's stack - REIT ; Return from interrup + PUSHM R0,R1,R2,R3,A0,A1,SB,FB + + MOV.W rt_interrupt_from_thread, A0 + STC ISP, [A0] + MOV.W rt_interrupt_to_thread, A0 + LDC [A0], ISP + + POPM R0,R1,R2,R3,A0,A1,SB,FB ; Restore registers from the new task's stack + REIT ; Return from interrup /* * void rt_hw_context_switch_to(rt_uint32 to); * r0 --> to * this fucntion is used to perform the first thread switch */ -rt_hw_context_switch_to - MOV.W R0, A0 - LDC [A0], ISP - POPM R0,R1,R2,R3,A0,A1,SB,FB +rt_hw_context_switch_to: + MOV.W R0, A0 + LDC [A0], ISP + POPM R0,R1,R2,R3,A0,A1,SB,FB REIT -rt_hw_context_switch - CMP.W #1,rt_thread_switch_interrput_flag - JEQ jump1 - MOV.W #1,rt_thread_switch_interrput_flag - MOV.W R0, rt_interrupt_from_thread -jump1 - MOV.W R1, rt_interrupt_to_thread - INT #0 +rt_hw_context_switch: + MOV.W R0, rt_interrupt_from_thread + MOV.W R1, rt_interrupt_to_thread + INT #0 ;software interrupt 0 RTS -rt_hw_context_switch_interrupt - CMP.W #1,rt_thread_switch_interrput_flag - JEQ jump - MOV.W #1,rt_thread_switch_interrput_flag - MOV.W R0, rt_interrupt_from_thread +rt_hw_context_switch_interrupt: + CMP.W #1, rt_thread_switch_interrput_flag + JEQ jump + MOV.W #1, rt_thread_switch_interrput_flag + MOV.W R0, rt_interrupt_from_thread jump - MOV.W R1, rt_interrupt_to_thread + MOV.W R1, rt_interrupt_to_thread RTS END