基于Euler-Rodrigues公式的Python旋转矩阵函数返回值异常排查

嘿，我来帮你排查这个旋转矩阵的问题！

你提到用Euler-Rodrigues公式实现的旋转函数，在旋转π/2时向量夹角不符合预期，但π和2π旋转正常，这种情况大概率是公式实现过程中某个细节出错了——毕竟Euler-Rodrigues的细节（比如半角、反对称矩阵符号、乘法顺序）很容易踩坑。

先梳理可能的问题点 #

我先列几个最常见的错误原因，你可以逐一排查：

• 半角处理错误：如果是用四元数转旋转矩阵的方式实现Euler-Rodrigues，公式里的θ需要取半角（θ/2），很多人会直接用θ代入，导致实际旋转角度变成2倍。比如你传入π/2，实际会转π，这时候结果自然不对，但传入π时实际转2π，又会回到原位置，刚好符合你的“π旋转正常”的现象。
• 反对称矩阵构造错误：如果是用反对称矩阵的形式实现公式，轴向量的反对称矩阵符号很容易写错。正确的反对称矩阵应该是：

  [ 0, -v_z, v_y ]
  [ v_z, 0, -v_x ]
  [ -v_y, v_x, 0 ]
  

  符号错了会导致旋转方向反转，但如果是角度计算错了，就会直接影响夹角。
• 矩阵与向量的乘法顺序：要确认你是用旋转矩阵左乘列向量（R @ v），还是右乘行向量（v @ R）。前者是主动旋转（向量绕轴转动），后者是被动旋转（坐标系转动），虽然方向可能不同，但夹角应该还是90度，不过如果你的测试逻辑搞反了，也可能出现异常。
• 迹的验证：旋转矩阵的迹（主对角线元素之和）应该满足 1 + 2cosθ。比如θ=π/2时，迹应该是1；θ=π时迹是-1；θ=2π时迹是3。你可以打印出你生成的矩阵，算一下迹是否符合，这能快速判断公式核心部分是否正确。

给你一个标准的Euler-Rodrigues实现参考 #

你可以对比自己的代码，看看哪里不一样：

方式1：基于四元数转换

import numpy as np
import math

def rotation_matrix(axis, theta):
    """基于Euler-Rodrigues公式生成3D旋转矩阵"""
    axis = np.asarray(axis)
    # 归一化旋转轴（避免零向量或非单位向量影响）
    axis = axis / math.sqrt(np.dot(axis, axis))
    
    # 四元数分量：q = [cos(θ/2), -sin(θ/2)*v_x, -sin(θ/2)*v_y, -sin(θ/2)*v_z]
    a = math.cos(theta / 2.0)
    b, c, d = -axis * math.sin(theta / 2.0)
    
    # 从四元数展开为旋转矩阵
    aa, bb, cc, dd = a*a, b*b, c*c, d*d
    bc, ad, ac, ab, bd, cd = b*c, a*d, a*c, a*b, b*d, c*d
    
    return np.array([
        [aa + bb - cc - dd, 2*(bc + ad), 2*(bd - ac)],
        [2*(bc - ad), aa + cc - bb - dd, 2*(cd + ab)],
        [2*(bd + ac), 2*(cd - ab), aa + dd - bb - cc]
    ])

方式2：基于反对称矩阵

import numpy as np
import math

def rotation_matrix(axis, theta):
    """基于Euler-Rodrigues公式生成3D旋转矩阵"""
    axis = np.asarray(axis)
    axis = axis / np.linalg.norm(axis)  # 归一化轴向量
    
    cos_theta = math.cos(theta)
    sin_theta = math.sin(theta)
    
    # 构造轴向量的反对称矩阵
    skew_sym = np.array([
        [0, -axis[2], axis[1]],
        [axis[2], 0, -axis[0]],
        [-axis[1], axis[0], 0]
    ])
    
    # Euler-Rodrigues核心公式
    return cos_theta * np.eye(3) + (1 - cos_theta) * np.outer(axis, axis) + sin_theta * skew_sym

快速测试方法 #

你可以用一个简单的用例验证：比如绕z轴旋转π/2，原向量取(1, 0, 0)，正确旋转后应该得到(0, 1, 0)，两个向量的点积为0（夹角90度）。用上面的函数跑一遍这个测试，看看结果是否符合。

如果你的代码和上面的实现有差异，大概率就是出错的地方啦！

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