说明:本章介绍两种非线性Kalman滤波器[15-17],一种是扩展Kalman滤波器(Extended Kalman Filter,简称EKF),其基本思想是利用泰勒展开,将非线性方程直接线性化。线性化后的系统模型和系统实际的非线性模型会有差别,非线性越强,差别就会越大。不过,EKF的优势也不容忽视,由...
说明:这是fastslam程序,里面包含有1.0,2.0算法的实现过程,是一个很好的仿真学习fastslam的程序。可以进行改进优化。 fastslam算法使用了粒子滤波算法进行定位,使用EKF进行特征更新,能够实现很好的定位效果。相比于fastslam1.0算法fastslam2.0算法将最新...