Adding initial RTOS code