12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

And one more warning...

release/4.3a0
Frank 2015-05-12 15:07:49 -07:00
parent 057aef90d9
commit a585e8ac09
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
examples/SolverComparer.cpp
View File

@ -253,12 +253,12 @@ void runIncremental()
boost::dynamic_pointer_cast<BetweenFactor<Pose> >(datasetMeasurements[nextMeasurement])) boost::dynamic_pointer_cast<BetweenFactor<Pose> >(datasetMeasurements[nextMeasurement]))
{ {
Key key1 = measurement->key1(), key2 = measurement->key2(); Key key1 = measurement->key1(), key2 = measurement->key2();
if(((int)key1 >= firstStep && key1 < key2) || (key2 >= firstStep && key2 < key1)) { if(((int)key1 >= firstStep && key1 < key2) || ((int)key2 >= firstStep && key2 < key1)) {
// We found an odometry starting at firstStep // We found an odometry starting at firstStep
firstPose = std::min(key1, key2); firstPose = std::min(key1, key2);
break; break;
} }
if(((int)key2 >= firstStep && key1 < key2) || (key1 >= firstStep && key2 < key1)) { if(((int)key2 >= firstStep && key1 < key2) || ((int)key1 >= firstStep && key2 < key1)) {
// We found an odometry joining firstStep with a previous pose // We found an odometry joining firstStep with a previous pose
havePreviousPose = true; havePreviousPose = true;
firstPose = std::max(key1, key2); firstPose = std::max(key1, key2);