mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 05:53:34 +08:00
multirotor landinging sudden fall protection:
remove condition which made activation of the protection very unlikely
This commit is contained in:
@@ -1512,7 +1512,6 @@ MulticopterPositionControl::task_main()
|
||||
_landing_started = hrt_absolute_time();
|
||||
}
|
||||
|
||||
#if 0
|
||||
// TODO quick fix: remove this since in combination with the non-working fall detection
|
||||
// it can lead to the copter falling out of the sky
|
||||
/* don't let it throttle up again during landing */
|
||||
@@ -1523,7 +1522,6 @@ MulticopterPositionControl::task_main()
|
||||
&& hrt_elapsed_time(&_landing_started) > 15e5) {
|
||||
_landing_thrust = thrust_abs;
|
||||
}
|
||||
#endif
|
||||
|
||||
/* assume ground, reduce thrust */
|
||||
if (hrt_elapsed_time(&_landing_started) > 15e5
|
||||
@@ -1535,7 +1533,6 @@ MulticopterPositionControl::task_main()
|
||||
|
||||
/* if we suddenly fall, reset landing logic and remove thrust limit */
|
||||
if (hrt_elapsed_time(&_landing_started) > 15e5
|
||||
&& _landing_thrust < FLT_EPSILON
|
||||
/* XXX: magic value, assuming free fall above 4m/s2 acceleration */
|
||||
&& (_acc_z_lp > 4.0f
|
||||
|| _vel_z_lp > 2.0f * _params.land_speed)
|
||||
|
||||
Reference in New Issue
Block a user