diff --git a/drive_between_arucos.py b/drive_between_arucos.py index 47086c3..c091fcf 100644 --- a/drive_between_arucos.py +++ b/drive_between_arucos.py @@ -57,6 +57,7 @@ def main(): arlo = Robot() arucos = find_arucos(arlo) + print(arucos) aruco_positions = np.array([cv2.aruco.estimatePoseSingleMarkers( np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF )[1][0][0] for aruco in arucos])