先贴一下代码:
在相机位姿的顶点类中,增量函数:
virtual void oplusImpl ( const double* update )
{
Eigen::VectorXd::ConstMapType v ( update, VertexCameraBAL::Dimension );
_estimate += v;
}
landmark顶点类中增量函数:
virtual void oplusImpl ( const double* update )
{
//这里也是一样,将增量数组构造成增量矩阵,
Eigen::Vector3d::ConstMapType v ( update );
//将增量矩阵加到估计上
_estimate += v;
}
这里两句: