@@ -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)
@@ -1598,12 +1606,17 @@ controller_interface::return_type ControllerManager::switch_controller_cb(
1598
1606
return ret;
1599
1607
}
1600
1608
1609
+ const bool print_updated_list =
1610
+ (strictness != controller_manager_msgs::srv::SwitchController::Request::AUTO ||
1611
+ strictness != controller_manager_msgs::srv::SwitchController::Request::FORCE_AUTO);
1601
1612
RCLCPP_INFO_EXPRESSION (
1602
- get_logger (), !activate_request_.empty (),
1603
- fmt::format (" Activating controllers: [ {} ]" , fmt::join (activate_request_, " " )).c_str ());
1613
+ get_logger (), !activate_request_.empty () && print_updated_list,
1614
+ fmt::format (" Updated Activating controllers: [ {} ]" , fmt::join (activate_request_, " " ))
1615
+ .c_str ());
1604
1616
RCLCPP_INFO_EXPRESSION (
1605
- get_logger (), !deactivate_request_.empty (),
1606
- fmt::format (" Deactivating controllers: [ {} ]" , fmt::join (deactivate_request_, " " )).c_str ());
1617
+ get_logger (), !deactivate_request_.empty () && print_updated_list,
1618
+ fmt::format (" Updated Deactivating controllers: [ {} ]" , fmt::join (deactivate_request_, " " ))
1619
+ .c_str ());
1607
1620
1608
1621
// If it is a best effort switch, we can remove the controllers log that could not be activated
1609
1622
message.clear ();
@@ -4412,16 +4425,16 @@ void ControllerManager::build_controllers_topology_info(
4412
4425
}
4413
4426
for (const auto & [controller_name, controller_chain] : controller_chain_spec_)
4414
4427
{
4415
- RCLCPP_INFO (
4428
+ RCLCPP_DEBUG (
4416
4429
get_logger (), " Controller '%s' has %ld following controllers and %ld preceding controllers." ,
4417
4430
controller_name.c_str (), controller_chain.following_controllers .size (),
4418
4431
controller_chain.preceding_controllers .size ());
4419
- RCLCPP_INFO_EXPRESSION (
4432
+ RCLCPP_DEBUG_EXPRESSION (
4420
4433
get_logger (), !controller_chain.following_controllers .empty (),
4421
4434
fmt::format (
4422
4435
" \t Following controllers are : {}" , fmt::join (controller_chain.following_controllers , " , " ))
4423
4436
.c_str ());
4424
- RCLCPP_INFO_EXPRESSION (
4437
+ RCLCPP_DEBUG_EXPRESSION (
4425
4438
get_logger (), !controller_chain.preceding_controllers .empty (),
4426
4439
fmt::format (
4427
4440
" \t Preceding controllers are : {}" , fmt::join (controller_chain.preceding_controllers , " , " ))
0 commit comments