diff --git a/field_friend/automations/navigation/navigation.py b/field_friend/automations/navigation/navigation.py index 388b6cf3..47493b1e 100644 --- a/field_friend/automations/navigation/navigation.py +++ b/field_friend/automations/navigation/navigation.py @@ -88,8 +88,12 @@ async def _drive_to_yaw(self, distance: float, yaw: float): await self.driver.wheels.drive(*self.driver._throttle(1, yaw)) # pylint: disable=protected-access try: while self.odometer.prediction.point.distance(start_position) < distance: + # FIXME: ggf. deadline erhöhen if rosys.time() >= deadline: - raise TimeoutError('Driving Timeout') + self.log.error( + f'Driving Timeout at startpoint: {start_position} with yaw: {yaw} and target point: {self.odometer.prediction.point}') + break + # raise TimeoutError('Driving Timeout') await rosys.sleep(0.01) finally: await self.driver.wheels.stop()