From 4c75d2f56e732e94992ccc6e19757b5edcb5eadb Mon Sep 17 00:00:00 2001
From: Tylr-J42 <Tyler.Jacques00@gmail.com>
Date: Sat, 17 Aug 2024 17:56:37 -0400
Subject: [PATCH] aruco test

---
 FRC_Fiducial_Tracking/Aruco_Detection.py | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/FRC_Fiducial_Tracking/Aruco_Detection.py b/FRC_Fiducial_Tracking/Aruco_Detection.py
index ef078b1..d8c1ef0 100644
--- a/FRC_Fiducial_Tracking/Aruco_Detection.py
+++ b/FRC_Fiducial_Tracking/Aruco_Detection.py
@@ -1,5 +1,20 @@
 import cv2
 import numpy as np
+from Picam2Vid import Picam2Vid
 
 
 
+while True:
+    stream = Picam2Vid()
+    stream.update()
+    frame = cv2.imread(stream.read())
+    cv2.imshow('frame', frame)
+    cv2.waitKey(0)
+
+    tag36h11 = cv2.aruco.DICT_APRILTAG_36h11
+    params = cv2.aruco.DetectorParameters_create()
+
+    (corners, ids, rejcted) = cv2.aruco.detectMarkers(frame, tag36h11, parameters=params)
+    print(corners)
+    print(ids)
+