Quadrocopter on FreeRTOS