fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-01 03:31:37 +08:00
Code Issues Packages Projects Releases Wiki Activity

navigator: geofence with global pos: reduce update rate

Browse Source
This commit is contained in:
Thomas Gubler
2014-09-21 18:04:11 +02:00
parent 885d3e8ca4
commit 808cc60cda
1 changed files with 5 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/navigator_main.cpp
+5 -1
View File
@@ -387,9 +387,13 @@ Navigator::task_main()
/* global position updated */ /* global position updated */
if (fds[0].revents & POLLIN) { if (fds[0].revents & POLLIN) {
global_position_update(); global_position_update();
if (_geofence.getSource() == Geofence::GF_SOURCE_GLOBALPOS) { static int gposcounter = 0;
if (_geofence.getSource() == Geofence::GF_SOURCE_GLOBALPOS &&
gposcounter % 10 == 0) {
/* Geofence is checked only every 10th gpos update */
have_geofence_position_data = true; have_geofence_position_data = true;
} }
gposcounter++;
} }
/* Check geofence violation */ /* Check geofence violation */