mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 14:03:34 +08:00
add ref_timestamp (time when origin was set) to lpe
This commit is contained in:
committed by
Kabir Mohammed
parent
a1a0dd37dc
commit
9b5de23553
@@ -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) {
|
||||
|
||||
Reference in New Issue
Block a user