i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 09:30:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

Memory: fixed cov->inf conversion error

Browse Source
This commit is contained in:
matlabbe
2017-07-13 11:07:00 -04:00
parent 19abbe0dbd
commit 1ed01b8d3d
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
corelib/src/Memory.cpp
View File

@@ -720,8 +720,8 @@ void Memory::addSignatureToStm(Signature * signature, const cv::Mat & covariance
{ {
UASSERT(covariance.cols == 6 && covariance.rows == 6 && covariance.type() == CV_64FC1); UASSERT(covariance.cols == 6 && covariance.rows == 6 && covariance.type() == CV_64FC1);
cv::Mat infMatrix = covariance.inv(); cv::Mat infMatrix = covariance.inv();
if((uIsFinite(covariance.at<double>(0,0) && covariance.at<double>(0,0)>0)) && if((uIsFinite(covariance.at<double>(0,0)) && covariance.at<double>(0,0)>0.0) &&
!(uIsFinite(infMatrix.at<double>(0,0) && infMatrix.at<double>(0,0)>0))) !(uIsFinite(infMatrix.at<double>(0,0)) && infMatrix.at<double>(0,0)>0.0))
{ {
UERROR("Failed to invert the covariance matrix! Covariance matrix should be invertible!"); UERROR("Failed to invert the covariance matrix! Covariance matrix should be invertible!");
std::cout << "Covariance: " << covariance << std::endl; std::cout << "Covariance: " << covariance << std::endl;