mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 09:43:34 +08:00
6 lines
198 B
Matlab
6 lines
198 B
Matlab
% normalise the quaternion
|
|
function quaternion = normQuat(quaternion)
|
|
|
|
quatMag = sqrt(quaternion(1)^2 + quaternion(2)^2 + quaternion(3)^2 + quaternion(4)^2);
|
|
quaternion(1:4) = quaternion / quatMag;
|