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

相关推荐
后季暖26 分钟前
电商问数笔记(2)
笔记
xier_ran35 分钟前
【infra之路】AI 编译器学习笔记(二):重拾 C++——移动语义与 LLVM 风格的类型转换
人工智能·笔记·学习
li星野3 小时前
5 TYPES OF ADVERBS — One-Page Notes
学习
星恒随风3 小时前
Linux库的底层原理:ELF文件格式、静态链接、程序加载、虚拟地址空间与GOT/PLT详解
linux·运维·笔记·学习·状态模式
罗西的思考3 小时前
[Agent Memory / 强化学习] MemPO源码学习笔记 — (7)— 混合机制
笔记·学习
starsky762383 小时前
Agent学习——上下文工程(三)
学习
ClinicTech4 小时前
婴儿培养箱技术笔记:温控、报警与数据记录的三层架构
笔记
xiaominngtongxue4 小时前
从一次接触网实训课看中职实训教学的组织逻辑
笔记
xier_ran5 小时前
【infra之路】AI 编译器学习笔记(四):PatternRewriter 与贪心 driver
人工智能·笔记·学习
小弥儿5 小时前
GitHub今日热榜 | 2026-10-12:pytorch 上升四位
人工智能·pytorch·学习·开源·github