diff options
Diffstat (limited to 'src/modules/land_detector/MulticopterLandDetector.cpp')
| -rw-r--r-- | src/modules/land_detector/MulticopterLandDetector.cpp | 6 |
1 files changed, 3 insertions, 3 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; |