ICP correspondence ratio set to 0 when maximum laser scan count is not set

This commit is contained in:
matlabbe
2015-08-05 20:16:27 -04:00
parent b90b46e5ac
commit a88e8dd013
3 changed files with 3 additions and 3 deletions

View File

@@ -130,7 +130,7 @@ public:
from_,
link.to(),
type_,
transform_ * link.transform(),
transform_ * link.transform(), // FIXME, should be inf1^-1(inf1*t1 + inf2*t2)
infMatrix_ + link.infMatrix());
}