v01
This commit is contained in:
12
thirdparty/opengv/matlab/helpers/rot2cayley.m
vendored
Normal file
12
thirdparty/opengv/matlab/helpers/rot2cayley.m
vendored
Normal file
@@ -0,0 +1,12 @@
|
||||
function v = rot2cayley(R)
|
||||
|
||||
C1 = R-eye(3);
|
||||
C2 = R+eye(3);
|
||||
C = C1 * inv(C2);
|
||||
|
||||
v = zeros(3,1);
|
||||
v(1,1) = -C(2,3);
|
||||
v(2,1) = C(1,3);
|
||||
v(3,1) = -C(1,2);
|
||||
|
||||
end
|
||||
Reference in New Issue
Block a user