【OpenREALM学习笔记:11】关于位姿矩阵从Sophus库的SE3类型转换为OpenCV库的Mat类型

cpp 复制代码
#include <Eigen/Core>
#include <Eigen/Dense>

#include <opencv2/opencv.hpp>
#include <opencv2/core/eigen.hpp>

cv::Mat Tcw;
Sophus::SE3f  Tcw_SE3f = mpSLAM->TrackMonocular(cv_ptr->image,cv_ptr->header.stamp.toSec());
Eigen::Matrix4f Tcw_Matrix = Tcw_SE3f.matrix();
cv::eigen2cv(Tcw_Matrix, Tcw);

第一行:声明一个OpenCV的Mat类型对象,用以存储相机在世界坐标系下的变换矩阵。Tcw表示从世界坐标系到相机坐标系的变换矩阵;

第二行:从SLAM系统中追踪单目相机的运动并获取位姿,而后将其存储在一个Sophus库的SE3f对象当中Tcw_SE3f当中。SE3f表示的是一个欧式群的单精度浮点类型,用以表示三维的旋转和平移;

第三行:将第二行的SE3f对象转换为4x4的浮点数矩阵,并将其赋值给Eigen::Matrix4f类型的矩阵对象;

第四行:这行代码主要用于将Eigen库的矩阵变换为OpenCV库的矩阵。

这里需要注意一点:在头文件的声明的时候,Eigen头文件的声明要放在opencv的eigen.hpp之前;否则,eigen.hpp头文件在程序运行的时候,会出现Eigen::XXXXXXX未定义的情况。

相关推荐
AlexMercer101228 分钟前
[前端]1.html基础
前端·笔记·学习·html
楚肽生物小敏34 分钟前
Cy3-Tyramide,Cyanine 3 Tyramide; 174961-75-2
笔记
健康平安的活着2 小时前
langchain4j笔记篇(阳哥)
笔记
一川月白7092 小时前
51单片机---硬件学习(跑马灯、数码管、外部中断、按键、蜂鸣器)
单片机·学习·51单片机·外部中断·蜂鸣器·数码管·跑马灯
励志不掉头发的内向程序员2 小时前
STL库——二叉搜索树
开发语言·c++·学习
ホロHoro3 小时前
学习笔记:MYSQL(4)
笔记·学习·mysql
aaaweiaaaaaa4 小时前
c++基础学习(学习蓝桥杯 ros2有C基础可看)
c++·学习·蓝桥杯·lambda·ros2·智能指针·c++类
MadPrinter4 小时前
SpringBoot学习日记 Day11:博客系统核心功能深度开发
java·spring boot·后端·学习·spring·mybatis
wanzhong23335 小时前
ArcGIS学习-18 实战-降雨量空间分布插值分析
学习·arcgis
wanzhong23335 小时前
ArcGIS学习-19 实战-表面分析
学习