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

Navigator: Publish mission triplet only when actually updated

Browse Source
This commit is contained in:
Julian Oes
2013-11-22 14:07:21 +01:00
parent 7892a72f90
commit 5748a9c964
1 changed files with 10 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/navigator_main.cpp
+10 -10
View File
@@ -468,16 +468,6 @@ Navigator::task_main()
advance_current_mission_item();
}
}
/* lazily publish the setpoint only once available */
if (_triplet_pub > 0) {
/* publish the attitude setpoint */
orb_publish(ORB_ID(mission_item_triplet), _triplet_pub, &_mission_item_triplet);
} else {
/* advertise and publish */
_triplet_pub = orb_advertise(ORB_ID(mission_item_triplet), &_mission_item_triplet);
}
}
perf_end(_loop_perf);
@@ -721,6 +711,16 @@ Navigator::update_mission_item_triplet()
_mission_item_triplet.next_valid = true;
}
}
/* lazily publish the mission triplet only once available */
if (_triplet_pub > 0) {
/* publish the mission triplet */
orb_publish(ORB_ID(mission_item_triplet), _triplet_pub, &_mission_item_triplet);
} else {
/* advertise and publish */
_triplet_pub = orb_advertise(ORB_ID(mission_item_triplet), &_mission_item_triplet);
}
}
void