Reordered functions in manipulatorDynamics, got rid of out of date comment.
centerOfMassJacobianDotTimesV + test.