一种基于伪距离差的多潜器实时协同定位方法
知识产权简介
本发明公开了一种基于伪距离差的多潜器实时协同定位方法,涉及潜航器定位领域。本发明面向水下无锚场景,设计了伪距离差作为潜器间的相对测量,利用潜器间的通信时间差和声速剖面联合补偿潜器时钟异步和水下声线弯曲的影响,实现相对测量与潜器位置关系的准确刻画。进一步,基于伪距离差,利用潜器的位置信息,设计了带有扩展状态向量的状态空间模型,并利用Sage-Husa估计器,实时估计实际水下环境中难以准确获取的测量噪声方差。在此基础上,针对伪距离差的非线性,设计改进的容积卡尔曼滤波算法,实现潜器的协同定位,解决了水下无锚场景中潜器系统协同定位难的问题。