RTOS Context Switch - Step 6