From 03e9b2f20f8f8584f69f18b71bfc179517e30c78 Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Mon, 15 May 2023 09:55:18 +0200 Subject: [PATCH] add logs after connecting to services --- src/test_controls/test_controls/test_controller.py | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/src/test_controls/test_controls/test_controller.py b/src/test_controls/test_controls/test_controller.py index 0852d893..b2b53fca 100644 --- a/src/test_controls/test_controls/test_controller.py +++ b/src/test_controls/test_controls/test_controller.py @@ -17,16 +17,20 @@ class TestController(Node): self.cli = self.create_client(SetAttitude, 'drone/set_attitude') while not self.cli.wait_for_service(timeout_sec=1.0): self.get_logger().info('set attitude service not available, waiting again...') + self.get_logger().info('successfully connected to set attitude service') self.vehicle_control_cli = self.create_client( SetVehicleControl, '/drone/set_vehicle_control') while not self.vehicle_control_cli.wait_for_service(timeout_sec=1.0): self.get_logger().info('set vehicle control service not available, waiting again...') + self.get_logger().info('successfully connected to set vehicle control service') self.traj_cli = self.create_client(SetTrajectory, '/drone/set_trajectory') while not self.traj_cli.wait_for_service(timeout_sec=1.0): self.get_logger().info('set trajectory service not available, waiting again...') + self.get_logger().info('successfully connected to set trajectory service') self.arm_cli = self.create_client(Empty, '/drone/arm') while not self.arm_cli.wait_for_service(timeout_sec=1.0): self.get_logger().info('arm service not available, waiting again...') + self.get_logger().info('successfully connected to arm service') self.get_logger().info('all services available') self.control_mode = 1