Fixed error: Change vtol status at correct place in the code