mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-24 03:23:33 +08:00
Land: use MIS_LND_ABRT_ALT also in non-mission Land
As we don't know the landing point altitude in non-mission landings, assume the worst case (abort right before touchdown) and thus always climb MIS_LND_ABRT_ALT on triggering an abort. Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
@@ -106,7 +106,9 @@ Land::on_active()
|
|||||||
vcmd.param2 = 1;
|
vcmd.param2 = 1;
|
||||||
vcmd.param5 = _navigator->get_global_position()->lat;
|
vcmd.param5 = _navigator->get_global_position()->lat;
|
||||||
vcmd.param6 = _navigator->get_global_position()->lon;
|
vcmd.param6 = _navigator->get_global_position()->lon;
|
||||||
vcmd.param7 = _navigator->get_global_position()->alt;
|
// as we don't know the landing point altitude assume the worst case (abort at 0m above ground),
|
||||||
|
// and thus always climb MIS_LND_ABRT_ALT
|
||||||
|
vcmd.param7 = _navigator->get_global_position()->alt + _navigator->get_landing_abort_min_alt();
|
||||||
|
|
||||||
_navigator->publish_vehicle_cmd(&vcmd);
|
_navigator->publish_vehicle_cmd(&vcmd);
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user