基于Fourier-Hermite正交多项式扩展椭球集员滤波方法
摘要:
本发明提出了一种基于Fourier‑Hermite正交多项式扩展椭球集员滤波方法,其步骤为:建立GNSS/INS组合导航系统的模型方程;计算第k‑1步的系统状态参数分量的不确定区间;对状态方程和观测方程实施Fourier‑Hermite级数多项式逼近;计算Fourier‑Hermite级数多项式逼近的误差边界,获取非线性方程的Fourier‑Hermite级数多项式逼近计算误差的外包椭球;利用线性椭球集员滤波算法计算预测状态变量的椭球边界、更新状态椭球边界、计算第k步的状态参数变量估计值和估计方差矩阵。本发明利用Fourier‑Hermite级数多项式获得非线性系统模型的线性化逼近,计算精度较高,降低了计算复杂度,并且有效保证了扩展椭球集员滤波算法的计算稳定性。
0/0