mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +08:00
Update SaveObjectsExample.cpp
This commit is contained in:
@@ -155,7 +155,6 @@ public:
|
||||
double stampB = nextNode->first;
|
||||
UASSERT(stamp>=stampA && stamp <=stampB);
|
||||
|
||||
rtabmap::Transform v = poseA.inverse() * poseB;
|
||||
double ratio = (stamp-stampA)/(stampB-stampA);
|
||||
rtabmap::Transform robotPose = poseA.interpolate(ratio, poseB);
|
||||
|
||||
|
||||
Reference in New Issue
Block a user