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

相关推荐
武文斌777 分钟前
复习总结最终版:单片机
linux·单片机·嵌入式硬件·学习
sealaugh322 小时前
AI(学习笔记第十二课) 使用langsmith的agents
人工智能·笔记·学习
QZ_orz_freedom2 小时前
学习笔记--事务管理
笔记·学习
程序员大雄学编程2 小时前
「机器学习笔记14」集成学习全面解析:从Bagging到Boosting的Python实战指南
笔记·机器学习·集成学习
im_AMBER2 小时前
Web 开发 30
前端·笔记·后端·学习·web
试试勇气3 小时前
Linux学习笔记(八)--环境变量与进程地址空间
linux·笔记·学习
蒙奇D索大3 小时前
【数据结构】考研数据结构核心考点:平衡二叉树(AVL树)详解——平衡因子与4大旋转操作入门指南
数据结构·笔记·学习·考研·改行学it
andwhataboutit?4 小时前
Docker Compose学习
学习·docker·容器
郭庆汝4 小时前
自然语言处理笔记
笔记·自然语言处理·easyui
二进制怪兽4 小时前
[笔记] 驱动开发:Virtual-Display-Driver编译过程
笔记