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:
parent
d50f0d2ed2
commit
2238e711b5
@ -266,6 +266,7 @@ const Mat& KalmanFilter::predict(const Mat& control)
|
|||||||
|
|
||||||
// handle the case when there will be measurement before the next predict.
|
// handle the case when there will be measurement before the next predict.
|
||||||
statePre.copyTo(statePost);
|
statePre.copyTo(statePost);
|
||||||
|
errorCovPre.copyTo(errorCovPost);
|
||||||
|
|
||||||
return statePre;
|
return statePre;
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user