VisionTrackingMk2.py 文件源码

def findCameraParameters(cont):
    objectPoints = np.array([[0,0,0],[10.5,0,0],[10.5,5,0],[0,5,0]], dtype=np.float32)
    imagePoints=cont
    ret, rvec, tvec = cv2.solvePnP(objectPoints, imagePoints, np.load("mtx.npy"), np.load("dist.npy"))
    print(tvec)
    print(rvec)