diff --git a/moveit_planners/ompl/ompl_interface/src/planning_context_manager.cpp b/moveit_planners/ompl/ompl_interface/src/planning_context_manager.cpp index b8e0d4d5ba8..b5b11fc640b 100644 --- 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()