From f546e3f8f505bcfc044337dc9752fee25091edb8 Mon Sep 17 00:00:00 2001
From: NikolajDanger <nikolajgade@live.dk>
Date: Wed, 28 Sep 2022 14:03:26 +0200
Subject: [PATCH] :sparkles:

---
 drive_between_arucos.py | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/drive_between_arucos.py b/drive_between_arucos.py
index a28c83e..f47b129 100644
--- a/drive_between_arucos.py
+++ b/drive_between_arucos.py
@@ -52,9 +52,9 @@ def find_arucos(arlo):
                         np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF
                     )[1][0][0]
                     print(position)
-                    position = np.array([position[1], position[0]])
+                    position = np.array([position[2], position[0]])
                     position[0] += 22.5
-                    print(id_, position)
+                    print(position)
                     aruco_dict[id_] = position
 
             if len(aruco_dict) >= 2: