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

vmount: use copyTo to copy quaternions

Browse Source
This commit is contained in:
Julian Oes
2021-02-04 08:12:35 +01:00
committed by Daniel Agar
parent f39216b9c3
commit a2d419c91a
2 changed files with 2 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/vmount/input_mavlink.cpp
+1 -4
View File
@@ -861,10 +861,7 @@ void InputMavlinkGimbalV2::_set_control_data_from_set_attitude(const uint32_t fl
} else {
_control_data.type = ControlData::Type::Angle;
_control_data.type_data.angle.q[0] = q(0);
_control_data.type_data.angle.q[1] = q(1);
_control_data.type_data.angle.q[2] = q(2);
_control_data.type_data.angle.q[3] = q(3);
q.copyTo(_control_data.type_data.angle.q);
_control_data.type_data.angle.angular_velocity[0] = angular_velocity(0);
_control_data.type_data.angle.angular_velocity[1] = angular_velocity(1);