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

4
src/modules/navigator/navigator_main.cpp

@ -665,9 +665,11 @@ Navigator::run() @@ -665,9 +665,11 @@ Navigator::run()
_pos_sp_triplet.current.type = position_setpoint_s::SETPOINT_TYPE_IDLE;
_pos_sp_triplet.current.valid = true;
_pos_sp_triplet.current.timestamp = hrt_absolute_time();
_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 */

1
src/modules/navigator/precland.cpp

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

Loading…
Cancel
Save