Moved context switching to PendSV (from SysTick)