aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorLorenz Meier <lm@inf.ethz.ch>2015-05-13 16:04:33 +0200
committerLorenz Meier <lm@inf.ethz.ch>2015-05-13 16:04:33 +0200
commit66b87ac7618d2e886b5389e3eef50af182b32f25 (patch)
tree1dc73e32cf467b0cdb5c81f3ab29728f8db0f5d3
parent6f949510501c34c3a114db7fdb32d6fb8d47c36a (diff)
downloadpx4-firmware-66b87ac7618d2e886b5389e3eef50af182b32f25.tar.gz
px4-firmware-66b87ac7618d2e886b5389e3eef50af182b32f25.tar.bz2
px4-firmware-66b87ac7618d2e886b5389e3eef50af182b32f25.zip
Fix state-level HIL. Reported by @s3erjaeh
-rw-r--r--src/modules/mavlink/mavlink_receiver.cpp4
1 files changed, 2 insertions, 2 deletions
diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp
index 0cd163a0c..988232dc2 100644
--- a/src/modules/mavlink/mavlink_receiver.cpp
+++ b/src/modules/mavlink/mavlink_receiver.cpp
@@ -1360,8 +1360,8 @@ MavlinkReceiver::handle_message_hil_state_quaternion(mavlink_message_t *msg)
memset(&hil_global_pos, 0, sizeof(hil_global_pos));
hil_global_pos.timestamp = timestamp;
- hil_global_pos.lat = hil_state.lat;
- hil_global_pos.lon = hil_state.lon;
+ hil_global_pos.lat = hil_state.lat / ((double)1e7);
+ hil_global_pos.lon = hil_state.lon / ((double)1e7);
hil_global_pos.alt = hil_state.alt / 1000.0f;
hil_global_pos.vel_n = hil_state.vx / 100.0f;
hil_global_pos.vel_e = hil_state.vy / 100.0f;