一种基于最大相关熵的滤波定位方法、系统及滤波器
摘要:
本发明提供一种基于最大相关熵的定位滤波方法、系统及滤波器,该方法包括:获取载体的当前状态参数,得到动力学模型的IMU状态方程和基于卡尔曼滤波的UWB观测方程;基于所述IMU状态方程和所述UWB观测方程建立IMU‑UWB混合定位模型;基于最大相关熵准则求解所述IMU‑UWB混合定位模型,得到固定点的解析表达式,输出定位结果。本发明不仅可以较好地削弱UWB观测异常影响,避免因观测异常造成的矩阵数值不稳定问题,具备较好鲁棒性;而且在定位精度和定位稳健性上均表现出最优性能。
0/0