dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

MC LandDetector: add constant (0.3) for vz threshold for in_descend flag 

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer 2022-10-17 11:49:04 +02:00
parent 4e74473932
commit 06bf60672b
2 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/modules/land_detector/MulticopterLandDetector.cpp
View File

@ -202,7 +202,7 @@ bool MulticopterLandDetector::_get_ground_contact_state()
if (_trajectory_setpoint_sub.update(&trajectory_setpoint)) {
// Setpoints can be NAN
_in_descend = PX4_ISFINITE(trajectory_setpoint.velocity[2])
&& (trajectory_setpoint.velocity[2] > FLT_EPSILON);
&& (trajectory_setpoint.velocity[2] > DESCENT_TRAJECTORY_VZ_THRESHOLD);
}
// ground contact requires commanded descent until landed

3
src/modules/land_detector/MulticopterLandDetector.h
View File

@ -87,6 +87,9 @@ private:
/** Distance above ground below which entering ground contact state is possible when distance to ground is available. */
static constexpr float DIST_FROM_GROUND_THRESHOLD = 1.0f;
/** Down velocity threshold for setting "in_descend" flag */
static constexpr float DESCENT_TRAJECTORY_VZ_THRESHOLD = 0.3f;
/** Handles for interesting parameters. **/
struct {
param_t minThrottle;