ORB-SLAM3 oplusImpl(Δx)
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) 上的指数映射与平移的耦合由左乘保证)。