@@ -1506,6 +1506,14 @@ controller_interface::return_type ControllerManager::switch_controller_cb(
15061506 ? " AUTO"
15071507 : " FORCE_AUTO" ));
15081508
1509+ RCLCPP_INFO_EXPRESSION (
1510+ get_logger (), !activate_controllers.empty (),
1511+ fmt::format (" Activating controllers: [ {} ]" , fmt::join (activate_controllers, " " )).c_str ());
1512+ RCLCPP_INFO_EXPRESSION (
1513+ get_logger (), !deactivate_controllers.empty (),
1514+ fmt::format (" Deactivating controllers: [ {} ]" , fmt::join (deactivate_controllers, " " ))
1515+ .c_str ());
1516+
15091517 const auto list_controllers =
15101518 [this , strictness, &strictness_string](
15111519 const std::vector<std::string> & controller_list, std::vector<std::string> & request_list,
@@ -1526,7 +1534,7 @@ controller_interface::return_type ControllerManager::switch_controller_cb(
15261534 is_activate
15271535 ? controller_chain_dependency_graph_.get_dependencies_to_activate (controller)
15281536 : controller_chain_dependency_graph_.get_dependencies_to_deactivate (controller);
1529- RCLCPP_INFO (
1537+ RCLCPP_DEBUG (
15301538 get_logger (), fmt::format (
15311539 " Controller {} has '{}' dependencies to {}" , controller,
15321540 fmt::join (ctrl_dependencies, " , " ), action)
@@ -1599,12 +1607,17 @@ controller_interface::return_type ControllerManager::switch_controller_cb(
15991607 return ret;
16001608 }
16011609
1610+ const bool print_updated_list =
1611+ (strictness != controller_manager_msgs::srv::SwitchController::Request::AUTO ||
1612+ strictness != controller_manager_msgs::srv::SwitchController::Request::FORCE_AUTO);
16021613 RCLCPP_INFO_EXPRESSION (
1603- get_logger (), !activate_request_.empty (),
1604- fmt::format (" Activating controllers: [ {} ]" , fmt::join (activate_request_, " " )).c_str ());
1614+ get_logger (), !activate_request_.empty () && print_updated_list,
1615+ fmt::format (" Updated Activating controllers: [ {} ]" , fmt::join (activate_request_, " " ))
1616+ .c_str ());
16051617 RCLCPP_INFO_EXPRESSION (
1606- get_logger (), !deactivate_request_.empty (),
1607- fmt::format (" Deactivating controllers: [ {} ]" , fmt::join (deactivate_request_, " " )).c_str ());
1618+ get_logger (), !deactivate_request_.empty () && print_updated_list,
1619+ fmt::format (" Updated Deactivating controllers: [ {} ]" , fmt::join (deactivate_request_, " " ))
1620+ .c_str ());
16081621
16091622 // If it is a best effort switch, we can remove the controllers log that could not be activated
16101623 message.clear ();
@@ -4413,16 +4426,16 @@ void ControllerManager::build_controllers_topology_info(
44134426 }
44144427 for (const auto & [controller_name, controller_chain] : controller_chain_spec_)
44154428 {
4416- RCLCPP_INFO (
4429+ RCLCPP_DEBUG (
44174430 get_logger (), " Controller '%s' has %ld following controllers and %ld preceding controllers." ,
44184431 controller_name.c_str (), controller_chain.following_controllers .size (),
44194432 controller_chain.preceding_controllers .size ());
4420- RCLCPP_INFO_EXPRESSION (
4433+ RCLCPP_DEBUG_EXPRESSION (
44214434 get_logger (), !controller_chain.following_controllers .empty (),
44224435 fmt::format (
44234436 " \t Following controllers are : {}" , fmt::join (controller_chain.following_controllers , " , " ))
44244437 .c_str ());
4425- RCLCPP_INFO_EXPRESSION (
4438+ RCLCPP_DEBUG_EXPRESSION (
44264439 get_logger (), !controller_chain.preceding_controllers .empty (),
44274440 fmt::format (
44284441 " \t Preceding controllers are : {}" , fmt::join (controller_chain.preceding_controllers , " , " ))
0 commit comments