用opencv找到相机中心答案

【问题标题】：find Camera Center with opencv用opencv找到相机中心
【发布时间】：2019-09-05 15:14:03
【问题描述】：

我正在尝试从经过校准的相机中获取相机中心。我有 4 个测量的 3D objectPoints 及其图像，并试图从投影矩阵中获取中心（平移），但没有可接受的结果。关于我应该期望使用opencv的准确性有什么建议吗？我应该增加点数吗？

这些是我得到的结果：

TrueCenter in mm for XYZ
 [[4680.]
 [5180.]
 [1621.]] 
Center
 [[-2508.791]
 [ 6015.98 ]
 [-1096.674]]

import numpy as np
import cv2
from scipy.linalg import inv

TrueCameraCenter = np.array([4680., 5180, 1621]).reshape(-1,1)

objectPoints = np.array(
        [[   0., 5783., 1970.],
           [   0., 5750., 1261.],
           [   0., 6412., 1968.],
           [1017., 9809., 1547.]], dtype=np.float32)

imagePoints=np.array(
        [[ 833.75, 1097.25],
           [ 798.  , 1592.25],
           [1323.  , 1133.5 ],
           [3425.5 , 1495.5 ]], dtype=np.float32)

cameraMatrix= np.array(
        [[3115.104,   -7.3  , 2027.605],
           [   0.   , 3077.283, 1504.034],
           [   0.   ,    0.   ,    1.   ]])

retval, rvec, tvec = cv2.solvePnP(objectPoints, imagePoints,cameraMatrix,None, None, None, False, cv2.SOLVEPNP_ITERATIVE)
R,jac= cv2.Rodrigues(rvec)
imagePoints2,jac= cv2.projectPoints(objectPoints, rvec, tvec, cameraMatrix,None)
print('TrueCenter in mm for XYZ\n', TrueCameraCenter, '\nCenter\n', -inv(R).dot(tvec))

【问题讨论】：

您正在使用一个非常简单的相机镜头模型，它可能在图像边缘附近不太准确，这将无济于事。此外，点对的数量不如它们的分布重要，如果它们在任何方向上聚集，那么你的相机位置估计将会受到负面影响。
感谢@PeteBlackerThe3rd。我使用了 4 个共面，没有 3 个共线点并进行了改进。

标签： python opencv homography

【解决方案1】：

我发现 Bill Wolfe 关于位置确定问题的这个有趣的演示文稿。 Perspective View Of 3 Points

因此，使用 4 个非共面点（非 3 个共线）解决方案得到了改进。

import numpy as np
import cv2
from scipy.linalg import inv,norm


TrueCameraCenter = np.array([4680., 5180, 1621])
objectPoints = np.array(
        [[   0., 5783., 1970.],
       [   0., 5750., 1261.],
       [   0., 6412., 1968.],
       [   0., 6449., 1288.]])

imagePoints=np.array(
        [[ 497.5 ,  674.75],
       [ 523.75, 1272.5 ],
       [1087.75,  696.75],
       [1120.  , 1212.5 ]])

cameraMatrix= np.array(
        [[3189.096,    0.   , 2064.431],
         [   0.   , 3177.615, 1482.859],
         [   0.   ,    0.   ,    1.   ]])
dist_coefs=np.array([[ 0.232, -1.215, -0.002,  0.011,  1.268]])

retval, rvec, tvec = cv2.solvePnP(objectPoints, imagePoints,cameraMatrix,dist_coefs, 
                                  None, None, False, cv2.SOLVEPNP_ITERATIVE)
R,_= cv2.Rodrigues(rvec)
C=-inv(R).dot(tvec).flatten()
print('TrueCenter in mm for XYZ\n', TrueCameraCenter, '\nCenter\n',C.astype(int) )
print('Distance:', int(norm(TrueCameraCenter-C)))

【讨论】：