GPS 的静态滤波,配上MATLAB
的卡尔曼算法,真的是一套挺实用的组合。文件名是GPS_kaerman_jingtai.m
,从名字你就能看出重点是“静态”和“卡尔曼”。如果你平时做 GNSS 或者惯导相关的,肯定绕不开这个。
用的是经典的卡尔曼滤波,代码写得比较清楚,没有什么绕来绕去的逻辑。输入输出也挺直观,方便调试。适合用来做GPS 数据平滑
或者定位稳定性
的验证。
里面的状态方程和观测方程已经搭好了,不用你重新推一遍公式,省心多了。你只要根据自己手头的数据改一下噪声协方差,基本就能跑起来。
如果你还对卡尔曼滤波的实现细节感兴趣,可以顺手看看卡尔曼滤波的 MATLAB 实现,讲得也蛮清楚的。
对了,这段代码适合做静态实验,动态场景的话就要改模型或者用扩展卡尔曼了。如果你手里是运动轨迹的数据,那得注意。
,这段代码比较适合快速上手或者做算法验证。如果你经常用MATLAB
跑滤波,不妨下载下来看看,搞不好能少折腾好几天。