diff --git a/rally.py b/rally.py index 6f59e8a..a1ea1a8 100644 --- a/rally.py +++ b/rally.py @@ -40,9 +40,14 @@ def find_aruco(image): def careful_forward(drive_time, arlo, careful_range = 600): start = time.time() + if drive_time > 3: + drive_time = 3 + hit_something = True + else: + hit_something = False + end = start + drive_time turning = None - hit_something = False while time.time() < end: forward_dist = arlo.read_front_ping_sensor() right_dist = arlo.read_right_ping_sensor()