Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: prevent a division by zero in takeoff code

Browse Source
This commit is contained in:
Andrew Tridgell 2016-04-26 12:06:57 +10:00
parent 831ae72908
commit 1ebe0a2583
1 changed files with 9 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
ArduPlane/takeoff.cpp
View File

@ -165,13 +165,15 @@ int16_t Plane::get_takeoff_pitch_min_cd(void)
} }
// are we entering the region where we want to start leveling off before we reach takeoff alt? // are we entering the region where we want to start leveling off before we reach takeoff alt?
float sec_to_target = (remaining_height_to_target_cm * 0.01f) / (-auto_state.sink_rate); if (auto_state.sink_rate < -0.1f) {
if (sec_to_target > 0 && float sec_to_target = (remaining_height_to_target_cm * 0.01f) / (-auto_state.sink_rate);
relative_alt_cm >= 1000 && if (sec_to_target > 0 &&
sec_to_target <= g.takeoff_pitch_limit_reduction_sec) { relative_alt_cm >= 1000 &&
// make a note of that altitude to use it as a start height for scaling sec_to_target <= g.takeoff_pitch_limit_reduction_sec) {
gcs_send_text_fmt(MAV_SEVERITY_INFO, "Takeoff level-off starting at %dm", remaining_height_to_target_cm/100); // make a note of that altitude to use it as a start height for scaling
auto_state.height_below_takeoff_to_level_off_cm = remaining_height_to_target_cm; gcs_send_text_fmt(MAV_SEVERITY_INFO, "Takeoff level-off starting at %dm", remaining_height_to_target_cm/100);
auto_state.height_below_takeoff_to_level_off_cm = remaining_height_to_target_cm;
}
} }
} }
return auto_state.takeoff_pitch_cd; return auto_state.takeoff_pitch_cd;