基于变换矩阵的3D点绕原点旋转函数异常问题排查

核心错误：多余的平移操作 #

你提到的「先平移到原点、旋转后再平移回去」是绕任意点旋转的步骤，但你的需求是绕3D原点旋转，这一步完全多余！原点是坐标系的基准点，所有点的坐标本身就是相对于原点的，平移操作反而会引入计算误差或逻辑错误，这大概率是z轴异常旋转的根源。

分步骤排查与修正 #

1. 立即移除平移逻辑
   直接用原始点坐标参与旋转矩阵运算，去掉「减原点坐标、旋转后加回」的步骤——绕原点旋转不需要这两步。

2. 核对旋转矩阵的乘法顺序
   3D旋转的顺序直接影响结果，必须和你的向量表示（行/列向量）对应：

   • 若用列向量（多数线性代数教材的标准），旋转顺序是「先绕X，再绕Y，最后绕Z」的话，组合矩阵的乘法顺序是 R = Rz * Ry * Rx，最终点坐标计算为 P' = R * P
   • 若用行向量，顺序完全反过来：P' = P * Rx * Ry * Rz
     很多新手会搞反顺序，导致某轴的旋转效果错位。

3. 验证旋转矩阵的正确性
   确保每个轴的旋转矩阵公式与你的坐标系（左手/右手）匹配，以下是右手坐标系下的标准矩阵：

   • 绕X轴旋转θ角：

     [1,  0,        0       ]
     [0, cosθ,  -sinθ]
     [0, sinθ,   cosθ]
     

   • 绕Y轴旋转φ角：

     [cosφ,  0,  sinφ]
     [0,     1,   0   ]
     [-sinφ, 0,  cosφ]
     

   • 绕Z轴旋转ψ角：

     [cosψ, -sinψ, 0]
     [sinψ,  cosψ, 0]
     [0,      0,   1]
     

   注意Y轴旋转的正负号，不同资料可能因坐标系定义有差异，若你的z轴异常仍存在，可尝试翻转Y轴矩阵的sin符号。

4. 检查角度单位
   确认所有旋转角都用弧度传入（你提到用了radians，但再核对一遍代码中是否有不小心转成角度的地方）。

示例修正逻辑 #

假设你用列向量、右手坐标系，绕原点旋转的简化代码逻辑应该是：

import math

def rotate_around_origin(point, rx, ry, rz):
    # 定义各轴旋转矩阵
    cos_rx, sin_rx = math.cos(rx), math.sin(rx)
    rx_mat = [
        [1, 0, 0],
        [0, cos_rx, -sin_rx],
        [0, sin_rx, cos_rx]
    ]
    
    cos_ry, sin_ry = math.cos(ry), math.sin(ry)
    ry_mat = [
        [cos_ry, 0, sin_ry],
        [0, 1, 0],
        [-sin_ry, 0, cos_ry]
    ]
    
    cos_rz, sin_rz = math.cos(rz), math.sin(rz)
    rz_mat = [
        [cos_rz, -sin_rz, 0],
        [sin_rz, cos_rz, 0],
        [0, 0, 1]
    ]
    
    # 计算组合旋转矩阵（顺序：Rx → Ry → Rz，列向量左乘）
    def multiply_matrices(a, b):
        return [
            [a[0][0]*b[0][0] + a[0][1]*b[1][0] + a[0][2]*b[2][0],
             a[0][0]*b[0][1] + a[0][1]*b[1][1] + a[0][2]*b[2][1],
             a[0][0]*b[0][2] + a[0][1]*b[1][2] + a[0][2]*b[2][2]],
            [a[1][0]*b[0][0] + a[1][1]*b[1][0] + a[1][2]*b[2][0],
             a[1][0]*b[0][1] + a[1][1]*b[1][1] + a[1][2]*b[2][1],
             a[1][0]*b[0][2] + a[1][1]*b[1][2] + a[1][2]*b[2][2]],
            [a[2][0]*b[0][0] + a[2][1]*b[1][0] + a[2][2]*b[2][0],
             a[2][0]*b[0][1] + a[2][1]*b[1][1] + a[2][2]*b[2][1],
             a[2][0]*b[0][2] + a[2][1]*b[1][2] + a[2][2]*b[2][2]]
        ]
    
    ry_rx = multiply_matrices(ry_mat, rx_mat)
    r_total = multiply_matrices(rz_mat, ry_rx)
    
    # 用列向量计算新坐标
    x, y, z = point
    new_x = r_total[0][0]*x + r_total[0][1]*y + r_total[0][2]*z
    new_y = r_total[1][0]*x + r_total[1][1]*y + r_total[1][2]*z
    new_z = r_total[2][0]*x + r_total[2][1]*y + r_total[2][2]*z
    
    return (new_x, new_y, new_z)

内容的提问来源于stack exchange，提问作者M. Nicol