Commit 1a88b254 authored by Vadim Pisarevsky's avatar Vadim Pisarevsky

Merge pull request #449 from Audenrith:EnableAccessToUKFErrorCovariance

parents 051759c1 6259c1e4
...@@ -80,6 +80,11 @@ public: ...@@ -80,6 +80,11 @@ public:
*/ */
virtual Mat getMeasurementNoiseCov() const = 0; virtual Mat getMeasurementNoiseCov() const = 0;
/**
* @return the error cross-covariance matrix.
*/
virtual Mat getErrorCov() const = 0;
/** /**
* @return the current estimate of the state. * @return the current estimate of the state.
*/ */
......
...@@ -195,6 +195,7 @@ public: ...@@ -195,6 +195,7 @@ public:
Mat getProcessNoiseCov() const; Mat getProcessNoiseCov() const;
Mat getMeasurementNoiseCov() const; Mat getMeasurementNoiseCov() const;
Mat getErrorCov() const;
Mat getState() const; Mat getState() const;
...@@ -425,6 +426,11 @@ Mat AugmentedUnscentedKalmanFilterImpl::getMeasurementNoiseCov() const ...@@ -425,6 +426,11 @@ Mat AugmentedUnscentedKalmanFilterImpl::getMeasurementNoiseCov() const
return measurementNoiseCov.clone(); return measurementNoiseCov.clone();
} }
Mat AugmentedUnscentedKalmanFilterImpl::getErrorCov() const
{
return errorCov.clone();
}
Mat AugmentedUnscentedKalmanFilterImpl::getState() const Mat AugmentedUnscentedKalmanFilterImpl::getState() const
{ {
return state.clone(); return state.clone();
......
...@@ -189,6 +189,7 @@ public: ...@@ -189,6 +189,7 @@ public:
// Get system parameters // Get system parameters
Mat getProcessNoiseCov() const; Mat getProcessNoiseCov() const;
Mat getMeasurementNoiseCov() const; Mat getMeasurementNoiseCov() const;
Mat getErrorCov() const;
// Get the state estimate // Get the state estimate
Mat getState() const; Mat getState() const;
...@@ -400,6 +401,11 @@ Mat UnscentedKalmanFilterImpl::getMeasurementNoiseCov() const ...@@ -400,6 +401,11 @@ Mat UnscentedKalmanFilterImpl::getMeasurementNoiseCov() const
return measurementNoiseCov.clone(); return measurementNoiseCov.clone();
} }
Mat UnscentedKalmanFilterImpl::getErrorCov() const
{
return errorCov.clone();
}
Mat UnscentedKalmanFilterImpl::getState() const Mat UnscentedKalmanFilterImpl::getState() const
{ {
return state.clone(); return state.clone();
......
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