一种多AUV协同定位鲁棒延迟滤波方法

摘要

本发明公开了一种多AUV协同定位鲁棒延迟滤波方法，包括步骤一：建立多AUV协同定位模型；步骤二：通过将延迟转换为量测偏置构建存在时变量测延迟的非线性协同定位系统模型；步骤三：构建时变延迟模型下向量与向量预测值的统计相似性度量；步骤四：将后验概率密度函数近似为高斯分布，最大化代价函数下界求得近似解；步骤五：通过求解代价函数优化解，完成辅助变量更新；步骤六：通过辅助变量对量测噪声协方差矩阵进行修正。本发明在水声通讯延迟与量测噪声异常值共同存在的情形下，可同时削弱延迟与非高斯噪声对定位精度的影响。