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

6 lines
130 B
Mathematica
Raw Normal View History

2019-12-18 11:25:45 +00:00
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