From 0cb11b52648bc75ee018a696b16565d9c221c3e5 Mon Sep 17 00:00:00 2001 From: NikolajDanger Date: Wed, 28 Sep 2022 14:01:11 +0200 Subject: [PATCH] :sparkles: --- drive_between_arucos.py | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/drive_between_arucos.py b/drive_between_arucos.py index f5867a7..0f24b9a 100644 --- a/drive_between_arucos.py +++ b/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])