97     stmfd   sp!, { lr, r0 }  in OS_SaveContext()
98     add     r0, r0, #OS_CONTEXT_CP_CONTEXT  in OS_SaveContext()
101     ldmfd   sp!, { lr, r0 }  in OS_SaveContext()
104     add     r1, r0, #OS_CONTEXT_CPSR  in OS_SaveContext()
112     mov     r0, #HW_PSR_SVC_MODE|HW_PSR_IRQ_DISABLE|HW_PSR_FIQ_DISABLE|HW_PSR_ARM_STATE  in OS_SaveContext()
113     msr     cpsr_c, r0  in OS_SaveContext()
119     mov     r0, #1              // Return value via OS_LoadContext  in OS_SaveContext()
120     stmia   r1, {r0-r14}        // Save R0-R14  in OS_SaveContext()
121     add     r0, pc, #8          // Set  PC_plus4 to do ("bx lr" + 4)  in OS_SaveContext()
122     str     r0, [r1, #OS_CONTEXT_PC_PLUS4 - OS_CONTEXT_R0 ]  in OS_SaveContext()
124     mov     r0, #0              // Regular return value  in OS_SaveContext()
144     add   r0, r0, #OS_CONTEXT_CPSR  in OS_LoadContext()
149     stmfd     sp!, { lr, r0 }  in OS_LoadContext()
150     add       r0, r0, #OS_CONTEXT_CP_CONTEXT  in OS_LoadContext()
154     ldmfd     sp!, { lr, r0 }  in OS_LoadContext()
164     ldr       r1, [ r0 ], #OS_CONTEXT_R0-OS_CONTEXT_CPSR  in OS_LoadContext()
169     ldr       sp, [ r0, #OS_CONTEXT_SP_SVC   - OS_CONTEXT_R0 ]  in OS_LoadContext()
173     ldr       lr, [ r0, #OS_CONTEXT_PC_PLUS4 - OS_CONTEXT_R0 ]  in OS_LoadContext()
174     ldmia     r0, { r0 - r14 }^  in OS_LoadContext()
181     stmfd     sp!, {r0-r3,r12,r14}  in OS_LoadContext()
183     stmfd     sp!, {r0-r1}  in OS_LoadContext()
191     ldr       r0, =REG_DIVCNT_ADDR  in OS_LoadContext()
193     ldr       r1, [r0]  in OS_LoadContext()
199     ldmfd  sp!, {r0-r3,r12,r14}  in OS_LoadContext()
201     ldmfd  sp!, {r0-r1}  in OS_LoadContext()