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

Navigator: Only indicate timeout if we really time out

Browse Source
This commit is contained in:
Lorenz Meier 2015-11-02 13:48:30 +01:00
parent 4c60f4d98a
commit 4fa0123652
1 changed files with 7 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/modules/navigator/navigator_main.cpp
View File

@ -314,6 +314,8 @@ Navigator::task_main()
fds[0].fd = _global_pos_sub;
fds[0].events = POLLIN;
bool global_pos_available_once = false;
while (!_task_should_exit) {
/* wait for up to 200ms for data */
@ -321,7 +323,9 @@ Navigator::task_main()
if (pret == 0) {
/* timed out - periodic check for _task_should_exit, etc. */
PX4_WARN("navigator timed out");
if (global_pos_available_once) {
PX4_WARN("navigator timed out");
}
continue;
} else if (pret < 0) {
@ -330,6 +334,8 @@ Navigator::task_main()
continue;
}
global_pos_available_once = true;
perf_begin(_loop_perf);
if (_mavlink_fd < 0 && hrt_absolute_time() > mavlink_open_time) {