四元数转欧拉角角度偏差π问题及Eigen代码排查求助

这个问题本质是欧拉角的多值性和Eigen库eulerAngles方法的返回规则导致的，咱们一步步拆解清楚：

一、偏差产生的核心原因 #

1. 欧拉角的固有多值性 #

同一个旋转（无论是四元数还是旋转矩阵表示），可以对应多组欧拉角解。比如绕Y轴转2° + 绕X轴转3°，和绕Y轴转178° + 绕X轴转-177°，这两组角度对应的旋转效果是完全等价的——因为旋转矩阵的组合会抵消掉额外的π偏移，最终得到相同的旋转结果。

2. Eigen eulerAngles的返回规则 #

Eigen的eulerAngles(2,1,0)方法对应Z-Y-X顺序的内禀旋转，它返回的角度会严格遵循以下范围：

• 绕Z轴（第一个值）：[0, 2π]
• 绕Y轴（第二个值）：[-π, π]
• 绕X轴（第三个值）：[0, 2π]

它只会返回符合这个范围的某一组解，而不会优先匹配你输入的原始角度。当输入角度较小时，另一组带π偏移的解也符合范围要求，Eigen就可能返回这组非预期的解。

而你用的维基百科代码，通过计算逻辑强制将Y轴角度（pitch）限制在[-π/2, π/2]范围内，直接排除了带π偏移的解，所以能得到你预期的结果。

二、获取预期角度的解决方法 #

方法1：调整Eigen的结果到目标范围 #

如果你想继续使用Eigen的eulerAngles，可以手动将角度调整到你需要的范围，并处理等价解：

#include <cmath>
#include <Eigen/Core>
#include <Eigen/Geometry>

int main() {
    Eigen::AngleAxisd z(0, Eigen::Vector3d::UnitZ());
    Eigen::AngleAxisd pan(2 / 180. * M_PI, Eigen::Vector3d::UnitY());
    Eigen::AngleAxisd tilt(3 / 180. * M_PI, Eigen::Vector3d::UnitX());
    auto q = z * pan * tilt;
    
    auto euler = q.toRotationMatrix().eulerAngles(2, 1, 0);
    
    // 辅助函数：将角度包裹到[-180°, 180°]范围
    auto wrap_deg = [](double rad) {
        double deg = rad * 180 / M_PI;
        while (deg > 180) deg -= 360;
        while (deg < -180) deg += 360;
        return deg;
    };
    
    double yaw = wrap_deg(euler[0]);
    double pitch = wrap_deg(euler[1]);
    double roll = wrap_deg(euler[2]);
    
    // 将pitch调整到[-90°, 90°]，同时修正roll和yaw
    if (std::abs(pitch) > 90) {
        pitch = pitch > 0 ? pitch - 180 : pitch + 180;
        roll = wrap_deg(roll + 180);
        yaw = wrap_deg(yaw + 180);
    }
    
    // 此时pitch≈2°, roll≈3°
    return 0;
}

方法2：直接使用维基百科的实现 #

维基百科的代码通过计算逻辑直接锁定了[-π/2, π/2]范围内的pitch解，完全避免了Eigen的范围选择问题。注意Eigen的四元数定义和代码中的一致：q.w()是实部，q.x()/q.y()/q.z()是虚部，可以直接复用代码。

方法3：确认旋转顺序匹配 #

确保你使用的欧拉角旋转顺序和构造四元数时的顺序一致。你构造的是Z*Y*X的内禀旋转（先X、再Y、最后Z），所以eulerAngles(2,1,0)是正确的；如果你的业务逻辑是外禀旋转，需要调整参数顺序（比如eulerAngles(0,1,2)对应X-Y-Z外禀旋转）。

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