9 lines
250 B
Mathematica
9 lines
250 B
Mathematica
|
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);
|