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