commands_logic: Added check to make sure the do_approach method is not being used to land.

This commit is contained in:
Adam M Rivera 2012-04-15 16:57:49 -05:00
parent 70d67b0791
commit 0027c9253b
1 changed files with 17 additions and 12 deletions

View File

@ -294,6 +294,8 @@ static void do_land()
static void do_approach() static void do_approach()
{ {
// Make sure we are not using this to land
if(g.rtl_approach_alt > 5){
wp_control = LOITER_MODE; wp_control = LOITER_MODE;
// just to make sure // just to make sure
@ -311,6 +313,9 @@ static void do_approach()
// Set target alt based on user setting // Set target alt based on user setting
set_new_altitude(g.rtl_approach_alt * 100); set_new_altitude(g.rtl_approach_alt * 100);
} else {
set_mode(LOITER);
}
} }
static void do_loiter_unlimited() static void do_loiter_unlimited()