✨

2022-10-26 14:30:13 +02:00
parent 0e46b0dbe2
commit ef5f297a47
2 changed files with 5 additions and 2 deletions
--- a/rally2.py
+++ b/rally2.py
@ -235,8 +235,8 @@ def main():
        print(f"Going to landmark {landmark}")
        while True:
            particles, est_pose = look_around(noah, particles, cam, est_pose)
-            particles, est_pose = turn_towards_landmark(
-                noah, particles, est_pose, landmark)
+            print(est_pose)
+            particles, est_pose = turn_towards_landmark(noah, particles, est_pose, landmark)
            drive_time = time_to_landmark(est_pose, landmark)
            if not abs(drive_until_stopped(noah) - drive_time) < 0.5:
                drunk_drive(noah)