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

EKF: prevent unwanted GPS use

Browse Source
This commit is contained in:
Paul Riseborough
2016-05-24 07:55:09 +10:00
parent c8c2d6d963
commit 5a40aa2c1a
1 changed files with 2 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/estimator_interface.cpp
+2 -1
View File
@@ -144,7 +144,8 @@ void EstimatorInterface::setMagData(uint64_t time_usec, float *data)
void EstimatorInterface::setGpsData(uint64_t time_usec, struct gps_message *gps) void EstimatorInterface::setGpsData(uint64_t time_usec, struct gps_message *gps)
{ {
// Limit the GPS data rate to a maximum of 14Hz // Limit the GPS data rate to a maximum of 14Hz
if (time_usec - _time_last_gps > 65000) { bool need_gps = (_params.fusion_mode & MASK_USE_GPS) || (_params.vdist_sensor_type == VDIST_SENSOR_GPS);
if (time_usec - _time_last_gps > 65000 && need_gps) {
gpsSample gps_sample_new = {}; gpsSample gps_sample_new = {};
gps_sample_new.time_us = gps->time_usec - _params.gps_delay_ms * 1000; gps_sample_new.time_us = gps->time_usec - _params.gps_delay_ms * 1000;