mirror of
https://gitee.com/xiaohuolufeihua/bizhang_-obav.git
synced 2026-05-22 09:28:58 +00:00
Fixes for sitl gazebo ground truth. (#5932)
* Fixes for sitl gazebo ground truth. * Switch ekf2 to new logging module for sitl.
This commit is contained in:
@@ -403,11 +403,11 @@ void Simulator::handle_message(mavlink_message_t *msg, bool publish)
|
||||
hil_gpos.time_utc_usec = timestamp;
|
||||
hil_gpos.lat = hil_state.lat;
|
||||
hil_gpos.lon = hil_state.lon;
|
||||
hil_gpos.alt = hil_state.alt;
|
||||
hil_gpos.alt = hil_state.alt / 1000.0f;
|
||||
|
||||
hil_gpos.vel_n = hil_state.vx;
|
||||
hil_gpos.vel_e = hil_state.vy;
|
||||
hil_gpos.vel_d = hil_state.vz;
|
||||
hil_gpos.vel_n = hil_state.vx / 100.0f;
|
||||
hil_gpos.vel_e = hil_state.vy / 100.0f;
|
||||
hil_gpos.vel_d = hil_state.vz / 100.0f;
|
||||
|
||||
// always publish ground truth attitude message
|
||||
int hil_gpos_multi;
|
||||
|
||||
Reference in New Issue
Block a user