pi/ar_basalt
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

v01

Browse Source
This commit is contained in:
Ivan
2022-04-05 11:42:28 +03:00
commit 6dc0eb0fcf
5565 changed files with 1200500 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
thirdparty/opengv/matlab/helpers/cayley2rot.m vendored Normal file
View File

@@ -0,0 +1,20 @@
function R = cayley2rot(v)
cayley0 = v(1,1);
cayley1 = v(2,1);
cayley2 = v(3,1);
R = zeros(3,3);
scale = 1+cayley0^2+cayley1^2+cayley2^2;
R(1,1) = 1+cayley0^2-cayley1^2-cayley2^2;
R(1,2) = 2*(cayley0*cayley1-cayley2);
R(1,3) = 2*(cayley0*cayley2+cayley1);
R(2,1) = 2*(cayley0*cayley1+cayley2);
R(2,2) = 1-cayley0^2+cayley1^2-cayley2^2;
R(2,3) = 2*(cayley1*cayley2-cayley0);
R(3,1) = 2*(cayley0*cayley2-cayley1);
R(3,2) = 2*(cayley1*cayley2+cayley0);
R(3,3) = 1-cayley0^2-cayley1^2+cayley2^2;
R = (1/scale) * R;