基于Eigen从方向向量生成适配3D Slicer的3x3旋转矩阵

核心前提：单向量变换无法唯一确定旋转矩阵 #

旋转矩阵是正交矩阵（满足A*A^T = I且行列式det(A)=1）。仅知道A*(0,0,1)^T = b，只意味着b是矩阵A的第三列（列向量乘法规则），但前两列可以是任何与b正交且互相正交的单位向量——这意味着存在无数个符合条件的旋转矩阵。你必须补充一个约束条件才能得到唯一解，比如：

• 指定原x轴(1,0,0)旋转后的目标方向
• 要求生成从原z轴到b的最小旋转矩阵（绕两向量叉乘轴旋转最小角度）

方法1：构造正交基生成旋转矩阵（推荐） #

该方法通过构建一组正交单位基来生成旋转矩阵，默认保持旋转后的x轴在垂直于b的平面内，尽可能贴近原x轴方向：

1. 对目标向量b做归一化：b_normalized = b.normalized()
2. 计算原z轴(0,0,1)与b_normalized的叉乘，得到第一正交轴：axis1 = (Vector3d(0,0,1).cross(b_normalized)).normalized()
   • 若叉乘结果为零（即b与原z轴同向/反向），直接取axis1 = (1,0,0)
3. 计算第三正交轴：axis2 = b_normalized.cross(axis1).normalized()
4. 旋转矩阵的三列依次为axis1、axis2、b_normalized（矩阵列对应原坐标轴变换后的方向）

方法2：用Eigen的AngleAxis生成最小旋转矩阵 #

如果只需要从原z轴到b的最小旋转（无额外轴约束），可以直接用Eigen的AngleAxis类：

1. 计算旋转轴：rotation_axis = Vector3d(0,0,1).cross(b).normalized()
2. 计算旋转角度：angle = acos(Vector3d(0,0,1).dot(b.normalized()))
3. 构造旋转矩阵：A = AngleAxisd(angle, rotation_axis).toRotationMatrix()
   • 若b与原z轴反向，叉乘为零，此时绕x轴旋转180度即可：A = AngleAxisd(M_PI, Vector3d(1,0,0)).toRotationMatrix()

Eigen代码实现示例 #

#include <Eigen/Dense>
#include <cmath>

Eigen::Matrix3d computeSlicerRotationMatrix(const Eigen::Vector3d& target_dir) {
    Eigen::Vector3d b_norm = target_dir.normalized();
    const Eigen::Vector3d original_z(0, 0, 1);

    // 处理目标向量与原z轴平行的特殊情况
    if (std::abs(b_norm.dot(original_z)) > 0.9999) {
        return b_norm.z() > 0 ? Eigen::Matrix3d::Identity() 
                              : Eigen::AngleAxisd(M_PI, Eigen::Vector3d(1, 0, 0)).toRotationMatrix();
    }

    // 构建正交基
    Eigen::Vector3d axis1 = original_z.cross(b_norm).normalized();
    Eigen::Vector3d axis2 = b_norm.cross(axis1).normalized();

    // 组装旋转矩阵（列优先，匹配3D Slicer导出格式）
    Eigen::Matrix3d rot_mat;
    rot_mat.col(0) = axis1;
    rot_mat.col(1) = axis2;
    rot_mat.col(2) = b_norm;

    return rot_mat;
}

适配3D Slicer的注意事项 #

• 验证：生成矩阵后，务必检查A * Eigen::Vector3d(0,0,1)是否与目标向量b一致（允许微小浮点误差）
• 存储顺序：3D Slicer导出的旋转矩阵通常为列优先，与Eigen默认的矩阵存储方式一致，无需额外转置

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