From 3d3422b6c63ee9aaae0c4674ccfef01facbc5f50 Mon Sep 17 00:00:00 2001 From: Shobuj Paul Date: Wed, 4 Oct 2023 19:55:11 +0530 Subject: [PATCH] Added debug info --- .../ompl/ompl_interface/src/planning_context_manager.cpp | 1 + 1 file changed, 1 insertion(+) 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()