mirror of https://github.com/ArduPilot/ardupilot
6 lines
198 B
Mathematica
6 lines
198 B
Mathematica
|
% 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;
|