From d4fedca1ee06e8ca2d180305b0a28c71f9d04d5c Mon Sep 17 00:00:00 2001 From: mcsauder Date: Wed, 14 Aug 2019 11:06:25 -0600 Subject: [PATCH] Rename _accel_horz_lp -> _xy_accel_filtered to standardize naming, use time literal, and delete unneeded #includes in the FixedwingLandDetector class. --- .../land_detector/FixedwingLandDetector.cpp | 14 +++++--------- src/modules/land_detector/FixedwingLandDetector.h | 3 +-- 2 files changed, 6 insertions(+), 11 deletions(-) diff --git a/src/modules/land_detector/FixedwingLandDetector.cpp b/src/modules/land_detector/FixedwingLandDetector.cpp index 2a60b865e3..64b99025fd 100644 --- a/src/modules/land_detector/FixedwingLandDetector.cpp +++ b/src/modules/land_detector/FixedwingLandDetector.cpp @@ -39,14 +39,10 @@ * @author Julian Oes */ -#include "FixedwingLandDetector.h" - -#include - -#include -#include #include +#include "FixedwingLandDetector.h" + namespace land_detector { @@ -90,7 +86,7 @@ bool FixedwingLandDetector::_get_landed_state() bool landDetected = false; - if (hrt_elapsed_time(&_vehicle_local_position.timestamp) < 500 * 1000) { + if (hrt_elapsed_time(&_vehicle_local_position.timestamp) < 500_ms) { // Horizontal velocity complimentary filter. float val = 0.97f * _velocity_xy_filtered + 0.03f * sqrtf(_vehicle_local_position.vx * _vehicle_local_position.vx + @@ -114,10 +110,10 @@ bool FixedwingLandDetector::_get_landed_state() const matrix::Vector3f accel{_vehicle_acceleration.xyz}; const float acc_hor = sqrtf(accel(0) * accel(0) + accel(1) * accel(1)); - _accel_horz_lp = _accel_horz_lp * 0.8f + acc_hor * 0.18f; + _xy_accel_filtered = _xy_accel_filtered * 0.8f + acc_hor * 0.18f; // crude land detector for fixedwing - landDetected = _accel_horz_lp < _param_lndfw_xyaccel_max.get() + landDetected = _xy_accel_filtered < _param_lndfw_xyaccel_max.get() && _airspeed_filtered < _param_lndfw_airspd.get() && _velocity_xy_filtered < _param_lndfw_vel_xy_max.get() && _velocity_z_filtered < _param_lndfw_vel_z_max.get(); diff --git a/src/modules/land_detector/FixedwingLandDetector.h b/src/modules/land_detector/FixedwingLandDetector.h index 0c2d1a01b8..020a769e20 100644 --- a/src/modules/land_detector/FixedwingLandDetector.h +++ b/src/modules/land_detector/FixedwingLandDetector.h @@ -42,7 +42,6 @@ #pragma once -#include #include #include #include @@ -82,10 +81,10 @@ private: vehicle_acceleration_s _vehicle_acceleration{}; vehicle_local_position_s _vehicle_local_position{}; - float _accel_horz_lp{0.0f}; float _airspeed_filtered{0.0f}; float _velocity_xy_filtered{0.0f}; float _velocity_z_filtered{0.0f}; + float _xy_accel_filtered{0.0f}; DEFINE_PARAMETERS_CUSTOM_PARENT( LandDetector,