diff options
Diffstat (limited to 'src/modules/land_detector')
-rw-r--r-- | src/modules/land_detector/MulticopterLandDetector.cpp | 6 | ||||
-rw-r--r-- | src/modules/land_detector/land_detector_params.c | 2 |
2 files changed, 4 insertions, 4 deletions
diff --git a/src/modules/land_detector/MulticopterLandDetector.cpp b/src/modules/land_detector/MulticopterLandDetector.cpp index 6d7803536..1490232a4 100644 --- a/src/modules/land_detector/MulticopterLandDetector.cpp +++ b/src/modules/land_detector/MulticopterLandDetector.cpp @@ -111,9 +111,9 @@ bool MulticopterLandDetector::update() && _vehicleStatus.condition_global_position_valid; // next look if all rotation angles are not moving - bool rotating = sqrtf(_vehicleAttitude.rollspeed*_vehicleAttitude.rollspeed + - _vehicleAttitude.pitchspeed*_vehicleAttitude.pitchspeed + - _vehicleAttitude.yawspeed*_vehicleAttitude.yawspeed) > _params.maxRotation; + bool rotating = fabsf(_vehicleAttitude.rollspeed) > _params.maxRotation || + fabsf(_vehicleAttitude.pitchspeed) > _params.maxRotation || + fabsf(_vehicleAttitude.yawspeed) > _params.maxRotation; // check if thrust output is minimal (about half of default) bool minimalThrust = _actuators.control[3] <= _params.maxThrottle; diff --git a/src/modules/land_detector/land_detector_params.c b/src/modules/land_detector/land_detector_params.c index d9ab47456..e3070c115 100644 --- a/src/modules/land_detector/land_detector_params.c +++ b/src/modules/land_detector/land_detector_params.c @@ -65,7 +65,7 @@ PARAM_DEFINE_FLOAT(LNDMC_XY_VEL_MAX, 1.00f); * * @group Land Detector */ -PARAM_DEFINE_FLOAT(LNDMC_ROT_MAX, 15.0f); +PARAM_DEFINE_FLOAT(LNDMC_ROT_MAX, 20.0f); /** * Multicopter max throttle |