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

GPS driver: Obey non-publish flag in all modes

Browse Source
This commit is contained in:
Lorenz Meier
2015-05-28 17:41:26 -07:00
parent aab379cde9
commit 46920cfd27
1 changed files with 7 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/gps/gps.cpp
+3
View File
@@ -361,12 +361,15 @@ GPS::task_main()
_report_gps_pos.timestamp_variance = hrt_absolute_time(); _report_gps_pos.timestamp_variance = hrt_absolute_time();
_report_gps_pos.timestamp_velocity = hrt_absolute_time(); _report_gps_pos.timestamp_velocity = hrt_absolute_time();
_report_gps_pos.timestamp_time = hrt_absolute_time(); _report_gps_pos.timestamp_time = hrt_absolute_time();
if (!(_pub_blocked)) {
if (_report_gps_pos_pub > 0) { if (_report_gps_pos_pub > 0) {
orb_publish(ORB_ID(vehicle_gps_position), _report_gps_pos_pub, &_report_gps_pos); orb_publish(ORB_ID(vehicle_gps_position), _report_gps_pos_pub, &_report_gps_pos);
} else { } else {
_report_gps_pos_pub = orb_advertise(ORB_ID(vehicle_gps_position), &_report_gps_pos); _report_gps_pos_pub = orb_advertise(ORB_ID(vehicle_gps_position), &_report_gps_pos);
} }
}
// GPS is obviously detected successfully, reset statistics // GPS is obviously detected successfully, reset statistics
_Helper->reset_update_rates(); _Helper->reset_update_rates();