一种基于北斗信标的水下移动节点无源定位方法，包括：步骤1.海面信标节点接收北斗卫星导航系统广播的定位导航信号，实时更新自身位置，并与北斗时钟保持同步；处于一个三角形栅格顶点的3个海面信标将自身位置和序号等信息组合成定位报文，根据自身发送定位报文的时序表，同时广播给水下移动节点；步骤2.当水下移动节点接收到定位报文时，利用3个定位报文的到达时刻和报文内容，用滤波算法解算其当前时刻的位置；当水下移动节点没有接收到定位报文时刻，也可以利用滤波算法估算其当前时刻的位置。本发明还包括实施本发明方法的系统。
1.基于北斗信标的水下移动节点无源定位方法，包括如下步骤：
步骤1.海面信标节点上的北斗卫星接收机，接收北斗卫星导航系统广播的定位导航信号，实时解析出海面信标北斗卫星天线所处位置的经度、纬度和高程，传输给海面信标节点的海面主控系统，并校准海面主控系统时钟和北斗基准时间保持同步，即所有海面信标之间保持同步；海面信标的海面主控系统把北斗卫星接收机高程信息减去综合定位/通信功能的声学收发系统的高度差值，作为海面信标节点的高程，然后把自身信标序号、经度、纬度、高程信息组合成定位报文；根据自身发送定位报文的时序表，处于一个三角形栅格顶点处的海面信标节点同时通过各自的声学收发 系统广播定位报文；
海面信标节点数量至少3个,水下移动节点定位系统的海面信标部署拓扑为:首先三个海面信标节点构成正三角形栅格,信标节点位于三角形顶点；所有海面信标节点的部署拓扑采取正三角形栅格为基本单位，无缝覆盖目标海域；
海面信标节点的定位信号广播时序：以正三角形栅格为单位，即位于一个三角形栅格上的3个海面信标节点同时广播其定位报文；当一个三角形栅格上的海面信标节点广播定位报文，相距固定时间间隔后，下一个时序的三角形栅格上的海面信标节点广播定位报文；
直至所有三角形栅格广播完定位报文，重新开始下一轮定位报文的广播时序；
3个海面信标节点同时广播定位报文，海面信标节点采用码分多址CDMA方式广播定位信号，具体地，对于编码生成的定位报文，采用多进制卷积码与M进制码元移位键控CSK相结合，并分配给海面信标节点不同的伪随机序列，实现多用户通信；每个正三角形栅格上的3个海面信标在广播定位报文时都会被分配3个不同的伪随机序列；属于不同正三角形栅格的同一个海面信标节点，在不同的正三角形栅格广播定位报文时，会被分配不同的伪随机序列；
步骤2.水下移动节点的综合定位/通信功能的声学接收系统处于侦听状态，一旦接收到定位信号，声学接收 系统完成多用户信号接收，记录3个定位报文的到达时刻，并把解码的定位报文及其到达时刻发送给水下主控系统；水下移动节点的水下主控系统解读定位报文内容，把报文中的经度、纬度、高程和对应报文到达时刻传输给水下解算模块；同时水下移动节点的水下主控系统实时从压力传感器读取深度信息，传输给水下解算模块；当水下移动节点的水下解算模块接收到来自水下主控系统的报文信息时，利用滤波算法解算其当前时刻的位置；当没有收到来自水下主控系统的报文信息时，也可以利用滤波算法估算其当前时刻的位置；
由于位于正三角形栅格上的3个信标节点采用CDMA方式同时广播定位报文，水下移动节点同时接收到3个信号；由于CDMA方式中扩频序列的准正交性质，利用串行多址干扰抵消技术抑制远近效应引起的多用户干扰MAI，恢复期望的定位报文信息；
a.当水下移动节点的水下声学接收系统接收到3个定位报文时：
(1)水下解算模块会接收到来自水下主控系统的经度、纬度、高程、定位报文到达时刻Ti，i＝1,2,3指代信标序号，与水下移动节点的深度信息；以T1为参考时间，得到不同定位报文到达时间差：△T12＝T2-T1和△T13＝T3-T1；
(2)解算模块利用高斯正算将报文中的经度和纬度转化为高斯平面坐标系，结合高程作为信标节点的三维坐标位置(Xi,Yi,Zi)，i＝1,2,3指代海面信标序号；水下移动节点位置设为(Xt,Yt,Zt)，t指代水下移动节点，其中Zt为深度信息，通过压力传感器获取，作为已知量；海面信标节点i到水下移动节点之间距离表示为(3)由于介质不均匀导致声速不是常数，不考虑声速剖面的横向变化,声速剖面表示为c(z)，z表示深度变量；利用Snell定律，建立海面信标节点i和水下移动节点之间的水平距离、传播延时与传播常数之间的关系,并离散化可得：其中ρi、τi和ni表示海面信标节点i到水下移动节点对应的水平距离，传播时延和传播常数；N表示c(z)上的采样点数量，在深度Zi和Zt之间均匀采样，j表示采样点序号，zj表示采样点处的深度，c(zj)表示深度zj对应的声速，海面信标节点i和水下移动节点直线距离与传播时延之间比值表示为：
由于信标节点都位于海面，信标节点之间深度差别较小，因此认为不同海面信标节点和水下移动节点的直线距离与传播时延之间比值相等，并表示为m，即：基于上式，当得到不同海面信标节点定位报文的传播时延之间的差值后，可以得到不同海面信标节点与水下移动节点间距离的差值△D12和△D13，以节点1为参考，即：(4)基于步骤(3)可知，解算模块得到了不同海面信标节点与水下移动节点间距离的差值△D12和△D13；建立扩展卡尔曼滤波的观测方程和状态方程：θt,k＝θt,k-1+TkVk-1+wk (8)其中，下标k-1和k表示卡尔曼滤波中引入的时刻标量，为k-1和k时刻，△D12,k，△D13,k表示k时刻的观测量，即k时刻不同海面信标节点与水下移动节点间距离的差值；θt,k和θt,k-1分别表示k时刻和k-1时刻的状态矢量，即水下移动节点的二维坐标(Xt,k,Yt,k)和(Xt,k-1,Yt,k-1)；Zt,k表示k时刻水下移动节点的深度信息；S1,k,S2,k,S3,k为k时刻3个海面信标节点三维坐标(Xi,k,Yi,k,Zi,k)，i＝1,2,3；Vk-1表示k-1时刻水下移动节点的二维移动速度；Tk表示k-1时刻和k时刻的时间间隔；δk和wk为k时刻观测噪声和过程噪声；
观测方程中h(θt,k,Zt,k,S1,k,Si,k)表示为式(9)，其中l＝2,3指代信标序号2,3：首先基于k-1时刻水下移动节点位置估算值θt,k-1|k-1和移动速度估算值 对于k时刻水下移动节点位置进行预测：其中θt,k|k-1＝[Xt,k|k-1Yt，k|k-1]T表示k时刻水下移动节点预测值；
其中，Pk|k-1表示k时刻水下移动节点预测值的协方差矩阵，Pk-1|k-1表示k-1时刻水下移动节点位置估算值的协方差矩阵，Qk-1|k-1表示水下移动节点移动速度估算值的协方差；
其中Rk表示观测误差的协方差；Hk为观测矩阵，由于观测方程式非线性方程，对其进行一阶泰勒展开，近似线性化：其中， 表示为：
利用高斯反算把二维坐标位置转化为经度和纬度；并更新k时刻水下移动节点位置的协方差用于下一时刻计算：Pk|k＝Pk|k-1-KkHkPk|k-1 (15)估计k时刻水下移动节点移动速度 并计算其协方差Qk|k，用于下一时刻计算：
b.当水下移动节点的水下声学接收系统未接收到3个定位报文时：
水下移动节点的水下解算模块不会接收到来自水下主控系统提交报文信息和报文到达时刻，只接收到水下移动节点的深度信息，即处于k-1时刻和k时刻之间；基于k-1时刻估算水下移动节点的位置和移动速度，估算当前时刻水下移动节点的位置θ't,k|k，即其中，Tk'表示当前时刻距离k-1时刻的时间间隔；
2.实施如权利要求1所述的基于北斗信标的水下移动节点无源定位方法的系统，其特征在于：由至少3个海面信标节点、水下移动节点、岸基数据控制中心和船基控制中心组成；
所述海面信标节点包括北斗卫星接收机、海面主控系统、综合定位/通信功能的海面声学收发系统；
所述水下移动节点，包括推进器、水下定位接收机、压力传感器；其中水下定位接收机包括水下主控系统、综合定位/通信功能的水下声学接收系统、水下解算模块、水下短消息处理模块；
所述船基控制中心，为定位辅助系统，部署于海面信标节点覆盖海域内，携带有船基定位接收机，用于监控海面信标节点的工作状况，船基定位接收机包括综合定位/通信功能的船基声学接收系统、船基解算模块、船基短消息处理模块；船基控制中心在海面信标节点覆盖海域内，通过船基声学接收系统监听特定的海面信标节点发送的报文，根据接收到报文的时序和内容，判断海面信标节点的工作状态；另外，船基控制中心通过移动，间断的监听所有海面信标节点的工作状况，从而监控定位系统运行状况；
所述岸基数据控制中心，用于控制水下移动节点；岸基数据控制中心通过北斗卫星导航系统，下达指令给海面信标节点，海面信标节点再通过短数据报文方式广播给对应的水下移动节点；
由于水下移动节点至少需要接收3个定位信号才能完成位置解算，且信标节点构成正三角形栅格的拓扑结构可最大化覆盖海域面积；因此海面信标节点部署拓扑采用正三角形为栅格，3个海面信标位于正三角形顶点，所有海面信标节点的部署拓扑采取正三角形栅格为基础构成，覆盖目标海域，保证覆盖海域下方任意位置的水下移动节点，均可接收到一个正三角形栅格顶点上3个海面信标发送的定位信号；
海面信标节点的广播时序是：以正三角形栅格为单位，即位于一个三角形栅格上的3个海面信标节点同时广播其定位报文；当一个三角形栅格上的海面信标节点广播定位报文，相距固定时间间隔后，下一个时序的三角形栅格上的海面信标节点广播定位报文；直至所有三角形栅格广播完定位报文，重新开始下一轮定位报文的广播时序；
海面信标节点以CDMA扩频方式向水下广播定位报文：
位于一个三角形栅格上的3个海面信标需要同时广播其定位报文，因此采用CDMA方式；
对于生成的定位报文，采用多进制卷积码与M进制码元移位键控(Code Shift Keying,CSK)相结合，并分配给海面信标节点不同的伪随机序列，实现多用户通信；
水下移动节点利用串行多址干扰抵消技术抑制远近效应引起的多用户干扰，恢复期望的定位报文信息；
c.当水下移动节点的声学接收系统接收到3个定位报文时：
水下移动节点根据3个定位报文的到达时刻，计算不同定位报文到达时间差，并基于Snell定律，对于声线弯曲进行补偿，得到不同海面信标节点与水下移动节点间距离的差值；
基于扩展卡尔曼滤波方法，不同海面信标节点与水下移动节点间距离的差值作为观测值，并根据上一时刻的位置和移动速度信息，对于当前时刻水下移动节点的位置和移动速度进行解算；
d.当水下移动节点的声学接收系统未接收到3个定位报文时：
当水下移动节点在未接收到定位报文时刻，基于扩展卡尔曼滤波方法，利用上一时刻解算的位置和移动速度，估算当前时刻的水下移动节点位置。
基于北斗信标的水下移动节点无源定位方法及其系统
技术领域
[0001] 本发明涉及水下移动节点的无源定位方法及其系统，具体涉及到采用北斗卫星定位导航系统实现海面信标节点的定位，基于多个海面信标节点定位信号实现水下移动节点无源定位的方法与系统。
背景技术
[0002] 随着人类日益频繁开展海洋活动，如海洋资源探查、灾害预防警告、海洋战争等，水下无人设备得到广泛应用。因此，水下无人设备的定位与导航受到广泛关注。在水下环境中，由于无线电信号与光信号衰落较快，无法满足长距离传播要求，而声音在水中传播是透明的，因此，一般采用声波进行长距离传输，从而水声定位成为水下无人设备定位的常用手段。但是，水声定位方法仍面临许多挑战。首先，声波在传输中带宽较小，导致传输速率远低于射频信号；其次，声波的传播速度在1500m/s左右，会有较大的传播时延，并且不均匀介质会导致水下声波传播速度不是一个常数，进而使传播轨迹不是一条直线；另外，水下时变的信道条件和多径传播现象，导致链路传输质量较差。因此，高精度的水下定位是一个需要解决的难题。
[0003] 陆地与海面设备的定位导航有很多成熟技术，如卫星导航(GPS,北斗等)。这些定位导航系统采用电磁波定位，因为海水对电磁波的强吸收作用，导致这些陆地与海面的定位系统在水下失去其应有的定位效果。
[0004] 目前广泛应用的水声定位系统按基线长短可分为长基线、短基线和超短基线。其中，现有的长基线定位系统可用于水下无人设备的自主定位，要在海底布设传感器阵列，采用应答机制进行测距，从而得到较高的定位精度，但是需要固定水域内的部署水声应答装置，而且应答器节点位置标定难度高，使其实现代价较高；短基线水声定位系统需要在载体平台上布放传感器阵列，水下无人设备安装应答器，可对水下无人设备进行定位，但是无法实现水下无人设备自主定位；超短基线水声定位系统需要在载体平台上布放声学基线阵列，水下无人设备安装应答器，采用应答机制实现对水下无人设备定位，但是同样无法实现水下无人设备的自主定位。另外，短基线和超短基线水声定位系统的基线尺度远小于长基线，作用范围有限，无法满足大区域海域的定位要求。
[0005] 水下无人设备定位导航的另一种实现方式是惯性导航系统，但是其水下定位误差会积累，且没有很好的消除机制，随着时间的推移会逐渐恶化，从而导致很难实现精确定位；同时，高精度的惯性测量单元体积庞大，价格高昂。惯性导航系统与卫星定位导航系统组合定位也是一种惯用手段，卫星定位导航信号的引入可以使浮出水面的水下无人设备实现位置修正，实现较好的定位效果。但是，设备的上浮与下沉过程会中断水下无人设备的任务降低作业效率，同时消耗能源，更不利于水下无人设备的隐蔽性。
[0006] 目前也有提出基于海面信标节点的水下目标定位技术，即首先利用卫星定位导航系统实现海面信标节点的定位，然后基于多个海面信标节点定位信号实现水下移动节点的定位。已有基于海面信标节点的定位系统中，经检索，美国专利号US7512036B2公开的一种水下定位的系统和方法和美国专利号US5119341公开的一种扩展GPS水下应用的方法，两者的局限性在于假设海面信标节点和水下目标节点之间时间同步，同时未考虑水下节点时钟会出现偏移问题，导致定位误差的增大；中国专利申请号CN200310118440发明公开的一种无高稳定频标的水下GPS定位导航系统和方法与中国专利申请号201210065951发明公开的一种基于GNSS卫星的水下航行器定位方法及系统,两者的局限在于利用了双程测距解决信标节点和目标节点之间无法一直保持同步问题，即水下节点需要发送请求定位信号，与海面定位信标进行交互。但双程测距会导致水下目标的隐蔽性差，功耗增加，且会使实现定位的水下节点数目受到限制；中国专利申请号201410073253公开了一种基于DGPS浮标的水下定位导航系统和方法,局限在于该系统默认为信标节点和目标节点之间存在固定的时间差,未考虑水下目标的时钟会出现的频偏和相偏。另外，上述系统都没有考虑水声传播路径弯曲问题。
[0007] 本发明要解决的技术问题是在无法保证海面信标节点与水下移动节点时钟同步，且不采用应答机制测距情况下，实现水下移动节点的无源自主定位。
发明内容
[0008] 本发明要克服现有技术的上述技术缺点，提供了一种基于北斗海面信标的水下移动节点无源定位方法及其系统。
[0009] 一种基于北斗信标的水下移动节点无源定位方法，包括以下步骤：
[0010] 1.海面信标节点上的北斗卫星接收机，接收北斗卫星导航系统广播的定位导航信号，实时解析出海面信标北斗卫星天线所处位置的经度、纬度和高程，传输给海面信标节点的海面主控系统，并校准海面主控系统时钟和北斗基准时间保持同步，即所有海面信标之间保持同步；海面信标的海面主控系统把北斗卫星接收机高程信息减去综合定位/通信功能的声学收发系统的高度差值，作为海面信标节点的高程，然后把自身信标序号、经度、纬度、高程信息组合成定位报文。根据自身发送定位报文的时序表，处于一个三角形栅格顶点处的海面信标节点同时通过各自的声学系统广播定位报文；
[0011] 2.水下移动节点的综合定位/通信功能的水下声学接收系统处于侦听状态，一旦接收到定位信号，声学系统完成多用户信号接收，记录3个定位报文的到达时刻，并把解码的定位报文及其到达时刻发送给水下主控系统；水下移动节点的水下主控系统解读定位报文内容，把报文中的经度、纬度、高程和对应报文到达时刻传输给水下解算模块；同时水下移动节点的水下主控系统实时从压力传感器读取深度信息，传输给水下解算模块；当水下移动节点的水下解算模块接收到来自水下主控系统的报文信息时，利用滤波算法解算其当前时刻的位置；当没有收到来自水下主控系统的报文信息时，也可以利用滤波算法估算其当前时刻的位置；
[0012] 步骤1中，海面信标节点数量至少3个,水下移动节点定位系统的海面信标部署拓扑为:首先三个海面信标节点构成正三角形栅格,信标节点位于三角形顶点；所有海面信标节点的部署拓扑采取正三角形栅格为基本单位，无缝覆盖目标海域；
[0013] 步骤1中，海面信标节点的定位信号广播时序：以正三角形栅格为单位，即位于一个三角形栅格上的3个海面信标节点同时广播其定位报文；当一个三角形栅格上的海面信标节点广播定位报文，相距固定时间间隔后，下一个时序的三角形栅格上的海面信标节点广播定位报文；直至所有三角形栅格广播完定位报文，重新开始下一轮定位报文的广播时序；
[0014] 步骤1中,3个海面信标节点同时广播定位报文，海面信标节点采用码分多址(Code Division Multiple Access,CDMA)方式广播定位信号，具体地，对于编码生成的定位报文，采用多进制卷积码与M进制码元移位键控(Code Shift Keying,CSK)相结合，并分配给海面信标节点不同的伪随机序列，实现多用户通信。每个正三角形栅格上的3个海面信标在广播定位报文时都会被分配3个不同的伪随机序列；属于不同正三角形栅格的同一个海面信标节点，在不同的正三角形栅格广播定位报文时，会被分配不同的伪随机序列；
[0015] 步骤2中，由于位于正三角形栅格上的3个信标节点采用CDMA方式同时广播定位报文，水下移动节点同时接收到3个信号。由于CDMA方式中扩频序列的准正交性质，利用串行多址干扰抵消技术抑制远近效应引起的多用户干扰(Multiple Access Interference，MAI)，恢复期望的定位报文信息；
[0016] 步骤2中，水下移动节点位置解算方法如下：
[0017] a.当水下移动节点的水下声学接收系统接收到3个定位报文时：
[0018] (1)水下解算模块会接收到来自水下主控系统的经度、纬度、高程、定位报文到达时刻Ti，i＝1,2,3指代信标序号，与水下移动节点的深度信息；以T1为参考时间，得到不同定位报文到达时间差：△T12＝T2-T1和△T13＝T3-T1；
[0019] (2)解算模块利用高斯正算将报文中的经度和纬度转化为高斯平面坐标系，结合高程作为信标节点的三维坐标位置(Xi,Yi,Zi)，i＝1,2,3指代海面信标序号；水下移动节点位置设为(Xt,Yt,Zt)，t用于指代水下移动节点，其中Zt为深度信息，通过压力传感器获取，作为已知量；海面信标节点i到水下移动节点之间距离表示为
[0020] (3)由于介质不均匀导致声速不是常数，不考虑声速剖面的横向变化,声速剖面表示为c(z)，z表示深度变量；利用Snell定律，建立海面信标节点i和水下移动节点之间的水平距离、传播延时与传播常数之间的关系,并离散化可得：
[0021]
[0022] 其中ρi、τi和ni表示海面信标节点i到水下移动节点对应的水平距离，传播时延和传播常数；N表示c(z)上的采样点数量，在深度Zi和Zt之间均匀采样，j表示采样点序号，zj表示采样点处的深度，c(zj)表示深度zj对应的声速，
[0023] 海面信标节点i和水下移动节点直线距离与传播时延之间比值表示为：
[0024]
[0025] 由于各项 之间变化量较小，上式可简化成：
[0026]
[0027] 根据泰勒展开，上式可进一步简化成：
[0028]
[0029] 由于信标节点都位于海面，信标节点之间深度差别较小，因此认为不同海面信标节点和水下移动节点的直线距离与传播时延之间比值相等，并表示为m，即：
[0030]
[0031] 基于上式，当得到不同海面信标节点定位报文的传播时延之间的差值后，可以得到不同海面信标节点与水下移动节点间距离的差值△D12和△D13，以节点1为参考即：
[0032]
[0033] (4)基于步骤(a3)可知，解算模块得到了不同海面信标节点与水下移动节点间距离的差值△D12和△D13；建立扩展卡尔曼滤波的观测方程和状态方程：
[0034]
[0035] θt,k＝θt,k-1+TkVk-1+wk (8)
[0036] 其中，下标k-1和k表示卡尔曼滤波中引入的时刻标量，为k-1和k时刻，△D12,k，△D13,k表示k时刻的观测量，即k时刻不同海面信标节点与水下移动节点间距离的差值；θt,k和θt,k-1分别表示k时刻和k-1时刻的状态矢量，即水下移动节点的二维坐标(Xt,k,Yt,k)和(Xt,k-1,Yt,k-1)；Zt,k表示k时刻水下移动节点的深度信息；S1,k,S2,k,S3,k为k时刻3个海面信标节点三维坐标(Xi,k,Yi,k,Zi,k)，i＝1,2,3；Vk-1表示k-1时刻水下移动节点的二维移动速度；Tk表示k-1时刻和k时刻的时间间隔；δk和wk为k时刻观测噪声和过程噪声；
[0037] 观测方程中h(θt,k,Zt,k,S1,k,Si,k)，l＝2,3指代信标序号2,3，表示为：
[0038]
[0039] 首先基于k-1时刻水下移动节点位置估算值θt,k-1|k-1和移动速度估算值 对于k时刻水下移动节点位置进行预测：
[0040]
[0041] 其中θt,k|k-1＝[Xt,k|k-1Yt,k|k-1]T表示k时刻水下移动节点预测值；
[0042] 计算其协方差Pk|k-1：
[0043]
[0044] 其中，Pk|k-1表示k时刻水下移动节点预测值的协方差矩阵，Pk-1|k-1表示k-1时刻水下移动节点位置估算值的协方差矩阵，Qk-1|k-1表示水下移动节点移动速度估算值的协方差；
[0045] 因此卡尔曼增益Kk表示为：
[0046]
[0047] 其中Rk表示观测误差的协方差；Hk为观测矩阵，由于观测方程式非线性方程，对其进行一阶泰勒展开，近似线性化：
[0048]
[0049] 其中， 表示为：
[0050]
[0051]
[0052] 因此，k时刻的水下移动节点位置估算值为：
[0053]
[0054] 利用高斯反算把二维坐标位置转化为经度和纬度；并更新k时刻水下移动节点位置的协方差用于下一时刻计算：
[0055] Pk|k＝Pk|k-1-KkHkPk|k-1 (15)
[0056] 估计k时刻水下移动节点移动速度 并计算其协方差Qk|k，用于下一时刻计算：
[0057]
[0058]
[0059] b.当水下移动节点的声学接收系统未接收到3个定位报文时：
[0060] 水下移动节点的解算模块不会接收到来自主控系统提交报文信息和报文到达时刻，只接收到水下移动节点的深度信息，即处于k-1时刻和k时刻之间。基于k-1时刻估算水下移动节点的位置和移动速度，估算当前时刻水下移动节点的位置θ't,k|k，即[0061]
[0062] 其中，T'k表示当前时刻距离k-1时刻的时间间隔；
[0063] 利用高斯反算把二维空间坐标位置转化为经度和纬度。
[0064] 实施本发明的基于北斗海面信标的水下移动节点无源定位方法的系统，包含至少3个海面信标节点、水下移动节点、岸基数据控制中心和船基控制中心。另外，本发明系统需要借助于北斗卫星导航系统实现海面信标的定位。
[0065] 所述海面信标节点包括北斗卫星接收机、海面主控系统、综合定位/通信功能的海面声学收发系统等。由于水下移动节点至少需要接收3个定位信标的定位信号才能完成位置解算，且信标节点构成正三角形栅格的拓扑结构可最大化覆盖海域面积。因此海面信标节点部署拓扑采用正三角形为栅格，3个海面信标位于正三角形顶点，所有海面信标节点的部署拓扑采取正三角形栅格为基础构成，覆盖目标海域，保证覆盖海域下方任意位置的水下移动节点，均可接收到一个正三角形栅格顶点上3个海面信标发送的定位信号。
[0066] 所述水下移动节点，具有一定的移动速度，包括推进器、压力传感器、水下定位接收机；其中水下定位接收机包括水下主控系统、综合定位/通信功能的水下声学接收系统、水下解算模块、水下短消息处理模块；
[0067] 所述船基控制中心，为定位辅助系统，部署于海面信标节点覆盖海域内，携带有船基定位接收机，包括综合定位/通信功能的船基声学接收系统、船基解算模块、船基短消息处理模块，用于监控海面信标节点的工作状况；船基控制中心在海面信标节点覆盖海域内，通过船基声学接收系统监听特定的海面信标节点发送的报文，根据接收到报文的时序和内容，判断海面信标节点的工作状态。另外，船基控制中心通过移动，可以间断的监听所有海面信标节点的工作状况，从而监控定位系统运行状况；
[0068] 所述岸基数据控制中心，用于控制水下移动节点。岸基数据控制中心可通过北斗卫星导航系统，下达指令给海面信标节点，海面信标节点再通过短数据报文方式广播给对应的水下移动节点。
[0069] 海面信标节点部署拓扑采取正三角形栅格为基础构成：
[0070] 由于水下移动节点至少需要接收3个定位信号才能完成位置解算，且信标节点构成正三角形栅格的拓扑结构可最大化覆盖海域面积；因此海面信标节点部署拓扑采用正三角形为栅格，3个海面信标位于正三角形顶点，所有海面信标节点的部署拓扑采取正三角形栅格为基础构成，覆盖目标海域，保证覆盖海域下方任意位置的水下移动节点，均可接收到一个正三角形栅格顶点上3个海面信标发送的定位信号；
[0071] 海面信标节点的广播时序是：以正三角形栅格为单位，即位于一个三角形栅格上的3个海面信标节点同时广播其定位报文；当一个三角形栅格上的海面信标节点广播定位报文，相距固定时间间隔后，下一个时序的三角形栅格上的海面信标节点广播定位报文；直至所有三角形栅格广播完定位报文，重新开始下一轮定位报文的广播时序；
[0072] 海面信标节点以CDMA扩频方式向水下广播定位报文：位于一个三角形栅格上的3个海面信标需要同时广播其定位报文，因此采用CDMA方式；对于生成的定位报文，采用多进制卷积码与M进制码元移位键控(Code Shift Keying,CSK)相结合，并分配给海面信标节点不同的伪随机序列，实现多用户通信；
[0073] 水下移动节点利用串行多址干扰抵消技术抑制远近效应引起的多用户干扰，恢复期望的定位报文信息；
[0074] 水下移动节点的定位解算过程如下：
[0075] a.当水下移动节点的声学接收系统接收到3个定位报文时：
[0076] 水下移动节点根据3个定位报文的到达时刻，计算不同定位报文到达时间差，并基于Snell定律，对于声线弯曲进行补偿，得到不同海面信标节点与水下移动节点间距离的差值；
[0077] 基于扩展卡尔曼滤波方法，不同海面信标节点与水下移动节点间距离的差值作为观测值，并根据上一时刻的位置和移动速度信息，对于当前时刻水下移动节点的位置和移动速度进行解算；
[0078] b.当水下移动节点的水下声学接收系统未接收到3个定位报文时：
[0079] 当水下移动节点在未接收到定位报文时刻，基于扩展卡尔曼滤波方法；利用上一时刻解算的位置和移动速度，估算当前时刻的水下移动节点位置。
[0080] 水下移动节点与海面信标节点不需要保持同步，且不需要发出任何信号。
[0081] 定位报文中不需要包含发送时间戳。
[0082] 本发明还包含辅助通信功能：
[0083] 岸基数据控制中心，用于控制水下移动节点。当岸基数据控制中心需要发送控制指令给某个水下移动节点时，首先借助北斗卫星导航系统，将控制指令下达给海面信标节点。在海面信标节点广播定位报文的间隔中，每个三角形栅格上的一个海面信标节点将来自岸基数据控制中心的控制指令编码成短消息报文，广播给水下移动节点，以保证海面信标节点覆盖海域的水下移动节点至少接收到一次短息消息报文；当水下移动节点的综合定位/通信声学接收系统收到短消息报文时，提交给主控系统；水下移动节点的主控系统根据报文的类型将该报文传输给水下移动节点的短消息处理模块；短消息处理模块解析报文的目的地址，当目的地址匹配该水下移动节点时，解析报文中的指令内容，指令水下移动节点做出相应操作，如果地址不匹配，丢弃相应的短消息报文。
[0084] 本发明的优点是：实现了水下移动节点与海面信标节点不同步情况下，水下移动节点的无源定位。考虑了传播路径弯曲问题，减小定位的误差。海面信标节点以正三角形栅格为单位部署方式实现最大化的海域覆盖，可提供大区域的节点定位；实现序贯滤波的解算方法，并可以在没有获得定位报文时估算自身位置；综合定位/通信声学系统的CDMA方式结合了M进制CSK高阶调制，相比于传统直接序列扩频方式，定位接收机利用置零串行多址干扰抵消技术消除远近效应引起的MAI，并提高了通信速率；另一方面，增加了辅助通信功能，实现了系统的功能多样化。附图说明：
[0085] 图1为本发明方法的实施系统的总构成图；
[0086] 图2为本发明实例海面信标节点拓扑结构图；
[0087] 图3为本发明实例系统海面信标节点和水下移动节点工作原理框图；
[0088] 图4为本发明实例一个海面信标节点栅格定位报文到达时刻图。具体实施方式：
[0089] 为了更详细的对于该发明进行解释说明，拟结合附图进行示例性说明，但并不局限于附图中，其中附图中结构有所省略或者比例大小不符合实际尺寸，仅供进一步说明参考使用。
[0090] 一种基于北斗信标的水下移动节点无源定位方法，包括以下步骤：
[0091] 1.海面信标节点上的北斗卫星接收机，接收北斗卫星导航系统广播的定位导航信号，实时解析出海面信标北斗卫星天线所处位置的经度、纬度和高程，传输给海面信标节点的海面主控系统，并校准海面主控系统时钟和北斗基准时间保持同步，即所有海面信标之间保持同步；海面信标的海面主控系统把北斗卫星接收机高程信息减去综合定位/通信功能的声学收发系统的高度差值，作为海面信标节点的高程，然后把自身信标序号、经度、纬度、高程信息组合成定位报文。根据自身发送定位报文的时序表，处于一个三角形栅格顶点处的海面信标节点同时通过各自的声学系统广播定位报文；
[0092] 2.水下移动节点的综合定位/通信功能的声学接收系统处于侦听状态，一旦接收到定位信号，声学系统完成多用户信号接收，记录3个定位报文的到达时刻，并把解码的定位报文及其到达时刻发送给主控系统；水下移动节点的水下主控系统解读定位报文内容，把报文中的经度、纬度、高程和对应报文到达时刻传输给解算模块；同时水下移动节点的水下主控系统实时从压力传感器读取深度信息，传输给解算模块；当水下移动节点的水下解算模块接收到来自水下主控系统的报文信息时，利用滤波算法解算其当前时刻的位置；当没有收到来自水下主控系统的报文信息时，也可以利用滤波算法估算其当前时刻的位置。
[0093] 步骤1中，海面信标节点数量至少3个,水下移动节点定位系统的海面信标部署拓扑为:首先三个海面信标节点构成正三角形栅格,信标节点位于三角形顶点；所有海面信标节点的部署拓扑采取正三角形栅格为基本单位，无缝覆盖目标海域；
[0094] 步骤1中，海面信标节点的定位信号广播时序：以正三角形栅格为单位，即位于一个三角形栅格上的3个海面信标节点同时广播其定位报文；当一个三角形栅格上的海面信标节点广播定位报文，相距固定时间间隔后，下一个时序的三角形栅格上的海面信标节点广播定位报文；直至所有三角形栅格广播完定位报文，重新开始下一轮定位报文的广播时序；
[0095] 步骤1中，3个海面信标节点同时广播定位报文，海面信标节点采用码分多址(Code Division Multiple Access,CDMA)方式广播定位信号，具体地，对于编码生成的定位报文，采用多进制卷积码与M进制码元移位键控(Code Shift Keying,CSK)相结合，并分配给海面信标节点不同的伪随机序列，实现多用户通信。每个正三角形栅格上的3个海面信标在广播定位报文时都会被分配3个不同的伪随机序列；属于不同正三角形栅格的同一个海面信标节点，在不同的正三角形栅格广播定位报文时，会被分配不同的伪随机序列；
[0096] 步骤2中，由于位于正三角形栅格上的3个信标节点采用CDMA方式同时广播定位报文，水下移动节点同时接收到3个信号。由于CDMA方式中扩频序列的准正交性质，利用串行多址干扰抵消技术抑制远近效应引起的多用户干扰(Multiple Access Interference，MAI)，恢复期望的定位报文信息；
[0097] 步骤2中，水下移动节点位置解算方法如下：
[0098] c.当水下移动节点的水下声学接收系统接收到3个定位报文时：
[0099] (1)水下解算模块会接收到来自水下主控系统的经度、纬度、高程、定位报文到达时刻Ti，i＝1,2,3指代信标序号，与水下移动节点的深度信息；以T1为参考时间，得到不同定位报文到达时间差：△T12＝T2-T1和△T13＝T3-T1；
[0100] (2)解算模块利用高斯正算将报文中的经度和纬度转化为高斯平面坐标系，结合高程作为信标节点的三维坐标位置(Xi,Yi,Zi)，i＝1,2,3指代海面信标序号；水下移动节点位置设为(Xt,Yt,Zt)，t用于指代水下移动节点，其中Zt为深度信息，通过压力传感器获取，作为已知量；海面信标节点i到水下移动节点之间距离表示为
[0101] (3)由于介质不均匀导致声速不是常数，不考虑声速剖面的横向变化,声速剖面表示为c(z)，z表示深度变量；利用Snell定律，建立海面信标节点i和水下移动节点之间的水平距离、传播延时与传播常数之间的关系,并离散化可得：
[0102]
[0103] 其中ρi、τi和ni表示海面信标节点i到水下移动节点对应的水平距离，传播时延和传播常数；N表示c(z)上的采样点数量，在深度Zi和Zt之间均匀采样，j表示采样点序号，zj表示采样点处的深度，c(zj)表示深度zj对应的声速，
[0104] 海面信标节点i和水下移动节点直线距离与传播时延之间比值表示为：
[0105]
[0106] 由于各项 之间变化量较小，上式可简化成：
[0107]
[0108] 根据泰勒展开，上式可进一步简化成：
[0109]
[0110] 由于信标节点都位于海面，信标节点之间深度差别较小，因此认为不同海面信标节点和水下移动节点的直线距离与传播时延之间比值相等，并表示为m，即：
[0111]
[0112] 基于上式，当得到不同海面信标节点定位报文的传播时延之间的差值后，可以得到不同海面信标节点与水下移动节点间距离的差值△D12和△D13(以节点1为参考)即：
[0113]
[0114] (4)基于步骤(a3)可知，解算模块得到了不同海面信标节点与水下移动节点间距离的差值△D12和△D13；建立扩展卡尔曼滤波的观测方程和状态方程：
[0115]
[0116] θt,k＝θt,k-1+TkVk-1+wk (8)
[0117] 其中，下标k-1和k表示卡尔曼滤波中引入的时刻标量，为k-1和k时刻，△D12,k，△D13,k表示k时刻的观测量，即k时刻不同海面信标节点与水下移动节点间距离的差值；θt,k和θt,k-1分别表示k时刻和k-1时刻的状态矢量，即水下移动节点的二维坐标(Xt,k,Yt,k)和(Xt,k-1,Yt,k-1)；Zt,k表示k时刻水下移动节点的深度信息；S1,k,S2,k,S3,k为k时刻3个海面信标节点三维坐标(Xi,k,Yi,k,Zi,k)，i＝1,2,3；Vk-1表示k-1时刻水下移动节点的二维移动速度；Tk表示k-1时刻和k时刻的时间间隔；δk和wk为k时刻观测噪声和过程噪声；
[0118] 观测方程中h(θt,k,Zt,k,S1,k,Si,k),其中l＝2,3指代信标序号2,3，表示为：
[0119]
[0120] 首先基于k-1时刻水下移动节点位置估算值θt,k-1|k-1和移动速度估算值 对于k时刻水下移动节点位置进行预测：
[0121]
[0122] 其中θt,k|k-1＝[Xt,k|k-1Yt,k|k-1]T表示k时刻水下移动节点预测值；
[0123] 计算其协方差Pk|k-1：
[0124]
[0125] 其中，Pk|k-1表示k时刻水下移动节点预测值的协方差矩阵，Pk-1|k-1表示k-1时刻水下移动节点位置估算值的协方差矩阵，Qk-1|k-1表示水下移动节点移动速度估算值的协方差；
[0126] 因此卡尔曼增益Kk表示为：
[0127]
[0128] 其中Rk表示观测误差的协方差；Hk为观测矩阵，由于观测方程式非线性方程，对其进行一阶泰勒展开，近似线性化：
[0129]
[0130] 其中， 其中l＝2,3指代信标序号2,3表示为：
[0131]
[0132]
[0133] 因此，k时刻的水下移动节点位置估算值为：
[0134]
[0135] 利用高斯反算把二维坐标位置转化为经度和纬度；并更新k时刻水下移动节点位置的协方差用于下一时刻计算：
[0136] Pk|k＝Pk|k-1-KkHkPk|k-1 (15)
[0137] 估计k时刻水下移动节点移动速度 并计算其协方差Qk|k，用于下一时刻计算：
[0138]
[0139]
[0140] d.当水下移动节点的水下声学接收系统未接收到3个定位报文时：
[0141] 水下移动节点的水下解算模块不会接收到来自主控系统提交报文信息和报文到达时刻，只接收到水下移动节点的深度信息，即处于k-1时刻和k时刻之间。基于k-1时刻估算水下移动节点的位置和移动速度，估算当前时刻水下移动节点的位置θ't,k|k，即[0142]
[0143] 其中，T'k表示当前时刻距离k-1时刻的时间间隔；
[0144] 利用高斯反算把二维空间坐标位置转化为经度和纬度。
[0145] 本发明基于北斗信标的水下移动节点定位系统的实例，由岸基数据中心12，10个波浪滑翔机13-1,2…10，船基控制中心14，2个包含定位接收机的水下滑翔机15-1,2组成；该系统还借助北斗卫星导航系统11实现海面信标节点的定位和同步。其中波浪滑翔机充当海面信标节点，水下滑翔机充当水下移动节点。如图1所示。
[0146] 10个波浪滑翔机充当海面信标节点，上半部分位于海面上，下半部分位于海面下方，配备有北斗卫星接收机、海面主控系统、综合定位/通信功能的海面声学收发系统等；其中北斗卫星接收机位于波浪滑翔机海面部分，海面声学收发系统位于波浪滑翔机水下部分；波浪滑翔机通过接收北斗卫星导航系统的导航信号，实时更新自身位置，并与北斗卫星基准时钟保持同步，即所有波浪滑翔机保持时间同步；每个波浪滑翔机根据自身的时序表，将自身位置信息和序号编码成定位报文，广播给水下滑翔机；
[0147] 2个水下滑翔机充当水下移动节点，配备有水下定位接收机，包括水下主控系统、综合定位/通信功能的水下声学接收系统、水下解算模块、水下短消息处理模块、压力传感器等；水下滑翔机当接收定位信号时，利用序贯算法解算自身位置；未接收到定位信号时，也可以利用序贯算法估算自身位置；
[0148] 岸基数据控制中心，位于海岸上，用于控制水下滑翔机。岸基数据控制中心通过北斗卫星导航系统，下达指令给波浪滑翔机，波浪滑翔机再通过短数据报文方式广播给相应的水下滑翔机。
[0149] 船基控制中心，配备有定位接收机，包括综合定位/通信功能的船基声学接收系统、船基解算模块、船基短消息处理模块，用于监控波浪滑翔机的工作状况。船基控制中心位于波浪滑翔机覆盖海域内，通过船基声学接收系统监听特定的波浪滑翔机发送的报文，根据接收到报文的时序和内容，判断波浪滑翔机的工作状态。另外，船基控制中心通过移动，可以间断的监听所有波浪滑翔机的工作状况，从而监控定位系统运行状况；
[0150] 10个波浪滑翔机拟采用图2所示的拓扑结构，其中21,22…210分别表示10个波浪滑翔机。首先3个波浪滑翔机构成正三角形栅格，三角形栅格边长为4.5公里，波浪滑翔机位于三角形顶点；10个波浪滑翔机构成10个正三角形栅格1,2…10，无缝覆盖目标海域；可实现100平方公里以上的覆盖海域范围。
[0151] 首先处于栅格1上的3个波浪滑翔机同时广播其的定位报文，相距固定时间间隔后，栅格2上的3个波浪滑翔机同时广播其定位报文，直至栅格10上的3个波浪滑翔机广播完其定位报文，然后开始下一轮的广播时序。
[0152] 处于一个栅格上的3个波浪滑翔机采用CDMA方式同时广播定位报文时，会被分配3个不同的伪随机序列，如当栅格1广播定位报文时，波浪滑翔机21、23和24会被分配3个不同的伪随机序列；属于不同正三角形栅格的同一个波浪滑翔机，在不同的正三角形栅格广播定位报文时，会被分配不同的伪随机序列，如波浪滑翔机24同属于栅格1和2，当栅格1或者栅格2上在广播定位报文，波浪滑翔机24在两次广播定位报文时，分配的伪随机序列也不同；
[0153] 当岸基数据控制中心需要控制水下滑翔机时，可通过卫星通信下达给两个波浪滑翔机21和22，波浪滑翔机21和22将控制命令和目的地址编码成短消息报文；在两个序号相邻的栅格广播定位报文间隔，可以广播短消息报文给水下滑翔机。
[0154] 当一个栅格上的3个波浪滑翔机同时广播其定位报文时，水下滑翔机实现多用户接收。具体地，如图3所示。
[0155] 一个栅格上的3个波浪滑翔机，每个波浪滑翔的北斗卫星接收机31通过接收来自北斗卫星导航系统的卫星信号，解析出天线所在处的经度、纬度、高程传输给海面主控系统，并实现海面主控系统32和北斗基准时钟同步；海面主控系统将卫星天线所在高程减去卫星天线和声学收发系统33高度差，作为波浪滑翔机的高程，海面主控系统将经度、纬度、高程和自身序号编码成定位报文，根据自身时序表，3个波浪滑翔机通过各自的综合定位/通信功能的水下声学接收系统33广播定位报文；
[0156] 水下滑翔机的综合定位/通信功能的水下声学接收系统34处于侦听状态，一旦接收到定位信号，完成多用户信号接收，记录3个定位报文的到达时刻，并把解码的定位报文及其到达时刻发送给水下主控系统35；水下滑翔机的水下主控系统解读定位报文内容，把报文中的经度、纬度、高程和对应报文到达时刻传输给水下解算模块38；同时水下滑翔机的水下主控系统实时从压力传感器36读取深度信息，传输给水下解算模块；当水下滑翔机的水下解算模块接收到来自水下主控系统的报文信息时，利用滤波算法解算其当前时刻的位置；当没有收到来自水下主控系统的报文信息时，也可以利用滤波算法估算其当前时刻的位置。
[0157] 当波浪滑翔机接收到短消息报文时，海面主控系统通过判断报文中的目的地址，当匹配目的地址时，提交给短消息处理模块37，做出相应响应，否则丢弃该短消息报文。
[0158] 如图4，当水下滑翔机实现多用户接收之后，解算模块获取到达时刻T1，T2，T3。假设位于一个三角形栅格上的波浪滑翔机1，2，3对应的定位信号的传播时延为△T1，△T2，△T3。由于3个波浪滑翔机同时广播其定位信号，可知△T2-△T1＝T2-T1＝△T12,△T3-△T1＝T3-T1＝△T13。因此，基于在接收端得到的到达时刻，可以获取不同定位信号传播时延的差值；在根据对于声线弯曲的修正，解算模块即得到不同波浪滑翔机和水下滑翔机直线距离的差值。除此之外，解算模块还需要对于经纬度和高程进行高斯正算，得到对应波浪滑翔机的三维坐标；在得到水下滑翔机的三维坐标后，也需要高斯反算得到对应的经纬度和高程。
[0159] 以上所述为本发明的一个实例，其中海面信标节点可以由浮标等来代替，实现其他水下目标的定位；船基控制中心，作为附属系统，可以由其他载体或多个载体来替代，实现对于定位系统监控功能；岸基数据中心，除了处于海岸，同时也可以建设在其他地方，需实现卫星通信；
[0160] 另外，除了借助于北斗卫星导航系统，也可以借助于其他全球导航系统，例如GPS，GLONASS，GALILEO等。而当水下移动节点自身可以提供速度矢量，会提高定位精度；而水下移动节点自身不提供深度信息时，只需要将正三角形栅改成四边形等其它形状，保证水下移动节点可以一次接收到4个及其以上定位报文。
[0161] 本说明书实施例所述的内容仅仅是对发明构思的实现形式的列举，本发明的保护范围不应当被视为仅限于实施例所陈述的具体形式，本发明的保护范围也及于本领域技术人员根据本发明构思所能够想到的等同技术手段。
