Add momentum and normalMomentumDot to CentroidalMomentumMatrix method.