Browse Source

navigator: set position setpoint timestamp

sbg
Daniel Agar 5 years ago
parent
commit
515e896cde
  1. 1
      src/modules/navigator/mission_block.cpp
  2. 4
      src/modules/navigator/navigator_main.cpp
  3. 1
      src/modules/navigator/precland.cpp

1
src/modules/navigator/mission_block.cpp

@ -590,6 +590,7 @@ MissionBlock::mission_item_to_position_setpoint(const mission_item_s &item, posi
} }
sp->valid = true; sp->valid = true;
sp->timestamp = hrt_absolute_time();
return sp->valid; return sp->valid;
} }

4
src/modules/navigator/navigator_main.cpp

@ -665,9 +665,11 @@ Navigator::run()
_pos_sp_triplet.current.type = position_setpoint_s::SETPOINT_TYPE_IDLE; _pos_sp_triplet.current.type = position_setpoint_s::SETPOINT_TYPE_IDLE;
_pos_sp_triplet.current.valid = true; _pos_sp_triplet.current.valid = true;
_pos_sp_triplet.current.timestamp = hrt_absolute_time();
_pos_sp_triplet.previous.valid = false; _pos_sp_triplet.previous.valid = false;
_pos_sp_triplet.next.valid = false;
_pos_sp_triplet.next.valid = false;
} }
/* if nothing is running, set position setpoint triplet invalid once */ /* if nothing is running, set position setpoint triplet invalid once */

1
src/modules/navigator/precland.cpp

@ -93,6 +93,7 @@ PrecLand::on_activation()
pos_sp_triplet->current.lon = _navigator->get_global_position()->lon; pos_sp_triplet->current.lon = _navigator->get_global_position()->lon;
pos_sp_triplet->current.alt = _navigator->get_global_position()->alt; pos_sp_triplet->current.alt = _navigator->get_global_position()->alt;
pos_sp_triplet->current.valid = true; pos_sp_triplet->current.valid = true;
pos_sp_triplet->current.timestamp = hrt_absolute_time();
} }
_sp_pev = matrix::Vector2f(0, 0); _sp_pev = matrix::Vector2f(0, 0);

Loading…
Cancel
Save