mirror of
https://github.com/introlab/rtabmap.git
synced 2026-10-07 10:37:47 +08:00
reprocess: fixed crash when odometry returns empty covariance. Also added more checks about that in the code in general.
This commit is contained in:
@@ -858,7 +858,7 @@ SensorData DBReader::getNextData(SensorCaptureInfo * info)
|
||||
info->odomPose = pose;
|
||||
info->odomCovariance = infMatrix.inv();
|
||||
info->odomVelocity = s->getVelocity();
|
||||
UDEBUG("odom variance = %f/%f", info->odomCovariance.at<double>(0,0), info->odomCovariance.at<double>(5,5));
|
||||
UDEBUG("odom variance = %f/%f", info->odomCovariance.empty()?0:info->odomCovariance.at<double>(0,0), info->odomCovariance.empty()?0:info->odomCovariance.at<double>(5,5));
|
||||
}
|
||||
}
|
||||
delete s;
|
||||
|
||||
Reference in New Issue
Block a user