13 lines
341 B
Mathematica
13 lines
341 B
Mathematica
|
function q = rv2q(rv) % <EFBFBD><EFBFBD>Ч<EFBFBD><EFBFBD>תʸ<EFBFBD><EFBFBD>ת<EFBFBD><EFBFBD>Ϊ<EFBFBD>任<EFBFBD><EFBFBD>Ԫ<EFBFBD><EFBFBD>
|
|||
|
|
nm2 = rv'*rv; % <EFBFBD><EFBFBD>תʸ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
|
|||
|
|
if nm2<1.0e-8 % <EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>С<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>̩<EFBFBD><EFBFBD>չ<EFBFBD><EFBFBD>ǰ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ǻ<EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
q0 = 1-nm2*(1/8-nm2/384);
|
|||
|
|
s = 1/2-nm2*(1/48-nm2/3840);
|
|||
|
|
else
|
|||
|
|
nm = sqrt(nm2);
|
|||
|
|
q0 = cos(nm/2);
|
|||
|
|
s = sin(nm/2)/nm;
|
|||
|
|
end
|
|||
|
|
q = [q0; s*rv];
|
|||
|
|
|