[发明专利]考虑量测异常的集群式多深海潜航器的协同定位方法

说明书

本发明公开了一种考虑量测异常的威力集群式多深海潜航器协同定位方法，在当地地理坐标系下建立了状态误差方程和考虑主从深海潜航器的相对距离测量信息异常的量测方程，为完成多深海潜航器协同定位提供数学模型。其次，根据多深海潜航器协同定位的特点以及Krein空间线性估计理论，引入乘性噪声和参数不确定性，在考虑量测异常的情况下设计了新形式Krein空间的协同导航的鲁棒后验滤波方程。同时，设计自适应算法对滤波器建模的参数不确定性进行在线估计和补偿，提高协同定位物理过程与所建数学模型的匹配度。最终实现威力集群多深海潜航器整体的高精度、高可靠性协同导航定位。

技术领域

本发明属于导航技术领域，涉及了深海潜航器的导航定位方法，具体是一种考虑量测异常的集群式多深海潜航器的协同定位方法。

背景技术

威力集群多深海潜航器协同工作系统具有探测范围广、容错能力强、工作效率高的特点，能够实现单体深海潜航器难以完成的多样化、复杂化水下任务。

多深海潜航器的协同定位技术与空中多无人机、陆地多机器人协同工作系统的协同定位技术相比有着一定的特殊性，存在着复杂环境干扰、传感器限制、通信技术等固有难点。因此多深海潜航器间的信息获取和交流只能靠超声波来完成。

但由于超声波距离传感器的信号相关特性，主从深海潜航器间的相对距离信息中往往含有乘性噪声，同时水下声波波速受海水温度、盐度变化影响，其不确定性会造成主从深海潜航器的相对距离建模中的参数存在不确定性。这两种情况统称为量测异常，会造成主从潜航器协同导航系统的定位精度降低，甚至于失效。

因此在海洋复杂的环境中，考虑量测异常情况下实现主从式深海潜航器的精准协同定位是目前多深海潜航器研究的一个热门方向。

发明内容

为解决上述问题，本发明针对威力集群多深海潜航器在协同定位过程中容易出现量测异常情况，造成协同导航系统的精度和可靠性下降的问题，从而提供一种考虑量测异常的威力集群式多深海潜航器协同定位方法。

本发明通过设计新形式krein空间滤波器来有效解决量测中存在乘性噪声和参数不确定性时传统H∞滤波器难以建模的困难，降低滤波器的时空复杂度。同时，设计自适应算法对滤波器建模的参数不确定性进行在线估计和补偿，提高协同定位物理过程与所建数学模型的匹配度。最终实现威力集群多深海潜航器整体的高精度、高可靠性协同导航定位。

技术方案：为实现上述发明目的，本发明采用的技术方案，包括如下步骤：

S1：建立从深海潜航器在当地地理坐标系下的状态误差方程和考虑主从深海潜航器的相对距离测量信息异常的量测方程；

S2：根据多深海潜航器协同定位的特点以及Krein空间线性估计理论，引入乘性噪声和参数不确定性，在考虑量测异常的情况下设计新形式Krein空间的协同导航的鲁棒后验滤波方程；

S3：设计自适应算法对滤波器建模的参数不确定性进行在线估计和补偿，提高协同定位物理过程与所建数学模型的匹配度。

本发明进一步改进在于：

所述步骤S1具体包括如下步骤：

S1-1:考虑一个15维系统状态量的主从潜航器协同定位离散系统：

其中，Δθ,Δφ,Δω表示从潜航器的姿态角误差，Δv_E,Δv_N,Δv_U代表从潜航器的东北天向速度误差，ΔL,Δλ,Δh表示从潜航器的纬度、经度、高度误差，代表从潜航器中惯性加计的常值偏移，代表从潜航器中惯性陀螺仪的常值偏移；

从潜航器惯导系统在当地地理坐标系下的离散时间误差方程为：