基于卡尔曼滤波的平面轨迹优化

文章目录

  • 概要
  • 卡尔曼滤波代码
  • 主函数代码
  • CMakeLists.txt

概要

在进行目标跟踪时,算法实时测量得到的目标平面位置,是具有误差的,连续观测,所形成的轨迹如下图所示,需要对其进行噪声滤除。这篇博客将使用卡尔曼滤波,对轨迹进行优化。

基于卡尔曼滤波的平面轨迹优化_第1张图片
优化的结果为黄色线。
基于卡尔曼滤波的平面轨迹优化_第2张图片

卡尔曼滤波代码

#include 

你可能感兴趣的:(机器人导航定位,c++,卡尔曼滤波)