✨

drive_between_arucos.py

@@ -50,7 +50,9 @@ def find_arucos(arlo):
                     print(f"found box {id_}")
                     position = cv2.aruco.estimatePoseSingleMarkers(
                         np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF
-                    )[1][0][0]
+                    )
+                    print(position)
+                    exit()
                     position = np.array([position[0], position[1]])
                     position[0] += 22.5
                     print(id_, position)
@@ -70,8 +72,6 @@ def main():
     arlo = Robot()
     aruco_positions = find_arucos(arlo)
 
-    print(aruco_positions)
-
     position = [
         np.average(aruco_positions[:,0]),
         np.average(aruco_positions[:,1])