Dynamic-Calibration/utils/screw utils/tw2tw_cord.m

11 lines
238 B
Mathematica
Raw Normal View History

2019-12-18 11:25:45 +00:00
function xi = tw2tw_cord(m)
%VEE_OPERATOR - extracts twist coordinates from a matrix m representing
%twist
xi = zeros(6,1);
xi(1:3,1) = m(1:3,4);
xi(4,1) = m(3,2);
xi(5,1) = m(1,3);
xi(6,1) = m(2,1);
end