isb\r
pop {r0-r5} /* Pop the registers that are saved automatically. */\r
mov lr, r5 /* lr is now in r5. */\r
+ pop {r3} /* The return address is now in r3. */\r
+ pop {r2} /* Pop and discard the XPSR. */\r
cpsie i /* The first task has its context and interrupts can be enabled. */\r
- pop {pc} /* Finally, pop the PC to jump to the user defined task code. */\r
+ bx r3 /* Finally, jump to the user defined task code. */\r
\r
ALIGN\r
}\r