[发明专利]一种水下滑翔器导航定位系统及上浮精度校正方法

权利要求书

1.一种水下滑翔器导航定位系统，其特征在于，包括微机电系统惯性测量单元MEMS-IMU，全球卫星定位系统接收模块GPS，三轴磁力计，多普勒测速仪DVL以及组合导航硬件处理系统；所述MEMS-IMU集成了三轴加速度计和三轴陀螺仪，输出的三轴加速度和角速率信息通过惯性导航算法得到水下滑翔器的姿态、速度和位置导航信息；所述三轴磁力计用于校正滑翔器的航向信息，所述多普勒测速仪用于判断水下滑翔器的运动状态；所述GPS用于滑翔器上浮校正操作中，与MEMS-IMU组成GPS/INS位置速度校正的松组合导航系统，利用组合导航滤波器算法，校正滑翔器的速度、位置误差；所述组合导航硬件处理系统用于三轴磁力计、GPS、MEMS-IMU以及DVL信号的接收处理与时钟同步工作，以及组合导航多传感器信息的算法解算工作；其中上浮校正利用GPS和MEMS-IMU输出的信号，采用GPS/INS位置速度校正的松组合导航系统，完成滑翔器的导航定位；其中组合导航滤波器算法采用基于多重自适应渐消因子的H∞卡尔曼滤波算法；

所述滤波算法的状态预测协方差阵H∞滤波增益阵H∞滤波状态最优协方差阵式中k和k-1分别表示当前时刻和前一时刻，Φ_k|k-1为状态转移矩阵，H_k为观测矩阵，Q_k-1为系统噪声协方差，S_k为多重自适应渐消因子阵，L_k为对系统状态量的线性组合的估计，I为单位阵，γ为自适应阈值。

2.根据权利要求1所述的水下滑翔器导航定位系统，其特征在于，所述水下滑翔器导航定位系统具有两种运行状态：水下工作状态和上浮校正状态；若导航定位误差过大，则滑翔器停止实时工作，由水下工作状态切换为上浮校正状态；当GPS/INS组合导航系统的速度、位置误差小于设定阈值时，则滑翔器由上浮校正状态切换为水下工作状态，继续工作。

3.根据权利要求1所述的水下滑翔器导航定位系统，其特征在于，水下工作利用MEMS-IMU和三轴磁力计输出的信号，采用基于互补滤波的四元数算法完成滑翔器的导航定位。

4.根据权利要求1所述的水下滑翔器导航定位系统，其特征在于，所述多重自适应渐消因子阵S_k＝diag(s₁,s₂,s₃...,s_n)由下式计算：

式中，λ_i为观测阵H_k第i个观测元素，j_ii(k)为矩阵的第i个对角线元素,ε_i为卡方检测的阈值，υ_i(k)为新息阵V_k第i个观测元素，b_ii(k)为矩阵的第i个对角线元素。

5.根据权利要求4所述的水下滑翔器导航定位系统，其特征在于，所述自适应阈值γ＝η·γ_a；其中，Trace()表示矩阵求迹运算，ρ()表示矩阵的谱半径。