Java中基于Rotation Matrix的向量旋转方法Z轴计算异常排查

你的代码核心问题是完全错误实现了旋转矩阵的计算逻辑——三维旋转不是对单个坐标分量直接乘一个系数，而是每个新坐标分量是原多个分量的线性组合（旋转会让不同轴的坐标互相影响）。当前写法相当于把旋转变成了各轴的缩放，而非真正的旋转变换，这才导致绕Y轴旋转时Z值不受相关坐标影响，出现所有向量Z值一致的问题。

具体错误点 #

1. 绕X轴旋转错误
   正确的绕X轴旋转公式（OpenGL右手坐标系）是：

   Y' = Y * cos(rX) - Z * sin(rX)
   Z' = Y * sin(rX) + Z * cos(rX)
   

   你当前直接给Y、Z乘固定系数，没有利用对方的分量，完全不符合旋转逻辑。

2. 绕Y轴旋转错误
   正确的绕Y轴旋转公式是：

   X' = X * cos(rY) + Z * sin(rY)
   Z' = -X * sin(rY) + Z * cos(rY)
   

   你现在只单独修改X和Z的分量，没有将两者的原始值结合计算，导致Z的结果只和原始Z有关，和X的关联逻辑错误，最终出现所有向量Z值一致的问题。

3. 绕Z轴旋转错误
   正确的绕Z轴旋转公式是：

   X' = X * cos(rZ) - Y * sin(rZ)
   Y' = X * sin(rZ) + Y * cos(rZ)
   

   同样，当前写法只是单独缩放X和Y，没有实现正确的线性组合。

修正后的代码 #

以下是符合OpenGL右手坐标系旋转逻辑的修正版本，保留你原来的X→Y→Z旋转顺序：

public static float[] rotateVector3(float x, float y, float z, double rX, double rY, double rZ) {
    // 角度归一化到[0, 2π)区间
    rX = rX % (Math.PI * 2);
    if (rX < 0) rX += Math.PI * 2;
    rY = rY % (Math.PI * 2);
    if (rY < 0) rY += Math.PI * 2;
    rZ = rZ % (Math.PI * 2);
    if (rZ < 0) rZ += Math.PI * 2;

    float currX = x, currY = y, currZ = z;
    // 绕X轴旋转
    double cosX = Math.cos(rX);
    double sinX = Math.sin(rX);
    float newY = (float) (currY * cosX - currZ * sinX);
    float newZ = (float) (currY * sinX + currZ * cosX);
    currY = newY;
    currZ = newZ;

    // 绕Y轴旋转
    double cosY = Math.cos(rY);
    double sinY = Math.sin(rY);
    float newX = (float) (currX * cosY + currZ * sinY);
    newZ = (float) (-currX * sinY + currZ * cosY);
    currX = newX;
    currZ = newZ;

    // 绕Z轴旋转
    double cosZ = Math.cos(rZ);
    double sinZ = Math.sin(rZ);
    newX = (float) (currX * cosZ - currY * sinZ);
    newY = (float) (currX * sinZ + currY * cosZ);
    currX = newX;
    currY = newY;

    float[] ret = {currX, currY, currZ};
    System.out.println("(" + x + " " + y + " " + z + ") -> (" + rX + "º " + rY + "º " + rZ + "º) = (" + ret[0] + " " + ret[1] + " " + ret[2] + ")");
    return ret;
}

修正后效果验证 #

当传入rX=0、rY=2、rZ=0时，vecA(50,50,1)和vecB(50,-50,1)的Z值会产生明显差异——绕Y轴旋转时Z值由原始X和Z共同计算，最终结果符合三维旋转的预期逻辑。

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