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

相关推荐
琳少_7 小时前
java程序开发笔记
java·开发语言·数据库·笔记
Z21-X11 小时前
云原生运维学习笔记:Kubernetes Volume 与 Secret 实验
运维·笔记·学习·云原生·kubernetes
一只大鸽子11 小时前
游戏开发笔记7-Godot RPG游戏基础-场景切换、全局脚本
笔记·游戏·godot
console.log('npc')14 小时前
Python 学习教程 · 第4课:数据结构
数据结构·python·学习
吃我一窝jio15 小时前
Docker+Jenkins+K8s全流程部署
java·开发语言·笔记·python
我超膨胀der.15 小时前
关于如何完整转移LABVIEW源码
笔记·labview
国科安芯15 小时前
FPGA上电偶发不启动:多轨电源时序、PGOOD与并联供电的FAE排查笔记——ASP4644S2B在星载智能处理板中的工程应用分析
笔记·单片机·嵌入式硬件·fpga开发·低轨卫星·抗辐射
星落梦生17 小时前
Docker学习(11)
学习·docker·容器
一条破秋裤1 天前
【1115】【多线程】【笔记】
前端·chrome·笔记