From 81d9ae690a99b5865a8d3033bc1fd0adacfec026 Mon Sep 17 00:00:00 2001 From: NikolajDanger Date: Wed, 28 Sep 2022 13:58:59 +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 b8d7749..245bb27 100644 --- a/drive_between_arucos.py +++ b/drive_between_arucos.py @@ -61,7 +61,6 @@ def find_arucos(arlo): sleep((20 * TURN_T)/1000) arlo.stop() for key, value in aruco_dict.items(): - print(rot, value) aruco_dict[key] = np.dot(rot, value) return np.array(list(aruco_dict.values())[:2]) @@ -74,7 +73,7 @@ def main(): position = [ np.average(aruco_positions[:,0]), - np.average(aruco_positions[:,2]) + np.average(aruco_positions[:,1]) ] angle = np.rad2deg(np.arctan(position[0]/position[1]))