From 95c011e4e79ec2db6e7f596d965408c21f483ef2 Mon Sep 17 00:00:00 2001 From: NikolajDanger Date: Wed, 28 Sep 2022 14:04:25 +0200 Subject: [PATCH] :sparkles: --- drive_between_arucos.py | 3 +-- 1 file changed, 1 insertion(+), 2 deletions(-) diff --git a/drive_between_arucos.py b/drive_between_arucos.py index f47b129..b5cbafd 100644 --- a/drive_between_arucos.py +++ b/drive_between_arucos.py @@ -51,10 +51,8 @@ def find_arucos(arlo): position = cv2.aruco.estimatePoseSingleMarkers( np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF )[1][0][0] - print(position) position = np.array([position[2], position[0]]) position[0] += 22.5 - print(position) aruco_dict[id_] = position if len(aruco_dict) >= 2: @@ -70,6 +68,7 @@ def find_arucos(arlo): def main(): arlo = Robot() aruco_positions = find_arucos(arlo) + print(aruco_positions) position = [ np.average(aruco_positions[:,0]),