msr psp, r0 /* This is now the new top of stack to use in the task. */\r
movs r0, #2 /* Switch to the psp stack. */\r
msr CONTROL, r0\r
msr psp, r0 /* This is now the new top of stack to use in the task. */\r
movs r0, #2 /* Switch to the psp stack. */\r
msr CONTROL, r0\r
pop {r0-r5} /* Pop the registers that are saved automatically. */\r
mov lr, r5 /* lr is now in r5. */\r
cpsie i /* The first task has its context and interrupts can be enabled. */\r
pop {r0-r5} /* Pop the registers that are saved automatically. */\r
mov lr, r5 /* lr is now in r5. */\r
cpsie i /* The first task has its context and interrupts can be enabled. */\r