9 lines
174 B
Matlab
9 lines
174 B
Matlab
|
function q = qnormlz(q)
|
||
|
|
% 四元数归一化
|
||
|
|
q = q/norm(q);
|
||
|
|
if(q(1)<0)
|
||
|
|
q(1) = -q(1);
|
||
|
|
q(2) = -q(2);
|
||
|
|
q(3) = -q(3);
|
||
|
|
q(4) = -q(4);
|
||
|
|
end
|