mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 17:40:23 +08:00
Fix 6DoF graph angular check (#1511)
* Fix 6DoF graph angular check * Updated getAngle to use better version
This commit is contained in:
@@ -217,7 +217,7 @@ Transform OdometryDVO::computeTransform(
|
||||
t = motionFromKeyFrame_.inverse() * t;
|
||||
|
||||
// TODO make parameters?
|
||||
if(currentMotion.getNorm() > 0.01 || currentMotion.getAngle() > 0.01)
|
||||
if(currentMotion.getNorm() > 0.01 || currentMotion.getAngle(Transform::getIdentity()) > 0.01)
|
||||
{
|
||||
if(info)
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user