Bug fix in SolverComparer
parent
165e0b8797
commit
2321952f0a
|
@ -289,7 +289,7 @@ void runIncremental()
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
if(!newVariables.exists(measurement->key1())) { // Only need to check newVariables since loop closures come after odometry
|
if(!newVariables.exists(measurement->key2())) { // Only need to check newVariables since loop closures come after odometry
|
||||||
if(step == 1)
|
if(step == 1)
|
||||||
newVariables.insert(measurement->key2(), measurement->measured());
|
newVariables.insert(measurement->key2(), measurement->measured());
|
||||||
else {
|
else {
|
||||||
|
|
Loading…
Reference in New Issue