diff --git a/drive_between_arucos.py b/drive_between_arucos.py index 245bb27..f5867a7 100644 --- a/drive_between_arucos.py +++ b/drive_between_arucos.py @@ -53,6 +53,7 @@ def find_arucos(arlo): )[1][0][0] position = np.array([position[0], position[1]]) position[0] += 22.5 + print(id_, position) aruco_dict[id_] = position if len(aruco_dict) >= 2: