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

6 lines
130 B
Matlab
Executable File

function Vb = velocity_b(xi_hat,theta_d, g0)
xi = tw2tw_cord(xi_hat);
Vb = tw_cord2tw((inv_adj_transf(g0)*xi))*theta_d;
end