Continue work on SH2A demo.

This commit is contained in:
Richard Barry 2010-02-15 17:13:58 +00:00
parent 0978152144
commit b25f24cb75
16 changed files with 4559 additions and 671 deletions

View file

@ -55,55 +55,10 @@
.import _pxCurrentTCB
.export _vEMAC_ISR_Wrapper
.INCLUDE "ISR_Support.inc"
.section P
.macro portSAVE_CONTEXT
; Save r0 to r14 and pr.
movml.l r15, @-r15
; Save mac1, mach and gbr
sts.l macl, @-r15
sts.l mach, @-r15
stc.l gbr, @-r15
; Get the address of pxCurrentTCB
mov.l #_pxCurrentTCB, r0
; Get the address of pxTopOfStack from the TCB.
mov.l @r0, r0
; Save the stack pointer in pxTopOfStack.
mov.l r15, @r0
.endm
;-----------------------------------------------------------
.macro portRESTORE_CONTEXT
; Get the address of the pxCurrentTCB variable.
mov.l #_pxCurrentTCB, r0
; Get the address of the task stack from pxCurrentTCB.
mov.l @r0, r0
; Get the task stack itself into the stack pointer.
mov.l @r0, r15
; Restore system registers.
ldc.l @r15+, gbr
lds.l @r15+, mach
lds.l @r15+, macl
; Restore r0 to r14 and PR
movml.l @r15+, r15
; Pop the SR and PC to jump to the start of the task.
rte
nop
.endm
;-----------------------------------------------------------
_vEMAC_ISR_Wrapper:
@ -118,6 +73,7 @@ _vEMAC_ISR_Wrapper:
;-----------------------------------------------------------
.end