45-总结-【cartographer源码分析】系列的第五部分【kalman_filter】

本文总结了Cartographer源码中kalman_filter的实现,涉及GaussianDistribution类,包括均值和协方差的处理,UnscentedKalmanFilter类的预测与更新过程,以及PoseTracker类在位姿估计中的应用。卡尔曼滤波用于融合不同传感器数据,进行精准的位姿估计。
摘要由CSDN通过智能技术生成

【cartographer源码分析】系列的第五部分【kalman_filter】。

现总结kalman_filter文件夹涉及到的主要功能:

【1】kalman_filter/gaussian_distribution.h


GaussianDistribution定义了多个变量的高斯分布。构造函数是N*1的均值矩阵和N*N的协方差矩阵

  • 数据成员:

    • Eigen::Matrix mean_; //N*1,均值
    • Eigen::Matrix covariance_; //N*N。协方差
  • 构造函数

  • GaussianDistribution(const Eigen::Matrix& mean, 
    const Eigen::Matrix& covariance) 
    初始化均值和协方差

  • 全局函数

    • 重载"+"加号操作符

      • GaussianDistribution operator+(const GaussianDistribution& lhs, 
        const GaussianDistribution& rhs) 
        高斯+高斯=对应均值+均值,对应协方差+协方差 
        返回值:新高斯对象 
        .
    • 重载乘法运算符

      • GaussianDistribution operator*(const Eigen::Matrix& lhs, 
        const GaussianDistribution& rhs) 
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值