如何在Jacobian逆运动学中使用四元数规避奇点与万向节锁？

直接用四元数替代欧拉角存储关节旋转，并调整Jacobian计算和旋转更新逻辑，就能彻底避免万向节锁。以下是具体实现步骤：

1. 替换欧拉角存储为四元数 #

首先修改姿态存储结构，把原来的欧拉角换成四元数，移除欧拉角相关的读写方法：

// 假设transforms结构体新增/替换rotation字段为glm::quat
glm::quat jointRot = transforms[child].rotation;

2. 计算Jacobian矩阵的旋转列 #

Jacobian中对应关节旋转的列，本质是微小旋转带来的末端线速度，公式和你用欧拉角时一致：∂p/∂θ = cross(旋转轴（世界空间）, 关节到末端的向量)。区别在于，这里的旋转轴是从当前关节四元数转换得到的局部轴，而非依赖欧拉角顺序：

以计算绕关节局部x轴的Jacobian列为例：

// bone = 末端效应器位置 - 关节位置（世界空间向量）
glm::vec3 localX = glm::normalize(transforms[child].rotation * glm::vec3(1.0f, 0.0f, 0.0f));
glm::vec3 velocityContribution = glm::cross(localX, bone);

// 填充Jacobian对应列（线速度部分，对应x轴旋转自由度）
ikt.jacobi(index + 0, j + 0) = velocityContribution.x;
ikt.jacobi(index + 1, j + 0) = velocityContribution.y;
ikt.jacobi(index + 2, j + 0) = velocityContribution.z;

同理，局部y轴和z轴的计算只需把glm::vec3(1.0f,0,0)替换为(0,1,0)和(0,0,1)即可。

3. 应用旋转增量（四元数版） #

阻尼最小二乘法得到的dTheta是三个轴的微小旋转弧度，将其转换为四元数增量后，与原关节旋转相乘即可更新姿态：

glm::vec3 deltaRotVec = { dTheta(jointNum + 0), dTheta(jointNum + 1), dTheta(jointNum + 2) };
float angle = glm::length(deltaRotVec);
glm::quat deltaRot;

if (angle > 1e-6f) { // 避免数值问题
    glm::vec3 axis = glm::normalize(deltaRotVec);
    deltaRot = glm::angleAxis(angle, axis);
} else {
    deltaRot = glm::quat(1.0f, 0.0f, 0.0f, 0.0f); // 单位四元数，无旋转
}

// 注意四元数乘法顺序：deltaRot * jointRot 是世界空间增量，jointRot * deltaRot 是局部空间增量
// 根据你的IK框架选择合适的顺序
transforms[child].rotation = deltaRot * transforms[child].rotation;

4. 维护四元数数值稳定性 #

每次更新后对四元数归一化，防止数值漂移：

transforms[child].rotation = glm::normalize(transforms[child].rotation);

核心优势 #

四元数是三维旋转的无奇异表示，不存在欧拉角的万向节锁问题——无论关节处于什么姿态，四元数都能稳定表示旋转，彻底解决你当前遇到的奇点失效问题。

内容的提问来源于stack exchange，提问作者Thomas O'Brien