当前位置:   article > 正文

卡尔曼滤波结果和图优化的融合_图优化 卡尔曼滤波

图优化 卡尔曼滤波

仅使用卡尔曼滤波结果作为初始值辅助NDT算法的进行,并没有进行实际融合。


论文地址

算法流程

  1. 扩展的卡尔曼滤波融合GPS、惯性测量单元IMU、编码器里程计得到融合后的定位信息

  2. 基于3D-NDT配准得到激光里程计

  3. 建图优化。融合单帧激光提取的地面数据和融合定位数据构建图优化的边约束

  4. 求解优化后的位姿
    在这里插入图片描述

图优化框架

以机器人的当前位姿作为节点,融合定位数据和激光提取的地面参数作为图优化结构中的边构建约束方程。

  • 3D-NDT:变换关系、地面参数、融合定位位姿——约束边
声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/天景科技苑/article/detail/744809
推荐阅读
相关标签
  

闽ICP备14008679号