如何利用OpenCV solvePnPRansac矩阵正确设置Rajawali相机旋转？

我之前做AR项目时也碰到过一模一样的问题——位置显示正常，但旋转总是不对，核心原因是OpenCV的相机坐标系和Rajawali（基于OpenGL）的3D场景坐标系轴方向不匹配，再加上旋转矩阵的变换逻辑需要对齐Rajawali的相机空间。下面是一步步的解决方案：

1. 先搞懂坐标系差异 #

这是问题的根源，必须先理清楚：

• OpenCV相机坐标系：右手系，X轴向右，Y轴向下，Z轴向前（从镜头指向场景）
• Rajawali/OpenGL坐标系：右手系，X轴向右，Y轴向上，Z轴向后（从屏幕指向观察者）

简单说，我们需要翻转Y轴和Z轴，才能让两个坐标系对齐。

2. 在C++端调整旋转矩阵 #

在你用cv::Rodrigues得到RotationMatrix之后，添加坐标系转换逻辑，把旋转矩阵调整到Rajawali的空间：

// 构造OpenCV转OpenGL的坐标系变换矩阵（翻转Y和Z轴）
cv::Mat cvToGl = cv::Mat::eye(3, 3, CV_64FC1);
cvToGl.at<double>(1, 1) = -1; // 翻转Y轴
cvToGl.at<double>(2, 2) = -1; // 翻转Z轴

// 相机的旋转是物体到相机旋转的逆变换（转置），再做坐标系转换
cv::Mat cameraRotation = RotationMatrix.t(); // 获取相机相对世界的旋转矩阵
cameraRotation = cvToGl * cameraRotation * cvToGl; // 转换到OpenGL坐标系

之后把这个cameraRotation传递给Java端，替换你之前的cameraOrientation逻辑。

3. 在Java端用四元数替代欧拉角 #

欧拉角很容易出现万向锁问题，Rajawali对四元数的支持更稳定可靠。接收调整后的旋转矩阵，转成四元数再设置给相机：

// 从C++端获取3x3旋转矩阵的值，存入double数组（长度9）
double[] rotationMatrix = new double[9];
getAdjustedCameraRotation(rotationMatrix); // 替换你的native方法，传递旋转矩阵

// 将旋转矩阵转为四元数
Quaternion cameraQuat = new Quaternion(rotationMatrix);
getCurrentCamera().setRotation(cameraQuat);

// 保持你原本正确的位置设置逻辑
double POSx = cameraPosition.get(0, 0)[0] / 1000;
double POSy = cameraPosition.get(1, 0)[0] / 1000;
double POSz = cameraPosition.get(2, 0)[0] / 1000;
getCurrentCamera().setPosition(POSx, POSy, POSz);

4. 如果坚持用欧拉角，注意旋转顺序 #

如果你还是想使用欧拉角，要记住Rajawali的setRotation(x,y,z)是按X轴→Y轴→Z轴的顺序依次应用旋转。你可以从四元数里提取正确顺序的欧拉角：

EulerAngles angles = cameraQuat.toEulerAngles();
double ROTx = Math.toDegrees(angles.x);
double ROTy = Math.toDegrees(angles.y);
double ROTz = Math.toDegrees(angles.z);
getCurrentCamera().setRotation(ROTx, ROTy, ROTz);

关键注意点 #

• 你原本计算cameraPosition的逻辑是对的：cameraPosition = -1 * (R_t * TranslationMatrix)，因为平移向量T是物体在相机坐标系中的位置，相机在世界坐标系中的位置就是-T。
• 测试时可以先渲染一个简单的立方体当参考，观察旋转是否符合预期，再逐步调整细节。

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