fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-03 15:28:53 +08:00
Code Issues Packages Projects Releases Wiki Activity

MAVLink: Send correct home heading

Browse Source
This commit is contained in:
Lorenz Meier
2016-12-25 21:30:31 +01:00
parent 6444988392
commit 9b97e0358b
1 changed files with 7 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/mavlink_messages.cpp
+7 -4
View File
@@ -1931,10 +1931,13 @@ protected:
msg.y = home.y; msg.y = home.y;
msg.z = home.z; msg.z = home.z;
msg.q[0] = 1.0f; matrix::Eulerf euler(0.0f, 0.0f, home.yaw);
msg.q[1] = 0.0f; matrix::Quatf q(euler);
msg.q[2] = 0.0f;
msg.q[3] = 0.0f; msg.q[0] = q(0);
msg.q[1] = q(1);
msg.q[2] = q(2);
msg.q[3] = q(3);
msg.approach_x = 0.0f; msg.approach_x = 0.0f;
msg.approach_y = 0.0f; msg.approach_y = 0.0f;