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