Just renamed StateVector.getMatrix() to toMatrix() so as to be consistent with CovarianceMatrix.