Bug fix in SolverComparer
parent
622a450a0c
commit
69a98bc37b
|
|
@ -276,7 +276,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