【OpenREALM学习笔记:13】pose_estimation.cpp和pose_estimation.h

UML Class Diagram

图中红色框为头文件中所涉及到的函数、变量和结构体

核心函数

PoseEstimation::process()

其核心作用为执行位姿估计的处理流程,并返回是否在此循环中进行了任何处理。

在这个函数中判断并完成地理坐标的初始化或这地理坐标的更新。

这里需要注意的是在该函数下,涉及到Frame类和GeometricReferencer类,两个类中都有一个同名的变量

Plain 复制代码
m_transformation_w2g

但是,该变量在不同的命名空间,所以所存储数据的地址是不一样的。两者通过process函数中的applyGeoreferenceToBuffer函数联系起来,如下图:

PoseEstimation::applyGeoreferenceToBuffer()

继续分析这个函数

其中,GeometricReferencer类的m_transformation_w2g变量,通过m_T_w2g变量传给Framelei的m_transformation_w2g,涉及到的函数为initGeoreference,如下图

但initGeoreference并不是真正操作的函数,如下图:

在这里可以看到Frame类中的m_transformation_w2g首先初始化为单位阵,之后通过updateGeoreference函数进行复制,并在这个函数中将稀疏点云的视觉坐标系也变成地理坐标系,updateGeoreference函数的内容如下图:

相关推荐
Moonnnn.1 小时前
51单片机学习——静态数码管显示
笔记·嵌入式硬件·学习·51单片机
JiaJunRun1 小时前
Java集合体系结构面试题
java·开发语言·windows·学习·安全
爱上妖精的尾巴1 小时前
3-1 WPS JS宏工作簿的新建与保存(批量新建工作簿)学习笔记
开发语言·javascript·笔记·js·wps
牛亚肖1 小时前
Plantsimulation中机器人怎么通过阻塞角度设置旋转135°
笔记
淳杰1 小时前
ubuntu部署小笔记-采坑
linux·笔记·ubuntu
百里与司空2 小时前
WPF基本布局基础
学习·wpf
小志biubiu2 小时前
Linux版本控制器Git【Ubuntu系统】
linux·运维·服务器·git·学习·ubuntu
烟雨迷3 小时前
八大排序算法(C语言实现)
c语言·数据结构·学习·算法·排序算法
liruiqiang053 小时前
线性模型 - 支持向量机(参数学习)
人工智能·学习·机器学习·支持向量机
Archie_IT3 小时前
Ollama辅助工具在思源笔记中的核心玩法助力实现AI高效创作
人工智能·笔记