diff --git a/gz_ros2_control/src/gz_ros2_control_plugin.cpp b/gz_ros2_control/src/gz_ros2_control_plugin.cpp index f2585935..c1c8fb03 100644 --- a/gz_ros2_control/src/gz_ros2_control_plugin.cpp +++ b/gz_ros2_control/src/gz_ros2_control_plugin.cpp @@ -297,6 +297,11 @@ void GazeboSimROS2ControlPlugin::Configure( // Get controller manager node name std::string controllerManagerNodeName{"controller_manager"}; + + if (sdfPtr->HasElement("controller_manager_name")) { + controllerManagerNodeName = sdfPtr->GetElement("controller_manager_name")->Get(); + } + std::string ns = "/"; // Hold joints if no control mode is active?