Completed all the matrices necessary to update the covariance matrix in CovarianceMatrix.addFeature().
Completed the CovarianceMatrix.addFeature() method.