✨

drive_between_arucos.py

@@ -42,7 +42,6 @@ def find_arucos(arlo):
     while True:
         arucos = find_aruco(arlo.take_photo())
         if arucos != []:
-            print(arucos)
             for aruco, id_ in arucos:
                 aruco_dict[id_] = aruco
 
@@ -52,7 +51,7 @@ def find_arucos(arlo):
         sleep(0.3)
         arlo.stop()
 
-    return list(arucos.items())[:2]
+    return list(aruco_dict.items())[:2]
 
 def main():
     arlo = Robot()