一种迭代容积点无迹卡尔曼滤波方法

摘要

本发明公开了一种迭代容积点无迹卡尔曼滤波方法，包括以下步骤：迭代容积点无迹卡尔曼滤波算法sigma点的选取；重新确定sigma点的加权系数；给出容积点无迹卡尔曼滤波算法的流程；迭代计算容积点无迹卡尔曼滤波算法。本发明能够有效应用在含有随机噪声的高自由度强非线性的系统中，协同处理解决计算量问题、非线性滤波发散问题、负权重问题，能够有效提高状态量的估计精度和实时性，不会使滤波结果发散。本发明相对于容积卡尔曼滤波可以更好地拟合非线性系统函数的统计特性，相对于无迹卡尔曼滤波可以避免sigma点权重的非正定性。