def Aptag_detect(cap):
# 读取视频帧,ret标志读取的结果,frame为读取到的视频帧图像
start = time.time()
ret, frame = cap.read()
gray = cv2.cvtColor(frame, cv2.COLOR_BGR2GRAY)
# Build a detector for apriltag
tag_detector = apriltag.Detector()
# Perform apriltag detection to get a list of detected apriltag
tags = tag_detector.detect(gray)
print("%d apriltags have been detected."%len(tags))
for tag in tags:
cv2.circle(frame, tuple(tag.corners[0].astype(int)), 4,(0,0,255), 2) # left-top
cv2.circle(frame, tuple(tag.corners[1].astype(int)), 4,(0,0,255), 2) # right-top
cv2.circle(frame, tuple(tag.corners[2].astype(int)), 4,(0,0,255), 2) # right-bottom
cv2.circle(frame, tuple(tag.corners[3].astype(int)), 4,(0,0,255), 2) # left-bottom
print("family:",tag.tag_family)
print("id:", tag.tag_id)
print("conners:", tag.corners)
print("homography:", tag.homography)
cv2.imshow("apriltag_test",frame)
end = time.time()
time_list.append(end-start)
avarge = sum(time_list) / len(time_list)
print("detect:", end-start)
print("avarge:",avarge)
while 1:
Aptag_detect(cap)