Added debug info

moveit · Nov 24, 2023 · 3d3422b · 3d3422b
1 parent aa7c508
commit 3d3422b
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/moveit_planners/ompl/ompl_interface/src/planning_context_manager.cpp b/moveit_planners/ompl/ompl_interface/src/planning_context_manager.cpp
@@ -98,6 +98,7 @@ bool MultiQueryPlannerAllocator::storePlannerData()
     planners_[entry.first]->getPlannerData(data);
     if (data.numVertices() == 0)
     {
+      RCLCPP_DEBUG_STREAM(LOGGER, "Could not fetch space information or space information is empty.");
       return false;
     }
     RCLCPP_INFO_STREAM(LOGGER, "Storing planner data. NumEdges: " << data.numEdges()