Add debug print of reordered controllers list once they are sorted

ros-controls · Jun 28, 2023 · 8ecd9fd · 8ecd9fd
1 parent ca05f77
commit 8ecd9fd
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/controller_manager/src/controller_manager.cpp b/controller_manager/src/controller_manager.cpp
@@ -1149,6 +1149,12 @@ controller_interface::return_type ControllerManager::switch_controller(
       &ControllerManager::controller_sorting, this, std::placeholders::_1, std::placeholders::_2,
       to));
 
+  RCLCPP_DEBUG(get_logger(), "Reordered controllers list is:");
+  for (const auto & ctrl : to)
+  {
+    RCLCPP_DEBUG(this->get_logger(), "\t%s", ctrl.info.name.c_str());
+  }
+
   // switch lists
   rt_controllers_wrapper_.switch_updated_list(guard);
   // clear unused list