Add computeCoMVelocity function.