Add os for test

Trying to merge newer version of flight control algorithm with OS