diff --git a/drive_between_arucos.py b/drive_between_arucos.py index f5867a7..0f24b9a 100644 --- a/drive_between_arucos.py +++ b/drive_between_arucos.py @@ -50,7 +50,9 @@ def find_arucos(arlo): print(f"found box {id_}") position = cv2.aruco.estimatePoseSingleMarkers( np.array([aruco]), 14.5, CAMERA_MATRIX, DIST_COEF - )[1][0][0] + ) + print(position) + exit() position = np.array([position[0], position[1]]) position[0] += 22.5 print(id_, position) @@ -70,8 +72,6 @@ def main(): arlo = Robot() aruco_positions = find_arucos(arlo) - print(aruco_positions) - position = [ np.average(aruco_positions[:,0]), np.average(aruco_positions[:,1])