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:
James Goppert
2016-12-03 11:40:53 -05:00
committed by GitHub
parent d71645b321
commit 4b6a11161e
3 changed files with 6 additions and 6 deletions

View File

@@ -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;