C++中欧拉角转换为Quaternion时数值偏差过大问题求助

1. 符号取反问题 #

四元数 q 和 -q 描述的是完全相同的空间旋转，这属于正常的数学性质，不是代码错误。如果需要保证输出符号统一，可以在返回前增加判断：如果w < 0，就将w/x/y/z四个分量全部取反即可。

2. 数值偏差问题 #

2.1 旋转顺序匹配校验 #

你当前的转换公式对应的是 内在ZYX旋转顺序（先滚转Roll-Z，再俯仰Pitch-X，最后偏航Yaw-Y），如果你的业务里欧拉角实际使用的是其他旋转顺序（比如OpenGL常用的Y-X-Z顺序），就会出现转换偏差，确认顺序后可以对应调整四元数分量的计算逻辑。

2.2 PI精度修正 #

确保你的PI宏精度足够，建议直接使用acos(-1.0)获取高精度的π值，避免手动定义PI精度不足导致的误差：

#define PI acos(-1.0)
// MSVC环境下可定义_USE_MATH_DEFINES后引入<cmath>使用内置M_PI

2.3 转换后归一化 #

浮点运算会引入微小误差，四元数使用前必须保证是单位四元数，给Quaternion结构体增加归一化方法，转换完成后调用：

void Normalize() {
    double length = sqrt(w*w + x*x + y*y + z*z);
    if (length < 1e-6) {
        w = 1; x = y = z = 0;
        return;
    }
    w /= length;
    x /= length;
    y /= length;
    z /= length;
}

2.4 右手系旋转方向校验 #

OpenGL右手系约定绕轴正方向逆时针旋转为正角度，如果你的欧拉角传入的是顺时针为正的定义，需要在转弧度前将角度取反。

修改后的完整ToQuaternion方法 #

static Quaternion ToQuaternion(Vector3& vec) {
    // 若你的欧拉角正方向为顺时针，替换成下面三行代码
    // double yaw = DegreesToRadians(-(double)vec.y);
    // double pitch = DegreesToRadians(-(double)vec.x);
    // double roll = DegreesToRadians(-(double)vec.z);
    
    // 原代码对应逆时针为正角度
    double yaw = DegreesToRadians((double)vec.y);
    double pitch = DegreesToRadians((double)vec.x);
    double roll = DegreesToRadians((double)vec.z);

    double cy = cos(yaw * 0.5);
    double sy = sin(yaw * 0.5);
    double cp = cos(pitch * 0.5);
    double sp = sin(pitch * 0.5);
    double cr = cos(roll * 0.5);
    double sr = sin(roll * 0.5);

    Quaternion q;
    q.w = cr * cp * cy + sr * sp * sy;
    q.x = cr * sp * cy + sr * cp * sy;
    q.y = cr * cp * sy - sr * sp * cy;
    q.z = sr * cp * cy - cr * sp * sy;

    // 归一化保证单位四元数
    q.Normalize();
    
    // 可选：统一输出符号
    if (q.w < 0) {
        q.w = -q.w;
        q.x = -q.x;
        q.y = -q.y;
        q.z = -q.z;
    }

    return q;
}

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