Tag码学习笔记

Windows下创建好一个新的opencv环境

import cv2
import pupil_apriltags
import re
import numpy as np

cap = cv2.VideoCapture(1) 
def convert_to_int(lst):
    return [int(item) for item in lst]
while(1):
   # get a frame
   ret, frame = cap.read()
   # show a frame
   res = cv2.cvtColor(frame, cv2.COLOR_BGR2GRAY)
   detector = pupil_apriltags.Detector(families='tag25h9')
   camera_param=[624.6957,624.6959,327.5524,243.1645]
   tags = detector.detect(res,
                       estimate_tag_pose=True, 
                       camera_params=camera_param, 
                       tag_size=0.051)
   
   L=len(tags)
   if L :print("find ok",tags[0])
   id=[]
   center=[]
   cen=[]
   Rx=[]
   Ry=[]
   length=[]
   localx=""
   localy=""
   #print("tagslen=",len(tags))
   if len(tags) :
      print("tagslen=",len(tags))
      for i in range(len(tags)):
         tag=tags[i]
         id.append(tag.tag_id)
         cen.append(int(tag.center[0]))
         cen.append(int(tag.center[1]))
         if tag.pose_t[0]<-0.001:localx='L'
         elif tag.pose_t[0]>0.001:localx='R'
         else:localx='True'
         if tag.pose_t[1]<-0.001:localy='U'
         elif tag.pose_t[1]>0.001:localy='D'
         else:localy='True'
         Rx.append(str(tag.pose_t[0]))
         Ry.append(str(tag.pose_t[1]))
         
         length.append(str(tag.pose_t[2])+'m')

      center.append(cen)
   txt1=str(id)+"length: "+str(length)
   txt2="center: "+str(center)
   txt3="localx: "+localx+"  "+"dx: "+str(Rx)
   txt4="localy: "+localy+"  "+"dy: "+str(Ry)
   fontScale=0.5
   color=(255,0,0)
   print(tags)
   cv2.putText(frame, txt1, (10,50), cv2.FONT_HERSHEY_SIMPLEX, fontScale, color, thickness=None, lineType=None, bottomLeftOrigin=None)
   cv2.putText(frame, txt2, (10,80), cv2.FONT_HERSHEY_SIMPLEX, fontScale, color, thickness=None, lineType=None, bottomLeftOrigin=None)
   cv2.putText(frame, txt3, (10,100), cv2.FONT_HERSHEY_SIMPLEX, fontScale*1.5, color, thickness=None, lineType=None, bottomLeftOrigin=None)
   cv2.putText(frame, txt4, (10,120), cv2.FONT_HERSHEY_SIMPLEX, fontScale*1.5, color, thickness=None, lineType=None, bottomLeftOrigin=None)
   #   True, (0, 255, 0), 2)
   cv2.imshow("capture", frame)
   if cv2.waitKey(1) & 0xFF == ord('q'):
   #退出
       break
cap.release()
cv2.destroyAllWindows()

  • 24
    点赞
  • 7
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值