fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

range_finder_consistency_check: fix consistency check timeout units (#26497)

Browse Source 
* range_finder_consistency_check: fix consistency check timeout units

* explicit float

* format
This commit is contained in:
Jacob Dahl 2026-02-17 14:10:04 -09:00 committed by GitHub
parent d5ddc9135d
commit b2fc5993cc
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/ekf2/EKF/aid_sources/range_finder/range_finder_consistency_check.cpp
View File

@ -75,7 +75,9 @@ void RangeFinderConsistencyCheck::update(float dist_bottom, float dist_bottom_va
void RangeFinderConsistencyCheck::updateConsistency(float vz, uint64_t time_us)
{
if (fabsf(_signed_test_ratio_lpf.getState()) >= 1.f) {
if ((time_us - _time_last_horizontal_motion) > _signed_test_ratio_tau) {
uint64_t timeout_us = _signed_test_ratio_tau * 1e6f;
if ((time_us - _time_last_horizontal_motion) > timeout_us) {
_is_kinematically_consistent = false;
_time_last_inconsistent_us = time_us;
}