[发明专利]一种运载体水下定位的方法

摘要

本发明提供一种运载体水下定位的方法，具体过程为：一，在运载体上安装惯导系统和水声超短基线定位系统；二，判断水声超短基线定位系统的水声信息所能到达的范围内是否存在水下应答器，若存在，进入步骤六，否则，进入步骤三；三，运载体释放安装有GPS接收器的浮标；四，运载体接收浮标的GPS信号，水声超短基线定位系统测量浮标在超短基线基阵坐标系中的位置信息；五，根据所述GPS信号和位置信息，计算出运载体在导航坐标系中的位置并对所述惯导系统进行标定；六，根据水下应答器在导航坐标系中的位置信息及其在超短基线基阵坐标系中的位置信息，计算出运载体在导航坐标系中的位置并对所述惯性系统进行标定。本发明实现了运载体的水下定位。

主权项

1.一种运载体水下定位的方法，其特征在于，具体过程为：一，在运载体上安装惯导系统和水声超短基线定位系统；二，判断水声超短基线定位系统的水声信息所能到达的范围内是否存在水下应答器，若存在，进入步骤六，若不存在，进入步骤三；三，运载体释放安装有GPS接收器的浮标；待所述浮标上浮至海面上时，其将接收的GPS信号转换成声学信号传输出去；四，运载体接收浮标的GPS信号，水声超短基线定位系统测量浮标在超短基线基阵坐标系中的位置信息；五，根据所述GPS信号和位置信息，计算出运载体在导航坐标系中的位置并对所述惯导系统进行标定；六，根据水下应答器在导航坐标系中的位置信息及其在超短基线基阵坐标系中的位置信息，计算出运载体在导航坐标系中的位置并对所述惯导系统进行标定；所述步骤五和六中惯导系统进行标定的具体过程为：设定惯导系统在导航坐标系中的位置为(X_v，Y_v，Z_v)′，应答器或浮标在超短基线基阵坐标系中的“视在位置”为基准应答器在东北天坐标系中的位置为(X_w，Y_w，Z_w)′，水下运载体的摇摆参数为[Φ，θ，ψ]，USBL与INS之间存在小失调角为：线性偏移为：载体坐标系相对导航坐标系方向余弦矩阵：应答器或浮标“视在位置”转换为相对载体惯导系统原地的地理坐标数据：惯导系统在直角地理坐标系中的准确位置及误差为：(δXv,δYV,δZv)′＝(X′v,Y′v,Z′v)′‑Xv，Yv，Zv)′惯导系统在经纬度地理坐标系中的准确位置及误差为：(δLv,δDV,δZv)′＝(L′v,D′v,Z′v)′‑Lv，Dv，Zv)′。