You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
6 lines
198 B
6 lines
198 B
10 years ago
|
% 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;
|