fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-06-27 05:20:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #52 from bugobliterator/pr-airspeed-sample-fix

Browse Source 
EKF: fix time of sample receive setting
This commit is contained in:
Roman Bapst
2016-02-17 22:34:30 +01:00
parent de02aebafd 2096e24c06
commit 678d6f45cc
1 changed files with 2 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/estimator_interface.cpp
+2 -3
View File
@@ -180,9 +180,8 @@ void EstimatorInterface::setAirspeedData(uint64_t time_usec, float *data)
if (time_usec > _time_last_airspeed) {
airspeedSample airspeed_sample_new;
airspeed_sample_new.airspeed = *data;
airspeed_sample_new.time_us -= _params.airspeed_delay_ms * 1000;
airspeed_sample_new.time_us = time_usec -= FILTER_UPDATE_PERRIOD_MS * 1000 / 2;
airspeed_sample_new.time_us = time_usec -_params.airspeed_delay_ms * 1000;
airspeed_sample_new.time_us -= FILTER_UPDATE_PERRIOD_MS * 1000 / 2;
_time_last_airspeed = time_usec;
_airspeed_buffer.push(airspeed_sample_new);