admin管理员组

文章数量:1516870

从这篇文章开始, 学习如何使用g2o, ceres, gtsam三个优化库进行后端优化.

在开始使用g2o进行优化的代码讲解之前, 先分析一下karto的后端的位姿图相关的数据结构.

karto 在 Mapper.h 中定义了后端优化的接口 ScanSolver, 在实现自己的优化的代码时只有对这个接口进行继承并重写就可以了.

ScanSolver的定义如下 

/**
   * Graph optimization algorithm
   */classScanSolver{
   
   public:/**
     * Vector of id-pose pairs
     */typedef std::vector<std::pair<kt_int32s, Pose2>> IdPoseVector;public:/**
     * Solve!
     */virtualvoidCompute()=0;/**
     * Adds a node to the solver
     */virtualvoidAddNode(Vertex<LocalizedRangeScan>*/*pVertex*/){
   
   }/**
     * Adds a constraint to the solver
     */virtualvoidAddConstraint(Edge<LocalizedRangeScan>*/*pEdge*/){
   
   }};// ScanSolver

1 节点的数据结构

首先看AddNode函数

virtual void AddNode(karto::Vertex<karto::LocalizedRangeScan> *pVertex);

可知, 这个函数传入的是 karto::Vertex<karto::LocalizedRangeScan> *pVertex 格式的节点类型.

karto::Vertex

接下来, 看一下karto中对Vertex的定义的代码. 如下所示 

/**
   * Represents an object in a graph
   */template<typenameT>classVertex{
   
   friendclassEdge<T>;inlineconst std::vector<Edge<T>*>&GetEdges()const{
   
   return m_Edges;}inline T *GetObject()

本文标签： 初探后端编程

版权声明：本文标题：初探Karto后端：深入了解2D激光SLAM中位姿图的数据结构与优化方法 内容由网友自发贡献，该文观点仅代表作者本人， 转载请联系作者并注明出处：https://www.betaflare.com/web/1771003966a3260962.html， 本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如发现本站有涉嫌抄袭侵权/违法违规的内容，一经查实，本站将立刻删除。