diff --git a/ArduCopter/commands_process.pde b/ArduCopter/commands_process.pde index 4c3b94eda7..18132e284d 100644 --- a/ArduCopter/commands_process.pde +++ b/ArduCopter/commands_process.pde @@ -64,7 +64,8 @@ static void update_commands() if (land_complete == true){ // we will disarm the motors after landing. } else { - set_mode(LAND); + // If the approach altitude is valid (above 1m), do approach, else land + set_mode(((g.rtl_approach_alt >= 1) ? APPROACH : LAND)); } } }