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]),