fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-15 12:51:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

new airframe for sih, HIL_STATE_QUATERION sent through MAVLink

Browse Source
This commit is contained in:
Beat Küng
2019-04-12 09:25:07 +02:00
parent c09e9ec97f
commit 914a9b78b6
42 changed files with 225 additions and 103 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/mavlink_messages.cpp
+7 -6
View File
@@ -4666,12 +4666,13 @@ protected:
msg.yawspeed = att.yawspeed;
// vehicle_global_position -> hil_state_quaternion
msg.lat = gpos.lat;
msg.lon = gpos.lon;
msg.alt = gpos.alt;
msg.vx = gpos.vel_n;
msg.vy = gpos.vel_e;
msg.vz = gpos.vel_d;
// same units as defined in mavlink/common.xml
msg.lat = gpos.lat * 1e7;
msg.lon = gpos.lon * 1e7;
msg.alt = gpos.alt * 1e3f;
msg.vx = gpos.vel_n * 1e2f;
msg.vy = gpos.vel_e * 1e2f;
msg.vz = gpos.vel_d * 1e2f;
msg.ind_airspeed = 0;
msg.true_airspeed = 0;
msg.xacc = 0;