【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函数的内容如下图:

相关推荐
南境十里·墨染春水15 分钟前
C++笔记 STL lterator迭代器
开发语言·c++·笔记
zjeweler18 分钟前
宝藏网站推荐:云服务器特惠与网安学习资源的一站式聚合平台
运维·服务器·学习
芸开发35 分钟前
VMware+RockyLinux10
linux·笔记
qq_571099351 小时前
学习周报四十二
学习
SunAqua1 小时前
《MCU与DSP芯片笔记》二、DSP芯片TI C2000系列TMS320F2800137
笔记·单片机·嵌入式硬件
HERR_QQ1 小时前
端到端课程自用 3 规划基于query的端到端规划
笔记·神经网络·学习·自动驾驶
思麟呀1 小时前
在Select的基础上学习poll
linux·网络·学习·tcp/ip
d111111111d1 小时前
STM32-UART抽象层封装调试
笔记·stm32·单片机·嵌入式硬件·学习
喜欢吃燃面1 小时前
Linux 信号保存机制深度解析:从内核数据结构到进程状态管理
linux·运维·数据结构·学习
求学的小高1 小时前
数据结构Day9(图的遍历、图应用及相关算法)
数据结构·笔记·考研