Commit 2238e711 authored by Nghia Ho's avatar Nghia Ho

Copied errorCovPre to errorCovPost. This allows the correct behaviour of the…

Copied errorCovPre to errorCovPost. This allows the correct behaviour of the uncertainty to grow when there is missing data for each predict step.
parent d50f0d2e
......@@ -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;
}
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment