OpenCV solvePnP相机标定后相机位于地板下方，如何翻转参数？

这问题我之前调试相机位姿时也碰到过！本质是坐标系定义不匹配或者solvePnP输出的位姿方向和你预期的不一致导致的。下面给你几个实操性强的解决思路：

• 先检查你的3D空间点坐标系定义
  通常我们会约定：地板平面为z=0，垂直地板向上为z轴正方向，相机应该在z>0的上方区域。如果你在定义地板3D点时，把z轴方向搞反了（比如向下设为正），solvePnP自然会算出相机在z<0的“下方”。先确认你的3D点坐标系是否符合预期，这是最基础的排查步骤。

• 直接翻转位姿参数（旋转+平移）
  如果坐标系定义没问题，那可以通过绕x轴旋转180度来修正相机位姿：

  1. 把solvePnP输出的旋转向量rvec转换为旋转矩阵R：

     R, _ = cv2.Rodrigues(rvec)
     

  2. 构造绕x轴翻转180度的旋转矩阵：

     R_flip = np.array([[1, 0, 0],
                        [0, -1, 0],
                        [0, 0, -1]], dtype=np.float32)
     

  3. 计算修正后的旋转矩阵和平移向量：

     R_corrected = R_flip @ R
     tvec_corrected = R_flip @ tvec
     

  4. 再把修正后的旋转矩阵转回旋转向量（如果需要）：

     rvec_corrected, _ = cv2.Rodrigues(R_corrected)
     

  这样处理后，相机的z坐标就会变成正数，处于地板上方了。

• 提前调整3D点坐标
  另一种简单的方式是，在传入solvePnP之前，把所有地板3D点的z坐标取反（比如points_3d[:, 2] = -points_3d[:, 2]），这样solvePnP直接就能算出符合预期的相机位姿，不用后续调整参数。

• 验证修正结果
  不管用哪种方法，记得用修正后的rvec和tvec把3D点投影回图像，对比和原始2D点的匹配度：

  projected_points, _ = cv2.projectPoints(points_3d, rvec_corrected, tvec_corrected, camera_matrix, dist_coeffs)
  

  如果投影点和原始2D点几乎重合，说明修正成功。

内容的提问来源于stack exchange，提问作者Samuel