From a3ce01a11a585d79d793d75e9d25a4dd366e6c84 Mon Sep 17 00:00:00 2001 From: thomaspeyrucain Date: Thu, 14 Aug 2025 17:50:50 +0200 Subject: [PATCH] Fix ERROR stream + check only active controllers --- .../src/controller_manager_plugin.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/moveit_plugins/moveit_ros_control_interface/src/controller_manager_plugin.cpp b/moveit_plugins/moveit_ros_control_interface/src/controller_manager_plugin.cpp index 349a97d478..2f2667460a 100644 --- a/moveit_plugins/moveit_ros_control_interface/src/controller_manager_plugin.cpp +++ b/moveit_plugins/moveit_ros_control_interface/src/controller_manager_plugin.cpp @@ -596,11 +596,11 @@ class Ros2ControlManager : public moveit_controller_manager::MoveItControllerMan dependency_map_reverse_.clear(); for (auto& controller : result->controller) { - if (controller.chain_connections.size() > 1) + if (isActive(controller) && controller.chain_connections.size() > 1) { RCLCPP_ERROR_STREAM(getLogger(), - "Controller with name %s chains to more than one controller. Chaining to more than " - "one controller is not supported."); + "Controller with name " << controller.name << " chains to more than one controller. " + "Chaining to more than one controller is not supported."); return false; } for (const auto& chained_controller : controller.chain_connections)