added workaround for resetting alt.

This commit is contained in:
Jason Short 2012-02-19 12:40:08 -08:00
parent fa32b084bd
commit bcd5129f9b
1 changed files with 7 additions and 0 deletions

View File

@ -326,6 +326,13 @@ static void clear_new_altitude()
static void set_new_altitude(int32_t _new_alt)
{
if(_new_alt == current_loc.alt){
next_WP.alt = _new_alt;
target_altitude = _new_alt;
alt_change_flag = REACHED_ALT;
return;
}
// just to be clear
next_WP.alt = current_loc.alt;