DLT algorithm needs at least 6 points for pose estimation from 3D-2D point correspondences. (expected: 'count >= 6')
# -*- coding: utf-8 -*-
# 测试使用opencv中的函数solvepnp
import cv2
import numpy as np
# tag_size = 0.05
tag_size_half = 1110.025
fx = 610.32366943
fy = 610.5026245
cx = 313.3859558
cy = 237.2507269
K = np.array([[fx, 0, cx],
[0, fy, cy],
[0, 0, 1]], dtype=np.float64)
objPoints = np.array([[-tag_size_half, -tag_size_half, 0],
[tag_size_half, -tag_size_half, 0],
[tag_size_half, tag_size_half, 0],
[-tag_size_half, tag_size_half, 0]], dtype=np.float64)
# imgPoints = np.array([[608, 167], [514, 167], [518, 69], [611, 71]], dtype=np.float64)
objPoints = np.array([(-165.0, 170.0, -110.5), # 左目左端
(165.0, 170.0, -110.5), # 右目右端, # Left eye
(0.0, 0.0, 0.0), # Nose tip
(-150.0, -150.0, -120.5), # 口の左端
(150.0, -150.0, -120.5)], dtype=np.float64) # Right Mouth corner)
imgPoints=np.array([[1030,528],
[1080,528],
[1050,541],
[1030,556],
[1057,556]],dtype=np.float64)
cameraMatrix = K
dist_coeffs = np.array([0,0,0,0], dtype=np.double)
retval,rvec,tvec = cv2.solvePnP(objPoints, imgPoints, cameraMatrix, distCoeffs=dist_coeffs)#,flags=cv2.SOLVEPNP_SQPNP)
# cv2.Rodrigues()
print(retval, rvec, tvec)
没有找到解
换一个求解算法：
# -*- coding: utf-8 -*-
# 测试使用opencv中的函数solvepnp
import cv2
import numpy as np
# tag_size = 0.05
tag_size_half = 1110.025
fx = 610.32366943
fy = 610.5026245
cx = 313.3859558
cy = 237.2507269
K = np.array([[fx, 0, cx],
[0, fy, cy],
[0, 0, 1]], dtype=np.float64)
objPoints = np.array([[-tag_size_half, -tag_size_half, 0],
[tag_size_half, -tag_size_half, 0],
[tag_size_half, tag_size_half, 0],
[-tag_size_half, tag_size_half, 0]], dtype=np.float64)
# imgPoints = np.array([[608, 167], [514, 167], [518, 69], [611, 71]], dtype=np.float64)
objPoints = np.array([(-165.0, 170.0, -110.5), # 左目左端
(165.0, 170.0, -110.5), # 右目右端, # Left eye
(0.0, 0.0, 0.0), # Nose tip
(-150.0, -150.0, -120.5), # 口の左端
(150.0, -150.0, -120.5)], dtype=np.float64) # Right Mouth corner)
imgPoints=np.array([[1030,528],
[1080,528],
[1050,541],
[1030,556],
[1057,556]],dtype=np.float64)
cameraMatrix = K
dist_coeffs = np.array([0,0,0,0], dtype=np.double)
retval,rvec,tvec = cv2.solvePnP(objPoints, imgPoints, cameraMatrix, distCoeffs=dist_coeffs,flags=cv2.SOLVEPNP_SQPNP)
# cv2.Rodrigues()
print(retval, rvec, tvec)
本文内容由网友自发贡献，版权归原作者所有，本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容，请联系:hwhale#tublm.com(使用前将#替换为@)
