Copied errorCovPre to errorCovPost. This allows the correct behaviour of the uncertainty to grow when there is missing data for each predict step.

This commit is contained in:
Nghia Ho 2013-10-20 13:00:11 +11:00
parent d50f0d2ed2
commit 2238e711b5

View File

@ -266,6 +266,7 @@ const Mat& KalmanFilter::predict(const Mat& control)
// handle the case when there will be measurement before the next predict.
statePre.copyTo(statePost);
errorCovPre.copyTo(errorCovPost);
return statePre;
}