FAST-LIO2代码解析(四)

他人是一面镜子，保持谦虚的态度

已于 2024-06-03 10:28:54 修改

阅读量683

点赞数

分类专栏： LiDAR-IMU 文章标签： FAST-LIO2

于 2024-04-12 16:53:54 首次发布

本文链接：https://blog.csdn.net/hltt3838/article/details/137686654

版权

LiDAR-IMU 专栏收录该内容

13 篇文章 19 订阅 ¥39.90 ¥99.00

订阅专栏

超级会员免费看

本文深入解析FAST-LIO2传感器融合算法，从主函数出发，探讨get_f函数、df_dx和df_dw函数以及h_share_model残差计算函数的关键作用，阐述其在ESKF和IKD-Tree中的应用。

摘要由CSDN通过智能技术生成

4. h_share_model残差计算函数

0. 简介

在讲完前面三节后我们将开始以主函数触发，并分析ESKF和IKD-Tree中对应的算法。其中ESKF作为主要的部分来进行展开介绍

1. 主函数

作为主函数，内部主要存放了一系列的参数传入，这部分没什么好说的基本都已经注释完成。

// FAST_LIO2主函数
int main(int argc, char **argv)
{
    /*****************************初始化：读取参数、定义变量以及赋值*************************/
    // 初始化ros节点，节点名为laserMapping
    ros::init(argc, argv, "laserMapping");
    ros::NodeHandle nh;
    // 从参数服务器读取参数值赋给变量（包括launch文件和launch读取的yaml文件中的参数）

    nh.param<bool>("publish/scan_publish_en", scan_pub_en, true);               // 是否发布当前正在扫描的点云的topic
    nh.para