如何计算ARCore中两个相机Pose的方位角差值？

阿华AIGC实验室

2026-5-14

解决ARCore中两个Pose的方位角差值计算问题

我来帮你拆解这个问题——你遇到的核心问题其实是ARCore坐标系定义和欧拉角提取的顺序/轴对应关系没匹配上，再加上直接用单轴欧拉角公式硬算容易混入其他轴的旋转影响。

先明确ARCore的坐标系规则

ARCore采用右手坐标系：

+Y：垂直向上（和地面垂直）
+Z：相机向前朝向（也就是镜头对着的方向，远离用户）
+X：相机右侧方向

这和维基百科里常见的ENU坐标系（+Z向上）完全不同，这是第一个容易混淆的点。

为什么你之前的公式不管用？

你修改后的公式试图提取绕Y轴的偏航角，但问题在于：欧拉角的提取是依赖旋转顺序的（比如常见的Yaw→Pitch→Roll顺序），你用的公式没有对应ARCore的旋转逻辑，导致把俯仰角（绕X轴旋转）的变化也混入了偏航角的计算中——这就是为什么你只改俯仰角，结果却跟着变的原因。

正确的两种计算方法

方法1：从几何意义出发（最直观，不易出错）

方位角的本质是相机前向在**水平平面（X-Z平面）**上的旋转差，所以我们可以直接通过向量投影来计算：

获取两个Pose的前向单位向量（ARCore的Pose.getForward()会直接返回Z轴方向的单位向量）
把这两个向量投影到X-Z平面（将Y分量置为0，过滤俯仰影响），并重新归一化
计算两个投影向量的夹角，就是方位角差值

代码示例（伪代码）：

// 获取旧Pose和新Pose的前向向量
Vector3 oldForward = oldPose.getForward();
Vector3 newForward = newPose.getForward();

// 投影到X-Z平面
Vector3 oldProj = new Vector3(oldForward.x, 0f, oldForward.z).normalize();
Vector3 newProj = new Vector3(newForward.x, 0f, newForward.z).normalize();

// 计算夹角：用点积和叉积确定方向（正负表示旋转方向）
float dotProduct = oldProj.dot(newProj);
float crossProduct = oldProj.x * newProj.z - oldProj.z * newProj.x;
float yawDiff = (float) Math.atan2(crossProduct, dotProduct);

这个方法完全避开了四元数转欧拉角的混乱，直接从方位角的几何定义出发，确保俯仰角的变化不会影响结果。

方法2：用四元数计算相对旋转再提取偏航角

如果你更习惯用四元数操作，可以先计算两个Pose的相对旋转，再从相对旋转中提取绕Y轴的偏航角：

计算旧Pose旋转的逆四元数（用来把旧姿态转换到全局坐标系）
用逆四元数乘以新Pose的四元数，得到从旧姿态到新姿态的相对旋转四元数
从相对四元数中提取绕Y轴的偏航角（注意对应ARCore的坐标系）

正确的偏航角提取公式（对应ARCore Y向上的坐标系，旋转顺序Yaw→Pitch→Roll）：

Quaternion relativeQ = oldPose.getRotation().inverse().multiply(newPose.getRotation());
float w = relativeQ.w;
float x = relativeQ.x;
float y = relativeQ.y;
float z = relativeQ.z;

// 提取绕Y轴的偏航角
float yawDiff = (float) Math.atan2(2 * (w * x + y * z), 1 - 2 * (x * x + z * z));

这里的公式是严格对应ARCore坐标系和Yaw-Pitch-Roll旋转顺序的，不会混入俯仰角的影响。