Test, documentation

Tested the RTOS again on my end to make sure it works and added
documentation in rtos.h