1
#include<cmath>
2
#include<Eigen/Core>
3
#include<Eigen/Dense>
4
#include<iostream>
5

6

7
int main() {
8

9
    Eigen::Vector3f p(2.0f, 1.0f, 1.0f);
10
    Eigen::Matrix3f r;
11

12
    // 提前计算好浮点数角度
13
    float pi = std::acos(-1);
14
    float angle = 45.0f / 180.0f * pi;
15

16
    r << std::cos(angle), -std::sin(angle), 1.0f,
17
        std::sin(angle), std::cos(angle), 2.0f,
18
        0.0f, 0.0f, 1.0f;
19

20
    Eigen::Vector3f result = r * p;
21

22
    std::cout << "变换后的结果是:\n" << result << std::endl;
23

24
    return 0;
25
}