Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Made landing disarm the motors

This commit is contained in:
Jason Short 2012-01-03 23:29:28 -08:00
parent ed1ff0b171
commit 40c649a27b
1 changed files with 9 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
ArduCopter/commands_logic.pde
View File

@ -356,13 +356,16 @@ static bool verify_land()
if (velocity_land == -1)
velocity_land = 2000;
// a LP filter used to tell if we have landed
// will drive to 0 if we are on the ground - maybe, the baro is noisy
velocity_land = ((velocity_land * 7) + (old_alt - current_loc.alt)) / 8;
if (current_loc.alt < 500){
// a LP filter used to tell if we have landed
// will drive to 0 if we are on the ground - maybe, the baro is noisy
velocity_land = ((velocity_land * 7) + (old_alt - current_loc.alt)) / 8;
}
old_alt = current_loc.alt;
if (current_loc.alt < 300){
wp_control = NO_NAV_MODE;
// Update by JLN for a safe AUTO landing
@ -381,12 +384,12 @@ static bool verify_land()
}
}
if(velocity_land <= 0){
if(current_loc.alt < 300 && velocity_land <= 100){
land_complete = true;
// reset old_alt
old_alt == 0;
// commented out to prevent tragedy
//return true;
init_disarm_motors();
return true;
}
//Serial.printf("N, %d\n", velocity_land);
//Serial.printf("N_alt, %ld\n", next_WP.alt);