资讯动态

ORB-SLAM3 oplusImpl(Δx)

发布时间:2026/8/18 12:26:10 来源:尧图企业网站定制
oplusImpl是 g2o 顶点类的核心成员函数,负责用增量向量ΔxΔx更新顶点的当前估计值。不同的顶点类型定义不同的更新规则,以适应变量所在的流形空间。在源码中,其实现大致为:cppvoid VertexSE3Expmap::oplusImpl(const number_t* update) { Eigen::Mapconst Vector6d update_vec(update); SE3Quat new_estimate = SE3Quat::exp(update_vec) * _estimate; setEstimate(new_estimate); }这里SE3Quat::exp(update_vec)内部使用罗德里格斯公式计算旋转部分,并将平移部分适当处理(SO(3) 上的指数映射与平移的耦合由左乘保证)。

读完文章,也想定制专属网站?

尧图设计师 24 小时内与您沟通定制方案

免费获取报价