fixed yaw/yawrate bit masking. fixed navigator overriding offboard setpoint

This commit is contained in:
Steven Blass
2014-11-17 19:58:18 -05:00
parent 97a1410ec9
commit 5f6d03099e
2 changed files with 6 additions and 5 deletions
+4 -3
View File
@@ -468,9 +468,10 @@ Navigator::task_main()
_navigation_mode_array[i]->run(_navigation_mode == _navigation_mode_array[i]);
}
/* if nothing is running, set position setpoint triplet invalid */
if (_navigation_mode == nullptr) {
// TODO publish empty sp only once
/* if nothing is running, set position setpoint triplet invalid once */
static bool published_once = false;
if (_navigation_mode == nullptr && !published_once) {
published_once = true;
_pos_sp_triplet.previous.valid = false;
_pos_sp_triplet.current.valid = false;
_pos_sp_triplet.next.valid = false;