IRDYn/complie/R1000 EVT GravityForce V1/mr/BodyVelToLinearVel.m

9 lines
250 B
Matlab

function Vlinear = BodyVelToLinearVel(V,G)
% *** CHAPTER x: DYNAMICS OF OPEN CHAINS ***
% Takes V: Body frame velocity,
% G: Spactial frame G
% Returns Glist: Spatial inertia matrices Gi of the links
[R, p] = TransToRp(G);
Vlinear = R*V(4:6);