test

libs/voxel_map/libs/area/maparea.h

@@ -88,6 +88,7 @@ public:
     }
     inline bool IsMapLoaded(const Vector3d& pose)
     {
+        LOG(INFO) << "pose: " << pose.transpose();
         return currMesh_->IsAreaLoaded(pose);
     }
 

libs/voxel_map/libs/area/mesharea.h

@@ -71,6 +71,7 @@ public:
         if(!inited_){
             return false;
         }
+        LOG(INFO) << "pose: " << pose.transpose();
         double x = pose.x() - offset_.x();
         double y = pose.y() - offset_.y();
         Vector2i shiftedIndexToLoad =