navigator: set position setpoint timestamp

This commit is contained in:
Daniel Agar
2019-11-19 09:12:47 -05:00
parent a2bd65460d
commit 515e896cde
3 changed files with 6 additions and 2 deletions
+1
View File
@@ -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 -2
View File
@@ -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.previous.valid = false;
_pos_sp_triplet.next.valid = false;
_pos_sp_triplet.current.timestamp = hrt_absolute_time();
_pos_sp_triplet.previous.valid = false;
_pos_sp_triplet.next.valid = false;
}
/* if nothing is running, set position setpoint triplet invalid once */
+1
View File
@@ -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);