diff --git a/src/drone_controls/test/test_positionchanger.py b/src/drone_controls/test/test_positionchanger.py index 41ef19ee..49138fef 100644 --- a/src/drone_controls/test/test_positionchanger.py +++ b/src/drone_controls/test/test_positionchanger.py @@ -112,7 +112,8 @@ class TestPositionChanger(unittest.TestCase): - def test_positionchanger_lidar_stops(self,positionchanger_node,proc_output): + def test_positionchanger_lidar_stops(self,positionchanger_node,proc_output): + self.node.get_logger().info("STARTING TEST test_positionchanger_lidar_stops") self.received_failsafe_callback = False self.called_positionchanger_service = False failsafe_subscriber = self.node.create_subscription(FailsafeMsg,'/drone/failsafe',self.failsafe_callback_timeout,10) @@ -138,11 +139,14 @@ class TestPositionChanger(unittest.TestCase): # wait for nodes to become active time.sleep(3) + + self.node.get_logger().info('STARTING WHILE LOOP') # wait 5 seconds for the failsafe to trigger wait_time = time.time() + 5.0 end_time = time.time() + 10.0 try: while time.time() < end_time: + print("yeet") rclpy.spin_once(self.node) # send 5 lidar messages and after that stop if (lidar_messages_published < 5): @@ -156,12 +160,12 @@ class TestPositionChanger(unittest.TestCase): future.add_done_callback(self.move_position_callback) elif not self.received_failsafe_callback: continue - else: - break + self.node.get_logger().info('END OF WHILE LOOP') self.assertTrue(self.called_positionchanger_service, "MovePosition service was not called!") self.assertTrue(self.received_failsafe_callback, "Failsafe was not activated!") finally: + self.node.get_logger().info('Cleaning up') self.node.destroy_client(move_position_client) self.node.destroy_subscription(failsafe_subscriber) self.node.destroy_publisher(lidar_publisher)