@@ -1506,6 +1506,14 @@ controller_interface::return_type ControllerManager::switch_controller_cb(
1506
1506
? " AUTO"
1507
1507
: " FORCE_AUTO" ));
1508
1508
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
+
1509
1517
const auto list_controllers =
1510
1518
[this , strictness, &strictness_string](
1511
1519
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(
1526
1534
is_activate
1527
1535
? controller_chain_dependency_graph_.get_dependencies_to_activate (controller)
1528
1536
: controller_chain_dependency_graph_.get_dependencies_to_deactivate (controller);
1529
- RCLCPP_INFO (
1537
+ RCLCPP_DEBUG (
1530
1538
get_logger (), fmt::format (
1531
1539
" Controller {} has '{}' dependencies to {}" , controller,
1532
1540
fmt::join (ctrl_dependencies, " , " ), action)
@@ -1599,12 +1607,17 @@ controller_interface::return_type ControllerManager::switch_controller_cb(
1599
1607
return ret;
1600
1608
}
1601
1609
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);
1602
1613
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 ());
1605
1617
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 ());
1608
1621
1609
1622
// If it is a best effort switch, we can remove the controllers log that could not be activated
1610
1623
message.clear ();
@@ -4413,16 +4426,16 @@ void ControllerManager::build_controllers_topology_info(
4413
4426
}
4414
4427
for (const auto & [controller_name, controller_chain] : controller_chain_spec_)
4415
4428
{
4416
- RCLCPP_INFO (
4429
+ RCLCPP_DEBUG (
4417
4430
get_logger (), " Controller '%s' has %ld following controllers and %ld preceding controllers." ,
4418
4431
controller_name.c_str (), controller_chain.following_controllers .size (),
4419
4432
controller_chain.preceding_controllers .size ());
4420
- RCLCPP_INFO_EXPRESSION (
4433
+ RCLCPP_DEBUG_EXPRESSION (
4421
4434
get_logger (), !controller_chain.following_controllers .empty (),
4422
4435
fmt::format (
4423
4436
" \t Following controllers are : {}" , fmt::join (controller_chain.following_controllers , " , " ))
4424
4437
.c_str ());
4425
- RCLCPP_INFO_EXPRESSION (
4438
+ RCLCPP_DEBUG_EXPRESSION (
4426
4439
get_logger (), !controller_chain.preceding_controllers .empty (),
4427
4440
fmt::format (
4428
4441
" \t Preceding controllers are : {}" , fmt::join (controller_chain.preceding_controllers , " , " ))
0 commit comments