CoG fixes for cpBodyApply* and VelocityAt functions.