add ref_timestamp (time when origin was set) to lpe

This commit is contained in:
ChristophTobler
2017-06-12 09:39:41 +05:30
committed by Kabir Mohammed
parent a1a0dd37dc
commit 9b5de23553
4 changed files with 10 additions and 1 deletions
@@ -42,6 +42,8 @@ void BlockLocalPositionEstimator::visionInit()
mavlink_and_console_log_info(&mavlink_log_pub, "[lpe] global origin init (vision) : lat %6.2f lon %6.2f alt %5.1f m",
double(_sub_vision_pos.get().ref_lat), double(_sub_vision_pos.get().ref_lon), double(_sub_vision_pos.get().ref_alt));
map_projection_init(&_map_ref, _sub_vision_pos.get().ref_lat, _sub_vision_pos.get().ref_lon);
// set timestamp when origin was set to current time
_time_origin = _timeStamp;
}
if (!_altOriginInitialized) {