Now using centerOfMassJacobianDotTimesV in QPControlBlock. Still need to do DotTimesV for terrainContactPoints.
Added terrainContactJacobianDotTimesV + test. Test currently fails for quat parameterization. Probably related to forwardJacDotTimesV test failure.
Now using terrainContactJacobianDotTimesV in QPControlBlock.