chore(nav2_behavior_tree): log actual wait period in bt_action_node (r…

…os-navigation#4178)

Signed-off-by: Felix <felix@fzeltner.de>
Co-authored-by: Felix <felix@fzeltner.de>
Signed-off-by: enricosutera <enricosutera@outlook.com>

nav2_behavior_tree/include/nav2_behavior_tree/bt_action_node.hpp

@@ -97,8 +97,9 @@ class BtActionNode : public BT::ActionNodeBase
  RCLCPP_DEBUG(node_->get_logger(), "Waiting for \"%s\" action server", action_name.c_str());
  if (!action_client_->wait_for_action_server(wait_for_service_timeout_)) {
  RCLCPP_ERROR(
- node_->get_logger(), "\"%s\" action server not available after waiting for 1 s",
- action_name.c_str());
+ node_->get_logger(), "\"%s\" action server not available after waiting for %f s",
+ action_name.c_str(),
+ wait_for_service_timeout_.count() / 1000.0);
  throw std::runtime_error(
  std::string("Action server ") + action_name +
  std::string(" not available"));