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

add matrix copyTo

Browse Source
This commit is contained in:
Daniel Agar
2017-02-24 13:49:45 -05:00
committed by Lorenz Meier
parent f43f3baa02
commit ecb2511a7b
6 changed files with 37 additions and 75 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/simulator/simulator_mavlink.cpp
+2 -6
View File
@@ -386,12 +386,8 @@ void Simulator::handle_message(mavlink_message_t *msg, bool publish)
{
hil_attitude.timestamp = timestamp;
math::Quaternion q(hil_state.attitude_quaternion);
hil_attitude.q[0] = q(0);
hil_attitude.q[1] = q(1);
hil_attitude.q[2] = q(2);
hil_attitude.q[3] = q(3);
matrix::Quatf q(hil_state.attitude_quaternion);
q.copyTo(hil_attitude.q);
hil_attitude.rollspeed = hil_state.rollspeed;
hil_attitude.pitchspeed = hil_state.pitchspeed;