diff --git a/src/laserPosegraphOptimization.cpp b/src/laserPosegraphOptimization.cpp index ce1a896..95765ca 100644 --- a/src/laserPosegraphOptimization.cpp +++ b/src/laserPosegraphOptimization.cpp @@ -478,7 +478,7 @@ void loopFindNearKeyframesCloud( pcl::PointCloud::Ptr& nearKeyframes, continue; mKF.lock(); - *nearKeyframes += * local2global(keyframeLaserClouds[keyNear], keyframePosesUpdated[root_idx]); + *nearKeyframes += * local2global(keyframeLaserClouds[keyNear], keyframePosesUpdated[keyNear]); mKF.unlock(); }