diff --git a/src/drone_controls/src/PositionChanger.cpp b/src/drone_controls/src/PositionChanger.cpp index 06bd860f..861429f1 100644 --- a/src/drone_controls/src/PositionChanger.cpp +++ b/src/drone_controls/src/PositionChanger.cpp @@ -56,11 +56,11 @@ public: this->failsafe_client = this->create_client("/drone/enable_failsafe"); RCLCPP_INFO(this->get_logger(), "waiting for trajectory service..."); - wait_for_service::SharedPtr>(this->trajectory_client); + wait_for_service::SharedPtr>(this->trajectory_client, "/drone/set_trajectory"); RCLCPP_INFO(this->get_logger(), "waiting for vehicle control service..."); - wait_for_service::SharedPtr>(this->vehicle_control_client); + wait_for_service::SharedPtr>(this->vehicle_control_client, "/drone/set_vehicle_control"); RCLCPP_INFO(this->get_logger(), "waiting for failsafe service..."); - wait_for_service::SharedPtr>(this->failsafe_client); + wait_for_service::SharedPtr>(this->failsafe_client, "/drone/enable_failsafe"); this->trajectory_request = std::make_shared(); this->vehicle_control_request = std::make_shared(); @@ -374,7 +374,7 @@ private: * @param client the client object to wait for the service */ template - void wait_for_service(T client) + void wait_for_service(T client, std::string service_name) { while (!client->wait_for_service(1s)) { @@ -383,7 +383,7 @@ private: RCLCPP_ERROR(this->get_logger(), "Interrupted while waiting for the service. Exiting."); return; } - RCLCPP_INFO(this->get_logger(), "service not available, waiting again..."); + RCLCPP_INFO(this->get_logger(), "service not available, waiting again on service %s", service_name.c_str()); } } };