mirror of
https://github.com/modelec/detection_pot.git
synced 2026-01-19 00:57:28 +01:00
80 lines
2.3 KiB
Python
80 lines
2.3 KiB
Python
import cv2 as cv
|
|
import cv2.aruco as aruco
|
|
import numpy as np
|
|
|
|
# Taille du tag aruco
|
|
ARUCO_WIDTH = 2.5
|
|
|
|
# Focal de la cam
|
|
# Calculer la focal avec le fichier get_the_focal.py
|
|
FOCAL_LENGTH = 600
|
|
|
|
arucoTagMapping = {
|
|
47: ["Solar Panel", 2.2],
|
|
36: ["White flower", 2.5],
|
|
13: ["Purple Flower", 1.8]
|
|
}
|
|
|
|
# Charger une image depuis la caméra (0 pour la caméra par défaut, généralement la webcam)
|
|
cap = cv.VideoCapture(0)
|
|
|
|
# Définir le dictionnaire ArUco
|
|
aruco_dict = aruco.getPredefinedDictionary(aruco.DICT_4X4_50)
|
|
|
|
# Créer le détecteur ArUco
|
|
parameters = aruco.DetectorParameters()
|
|
|
|
#
|
|
detector = aruco.ArucoDetector(aruco_dict, parameters)
|
|
|
|
while True:
|
|
# Lire une image depuis la caméra
|
|
ret, frame = cap.read()
|
|
|
|
# Convertir l'image en niveaux de gris
|
|
gray = cv.cvtColor(frame, cv.COLOR_BGR2GRAY)
|
|
|
|
# Détecter les marqueurs ArUco
|
|
corners, ids, rejectedImgPoints = detector.detectMarkers(gray)
|
|
|
|
# Dessiner les résultats
|
|
if ids is not None:
|
|
aruco.drawDetectedMarkers(frame, corners, ids)
|
|
|
|
for i in range(len(ids)):
|
|
|
|
if len(corners) > 0:
|
|
ids = ids.flatten()
|
|
for (markerCorner, markerID) in zip(corners, ids):
|
|
|
|
if markerID not in arucoTagMapping:
|
|
continue
|
|
|
|
corners = markerCorner.reshape((4, 2))
|
|
(topLeft, topRight, bottomRight, bottomLeft) = corners
|
|
|
|
|
|
topRight = (int(topRight[0]), int(topRight[1]))
|
|
bottomRight = (int(bottomRight[0]), int(bottomRight[1]))
|
|
bottomLeft = (int(bottomLeft[0]), int(bottomLeft[1]))
|
|
topLeft = (int(topLeft[0]), int(topLeft[1]))
|
|
|
|
# Calculate the apparent width in pixels
|
|
P = np.sqrt((topRight[0] - topLeft[0]) ** 2 + (topRight[1] - topLeft[1]) ** 2)
|
|
|
|
# Calculate the distance to the Aruco tag
|
|
D = (arucoTagMapping[markerID][1] * FOCAL_LENGTH) / P
|
|
|
|
print(f"Distance to : {arucoTagMapping[markerID][0]} : {D} cm")
|
|
|
|
# Afficher l'image
|
|
cv.imshow('Frame', frame)
|
|
|
|
# Sortir de la boucle si la touche 'q' est enfoncée
|
|
if cv.waitKey(1) & 0xFF == ord('q'):
|
|
break
|
|
|
|
# Libérer la capture et fermer la fenêtre
|
|
cap.release()
|
|
cv.destroyAllWindows()
|