视觉SLAM十四讲(三)——三维空间刚体运动(下)

最新推荐文章于 2024-11-19 13:44:51 发布

RBLT

最新推荐文章于 2024-11-19 13:44:51 发布

阅读量538

点赞数

CC 4.0 BY-SA版权

分类专栏： SLAM 视觉SLAM 文章标签： Eigen

本文链接：https://blog.youkuaiyun.com/EliminatedAcmer/article/details/81414083

这篇博客主要讲解如何使用Eigen库进行三维空间刚体运动的计算，包括安装Eigen库的方法以及通过CMakeLists.txt进行编译。还介绍了Eigen的几何模块在刚体运动中的应用。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

理论部分请看 :三维空间刚体运动

一、Eigen的使用

首先安装 Eigen：

sudo apt-get install libeigen3-dev

一般都安装在

/usr/include/eigen3/

中
代码：

#include <iostream>
#include <ctime>

using namespace std;

//Eigen 部分
#include <Eigen/Core>
//稠密矩阵的代数运算
#include <Eigen/Dense>

#define MATRIX_SIZE 50

//本程序演示了 Eigen 基本类型的使用

int main(int argc,char** argv){
   //声明一个 2×3 的 float 矩阵
   Eigen::Matrix<float,2,3> matrix_23;
   //Eigen 通过 typedef 提供了许多内置类型，不过底层仍然是 Eigen::Matrix
   //例如 Vector3d 实质上是 Eigen::Matrix<double,3,1> 
   Eigen::Vector3d v_3d;
   //Matrix3d 实质上是 Eigen::Matrix<double,3,3>
   Eigen::Matrix3d matrix_33 = Eigen::Matrix3d::Zero();
   //如果不确定矩阵大小，可以使用动态大小的矩阵
   Eigen::Matrix<double,Eigen::Dynamic,Eigen::Dynamic> matrix_dynamic;
   //更简单的
   Eigen::MatrixXd matrix_x;

   //矩阵操作
   //输入数据
   matrix_23 << 1,2,3,4,5,6;
   //输出
   cout<<"2*3矩阵 "<<matrix_23<<endl;

   //用（）访问矩阵中的元素
   for(int i = 0;i<