【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未定义的情况。

相关推荐
承渊政道11 分钟前
【Python编程—从入门到实践】(用户账户:给Django网站装上登录系统,让每个人拥有自己的学习笔记)
python·学习·pycharm·django
诗句藏于尽头1 小时前
游戏《完美神话》-使用Ai-agent进行修复已停服游戏到本地成功部署以及GM端网页完整教程
人工智能·学习·游戏
希和20271 小时前
51 单片机学习笔记:LCD1602、独立按键、I2C 与 AT24C02 掉电存储(江科大课程小白笔记)
笔记·单片机·学习
北风toto1 小时前
Spring Boot 常用注解 · 概要笔记
spring boot·笔记·后端
承渊政道2 小时前
【Python编程—从入门到实践】(设置样式并部署:给Django网站换新装,把学习笔记发布到互联网)
python·学习·pycharm·django
下一站春风里2 小时前
Spring IoC 控制反转 完整技术笔记
java·spring boot·笔记·spring
~kiss~13 小时前
A Survey of On-Policy Distillation for LLMs 学习(一)
学习
一只大鸽子14 小时前
游戏开发笔记4-像素画基础 轮廓-直线和曲线
笔记
小杨小杨、努力变强!15 小时前
python学习笔记
笔记·学习
杨逢昌工厂6S管理18 小时前
150-杨逢昌一线现场诊断笔记:越管一线越抵触背后的熵增机理与基准化治理
经验分享·笔记·职场和发展·学习方法