diff --git a/libs/vision/src/CDifodo.cpp b/libs/vision/src/CDifodo.cpp index 24317923cf..1d9a52501f 100644 --- a/libs/vision/src/CDifodo.cpp +++ b/libs/vision/src/CDifodo.cpp @@ -883,7 +883,7 @@ void CDifodo::filterLevelSolution() CMatrixFloat66 Bii; std::vector eigenVals; - if (est_cov.eig_symmetric(Bii, eigenVals)) + if (!est_cov.eig_symmetric(Bii, eigenVals)) { std::cerr << "\n Eigensolver couldn't find a solution. Pose is not updated\n";