mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-08 15:10:34 +08:00
VTOL: fix transition quadchute below home
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
@@ -303,14 +303,7 @@ bool VtolType::isFrontTransitionAltitudeLoss()
|
||||
|
||||
if (_param_vt_qc_t_alt_loss.get() > FLT_EPSILON && _common_vtol_mode == mode::TRANSITION_TO_FW && _local_pos->z_valid) {
|
||||
|
||||
if (_local_pos->z <= FLT_EPSILON) {
|
||||
// vehilce is above home
|
||||
result = _local_pos->z - _local_position_z_start_of_transition > _param_vt_qc_t_alt_loss.get();
|
||||
|
||||
} else {
|
||||
// vehilce is below home
|
||||
result = _local_position_z_start_of_transition - _local_pos->z > _param_vt_qc_t_alt_loss.get();
|
||||
}
|
||||
result = _local_pos->z - _local_position_z_start_of_transition > _param_vt_qc_t_alt_loss.get();
|
||||
}
|
||||
|
||||
return result;
|
||||
|
||||
Reference in New Issue
Block a user