Merge branch 'master' of github.com:introlab/rtabmap into devel

This commit is contained in:
matlabbe
2016-06-27 16:08:53 -04:00

View File

@@ -262,7 +262,7 @@ Transform Odometry::process(SensorData & data, OdometryInfo * info)
double dt = previousStamp_>0.0f?data.stamp() - previousStamp_:0.0; double dt = previousStamp_>0.0f?data.stamp() - previousStamp_:0.0;
Transform guess = dt && guessFromMotion_?Transform::getIdentity():Transform(); Transform guess = dt && guessFromMotion_?Transform::getIdentity():Transform();
UASSERT(dt>0.0 || (dt == 0.0 && previousVelocityTransform_.isNull())); UASSERT_MSG(dt>0.0 || (dt == 0.0 && previousVelocityTransform_.isNull()), uFormat("dt=%f previous transform=%s", dt, previousVelocityTransform_.c_str()).c_str());
if(!previousVelocityTransform_.isNull()) if(!previousVelocityTransform_.isNull())
{ {
if(guessFromMotion_) if(guessFromMotion_)