如何在CGAL中构建旋转矩阵？从Vector_3到Z轴的旋转方法问询

我之前也碰到过类似的需求，其实用CGAL的Aff_transformation_3把任意向量旋转到Z轴上，核心是确定旋转参数或者构建正确的正交变换矩阵。下面给你两种实用的实现方式：

方法一：基于轴角旋转 #

这种方法的思路是计算原向量与Z轴之间的旋转轴和角度，直接构造旋转变换：

• 处理特殊情况：如果输入向量已经和Z轴平行（方向相同或相反），直接返回单位变换即可，不需要旋转；如果是零向量则抛出错误，避免后续计算异常。
• 计算旋转轴：旋转轴是原向量与Z轴向量的叉乘结果，这个轴垂直于两个向量所在的平面，最后要归一化确保是单位向量。
• 计算旋转角度：通过点积计算两个单位向量的夹角余弦值，再用acos转成弧度作为旋转参数。
• 构造旋转变换：用CGAL的ROTATION模式，结合轴和角度创建Aff_transformation_3对象。

示例代码如下：

#include <CGAL/Exact_predicates_inexact_constructions_kernel.h>
#include <CGAL/Aff_transformation_3.h>
#include <cmath>
#include <stdexcept>

typedef CGAL::Exact_predicates_inexact_constructions_kernel K;
typedef K::Vector_3 Vector_3;
typedef K::Aff_transformation_3 Aff_transformation_3;

Aff_transformation_3 rotate_vector_to_z_axis(const Vector_3& v) {
    const Vector_3 z_axis(0, 0, 1);
    
    // 处理零向量
    if (CGAL::squared_length(v) == 0) {
        throw std::invalid_argument("Input vector cannot be zero.");
    }
    
    // 检查是否已经与Z轴平行
    if (CGAL::collinear(v, z_axis)) {
        return Aff_transformation_3(CGAL::IDENTITY);
    }
    
    // 计算并归一化旋转轴
    Vector_3 rotation_axis = CGAL::cross_product(v, z_axis);
    rotation_axis = rotation_axis / CGAL::sqrt(CGAL::squared_length(rotation_axis));
    
    // 计算旋转角度（弧度）
    Vector_3 unit_v = v / CGAL::sqrt(CGAL::squared_length(v));
    double dot_product = CGAL::to_double(CGAL::scalar_product(unit_v, z_axis));
    double rotation_angle = std::acos(dot_product);
    
    // 构造旋转变换
    return Aff_transformation_3(CGAL::ROTATION, rotation_axis, rotation_angle);
}

方法二：基于正交基构建变换矩阵 #

另一种思路是构造一个正交坐标系，将原向量的方向映射为Z轴，再基于这个正交基创建变换矩阵：

• 归一化原向量：得到单位向量u，作为新坐标系的Z轴。
• 构造正交基：先找一个与u不共线的向量，叉乘得到正交的X轴；再通过u和X轴叉乘得到Y轴，确保三个轴两两正交。
• 构造变换矩阵：用这三个正交向量作为变换的列向量（CGAL变换矩阵采用列优先顺序），创建Aff_transformation_3。

示例代码：

Aff_transformation_3 rotate_vector_to_z_axis_v2(const Vector_3& v) {
    const Vector_3 z_axis(0, 0, 1);
    
    if (CGAL::squared_length(v) == 0) {
        throw std::invalid_argument("Input vector cannot be zero.");
    }
    
    if (CGAL::collinear(v, z_axis)) {
        return Aff_transformation_3(CGAL::IDENTITY);
    }
    
    // 归一化输入向量作为新Z轴
    Vector_3 u = v / CGAL::sqrt(CGAL::squared_length(v));
    
    // 构造正交X轴
    Vector_3 x_axis = (std::abs(CGAL::to_double(u.x())) > 0.5 || std::abs(CGAL::to_double(u.y())) > 0.5) 
                      ? Vector_3(0, 1, 0) 
                      : Vector_3(1, 0, 0);
    x_axis = CGAL::cross_product(x_axis, u);
    x_axis = x_axis / CGAL::sqrt(CGAL::squared_length(x_axis));
    
    // 构造正交Y轴
    Vector_3 y_axis = CGAL::cross_product(u, x_axis);
    
    // 构造变换矩阵：将自定义正交基映射到标准坐标系
    return Aff_transformation_3(
        x_axis.x(), y_axis.x(), u.x(), 0,
        x_axis.y(), y_axis.y(), u.y(), 0,
        x_axis.z(), y_axis.z(), u.z(), 0,
        0, 0, 0, 1
    );
}

验证方式 #

你可以用以下代码测试变换是否正确：

int main() {
    Vector_3 test_vector(1, 1, 0);
    auto transform = rotate_vector_to_z_axis(test_vector);
    Vector_3 transformed = transform.transform(test_vector);
    
    // 验证变换后的向量是否与Z轴平行
    assert(CGAL::collinear(transformed, Vector_3(0,0,1)));
    return 0;
}

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