mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-03 01:50:24 +08:00
fixed a seg fault
This commit is contained in:
@@ -3717,7 +3717,7 @@ bool Rtabmap::process(
|
|||||||
refWordsCount = (int)signature->getWords().size();
|
refWordsCount = (int)signature->getWords().size();
|
||||||
refUniqueWordsCount = (int)uUniqueKeys(signature->getWords()).size();
|
refUniqueWordsCount = (int)uUniqueKeys(signature->getWords()).size();
|
||||||
|
|
||||||
if(_graphOptimizer->isSlam2d())
|
if(_graphOptimizer->isSlam2d() && _localizationCovariance.total() == 36)
|
||||||
{
|
{
|
||||||
// set very small
|
// set very small
|
||||||
_localizationCovariance.at<double>(2,2) = Registration::COVARIANCE_LINEAR_EPSILON;
|
_localizationCovariance.at<double>(2,2) = Registration::COVARIANCE_LINEAR_EPSILON;
|
||||||
|
|||||||
Reference in New Issue
Block a user