5
0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-15 12:23:58 -04:00
ardupilot/libraries/AP_NavEKF/Models/Common/NormQuat.m

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;