我的旋转矩阵有什么问题？

Question

//---------------------------------------------------------------------------
//  arbitraryRotate - rotates v theta degrees around n
//---------------------------------------------------------------------------
private static Vector3D arbitraryRotate(Vector3D v, Vector3D n, double theta)
{
    theta = Math.toRadians(theta);
    double cosTheta = Math.cos(theta);
    double sinTheta = Math.sin(theta);

    double M11 = n.x * n.x * (1 - cosTheta) + cosTheta;
    double M12 = n.x * n.y * (1 - cosTheta) + (n.z * sinTheta);
    double M13 = n.x * n.z * (1 - cosTheta) - (n.y * sinTheta);

    double M21 = n.x * n.y * (1 - cosTheta) - (n.z * sinTheta);
    double M22 = n.y * n.y * (1 - cosTheta) + cosTheta;
    double M23 = n.y * n.z * (1 - cosTheta) + (n.x * sinTheta);

    double M31 = n.x * n.z * (1 - cosTheta) + (n.y * sinTheta);
    double M32 = n.y * n.z * (1 - cosTheta) - (n.x * sinTheta);
    double M33 = n.z * n.z * (1 - cosTheta) + cosTheta;

    return new Vector3D(v.x * M11 + v.y * M21 + v.z * M31,
                        v.x * M12 + v.y * M22 + v.z * M32,
                        v.x * M13 + v.y * M23 + v.z * M33);
}

谁能告诉我我的矩阵出了什么问题？ 绕Z轴旋转的效果很好，但是X和Y轴旋转会导致变形。

Answer 1

您的矩阵设置不正确。 这是您正确旋转的方式

1. 创建一个旋转矩阵，该矩阵旋转轴以使其沿着XZ平面
2. 创建一个旋转矩阵，将新轴旋转为沿Z轴
3. 使用Z轴旋转矩阵绕Z轴旋转theta度。
4. 乘以2的倒数
5. 乘以1的倒数。

你得到

new vector = (Rx^-1)(Ry^-1)RzRyRx(original vector)

这里的链接说明得很好。 您不必将向量和矩阵扩展到4维-仅出于绕空间中的任意线旋转而不是源于原点的向量旋转的目的。