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

9 lines
139 B
Matlab
Executable File

function m = adj_transf(v)
t1 = vec2skewSymMat(v(1:3,1));
t2 = vec2skewSymMat(v(4:6,1));
m = [t2, t1;
zeros(3,3), t2];
end