Added code to simply take-off and controlling