mavlink_receiver: odometry handler: simplify quaternion init

This commit is contained in:
TSC21
2018-07-12 21:42:11 +01:00
committed by Lorenz Meier
parent 607be6791c
commit 2f5b16a5d3
+1 -1
View File
@@ -1205,7 +1205,7 @@ MavlinkReceiver::handle_message_odometry(mavlink_message_t *msg)
odometry.z = odom.z;
/* The quaternion of the ODOMETRY msg represents a rotation from NED
* earth/local frame to XYZ body frame */
matrix::Quatf q(odom.q[0], odom.q[1], odom.q[2], odom.q[3]);
matrix::Quatf q(odom.q);
q.copyTo(odometry.q);
// create a method to simplify covariance copy