基于测距与信息交互的UUV集群协同定位系统和方法技术方案

本发明专利技术公开了基于测距与信息交互的UUV集群协同定位系统和方法。本发明专利技术系统包括一台主UUV、多台从UUV和安装于从UUV上的协同定位装置，协同定位装置利用从UUV的INS数据进行位置估计作为主导航单元，利用声学测距和协同定位报文滤波处理作为副导航单元。协同定位方法包括：主从UUV内部时钟驯服；主UUV周期性将自身位置和位置估计协方差矩阵打包成协同定位报文，并广播给集群的从UUV；从UUV接收协同定位报文；从UUV的协同定位装置根据数据构建状态和测量方程，利用扩展卡尔曼滤波计算得到协同定位结果。本发明专利技术考虑主UUV自身的位置估计不确定性，针对从UUV的状态向量进行了重构，提升了集群整体的定位性能。了集群整体的定位性能。了集群整体的定位性能。

【技术实现步骤摘要】
基于测距与信息交互的UUV集群协同定位系统和方法


[0001]本专利技术属于声学定位
，尤其是水下航行器集群声学定位
，涉及一种基于测距与信息交互的UUV集群协同定位系统和方法。

技术介绍

[0002]海洋蕴含着丰富的资源，随着陆地上资源的日益枯竭，全世界越来越多的国家也逐渐将目光投向了海洋的开发与保护。作为未来国家海洋安全、经济发展的重要竞争领域，海洋研究的重要性不言而喻。近年来，水下航行器的发展，如水下无人自主航行器(unmanned underwater vehicles,UUV)等，也加快了海洋探索和研究的进程。但相比于陆地环境，水下环境往往更加恶劣，陆地常用的光波、无线电等信号在水下的衰减或色散大，因此陆地上众多成熟的商用通信、导航方式在水下并不适用。
[0003]声波由于其更小的水下衰减、更长的水下传播距离，因此比光波、无线电等更适合于作为水下通信与定位导航的信号载体。一系列的声学理论、技术、产品也逐渐发展，在海洋研究领域做出了重要的贡献。
[0004]对于水下探索、任务执行而言，单体UUV存在着覆盖范围小、搭载的任务载荷少等缺陷，所以参考陆地上狼群、海洋里鲸群等工作的模式，UUV集群的工作模式逐渐发展起来。这种方式允许多个UUV以编队的形式执行任务，克服了单体UUV的缺陷。UUV集群分为三种工作模式：主从式、分层式和并行式。主从模式是最为常见的工作形式，在这种模式下，集群中存在单个或者多个领航者，这些作为领航者的主航行器搭载了更多的载荷，具有更为全面的探测、定位、处理能力。从航行器跟随主航行器进行工作，通过水声通信实现和主航行器的信息交互，实现任务分配、编队控制、数据汇聚等功能。分层模式下，弱化了主从航行器的概念，根据不同航行器搭载的载荷精度级别，将整个编队的航行器分属于不同的精度层级，相同层级的航行器可以进行信息交互，而低精度层的航行器受控于高精度层的航行器。并行模式下，没有主从和高低精度的区别，所有的航行器均可互相实现信息交互。
[0005]对于主从式UUV集群来说，主航行器作为集群的核心，承担着任务分配、信息汇聚、导航协助等重要功能；从航行器受体积、成本等限制，装备精度较差的传感器，往往定位精度较差。协同定位的内涵是，如果主从水下航行器可以实现相互的信息共享，从航行器可以利用主航行器的定位信息提升自身的导航定位精度，从而提升集群整体的定位能力。

技术实现思路

[0006]本专利技术的一个目的是针对现有主从UUV集群协同定位的需求，提供一种基于测距与信息交互的UUV集群协同定位系统，考虑主航行器定位不确定性时，利用测距和信息交互进行集群内协同定位。
[0007]本专利技术的协同定位系统，包括主UUV、从UUV和协同定位装置，具体构成包括：
[0008](1)一台主UUV，包括但不限于大型的自主式水下航行器(Autonomous underwater vehicles,AUV)等，搭载多普勒测速仪DVL(Doppler velocity log)、高精度惯性导航系统
INS(Inertial navigation system)、第一卫星单元模块、第一水声通信机、第一主控单元模块、第一动力系统、第一数据处理模块和第一时钟模块。其中：
[0009]多普勒测速仪进行对水和对水底锁定，用于测量主UUV航速；
[0010]高精度惯性导航系统INS用于估计主UUV自身位置和相应的运动姿态；
[0011]第一卫星单元模块用于主UUV浮出海面时，接收卫星位置更新和与控制中心的通信；
[0012]第一水声通信机用于主从UUV在水下的通信，主UUV通过水声通信机向控制中心汇报状态以及接收控制中心的指令与数据；
[0013]第一主控单元模块用于控制主UUV的上浮、下潜、任务切换；
[0014]第一动力系统用于输出主UUV所需动力；
[0015]第一数据处理模块用于结合DVL和INS数据，输出主UUV位置，并产生协同定位报文；
[0016]第一时钟模块用于提供时钟基准。
[0017](2)多台从UUV，包括但不限于小型的自主式水下航行器等，每台从UUV搭载低精度惯性导航系统INS、第二卫星单元模块、第二水声通信机、第二主控单元模块、第二动力系统、第二数据处理模块和第二时钟模块。其中：
[0018]低精度惯性导航系统INS输出从UUV的定位结果与相应的运动姿态；
[0019]第二卫星单元模块用于从UUV浮出海面时，接收卫星位置更新和与控制中心的通信；
[0020]第二水声通信机用于从主UUV在水下的通信，以及接收协同定位数据报文；
[0021]第二主控单元模块用于控制从UUV的上浮、下潜、任务切换，具有通信和定位一体化功能；
[0022]第二动力系统用于输出从UUV所需动力；
[0023]第二数据处理模块用于从UUV的内部数据处理；
[0024]第二时钟模块用于提供时钟基准。
[0025]主UUV搭载的高精度惯性导航系统INS与从UUV搭载的低精度惯性导航系统INS为精度相对高低。
[0026](3)协同定位装置，安装于从UUV上，用于协同定位的算法执行和输出协同定位结果。
[0027]协同定位装置包含主导航单元和副导航单元，利用从UUV的INS数据进行位置估计作为主导航单元；利用声学测距和协同定位报文滤波处理作为副导航单元。
[0028]协同定位装置向外提供两个接口，与数据处理模块的通信接口和与水声通信机的通信接口；接口通信采用串口通信，发送TX、接收RX与地线连接的方式，使用软件握手XON/XOFF方式建立通信连接。需要通信时，接收端向发送端发送XON，开始接收数据；发送端接收到XON后开始发送数据；当不需要通信时，接收端反馈XOFF结束通信。
[0029](3
‑
1)与数据处理模块的通信接口：从UUV默认以1Hz的频率向协同定位装置输入INS采集的经度、纬度、航速、航向、深度、时间戳数据；协同定位装置向从UUV输出协同定位后的经度、纬度数据。
[0030]协同定位装置和从UUV的信息交互如下：协同定位装置需要状态信息时，向第二数
据处理模块发送XON开始接收信息，直至不需要时，发送XOFF结束通信；第二数据处理模块接收到协同定位装置的XON后，开始发送包含经度、纬度的状态信息，直至接收到XOFF后停止发送。第二数据处理模块需要协同定位结果时，向协同定位装置发送XON，直至不需要该结果后，发送XOFF停止通信；协同定位装置接收到从UUV的XON后开始发送协同定位结果，直至接收到XOFF后停止发送。
[0031](3
‑
2)与水声通信机的通信接口：第二水声通信机接收到主UUV协同定位报文后，将解析后的报文信息与水声通信机记录的该协同定位报文的到达时刻输入给协同定位装置。
[0032]协同定位装置和声学通信接收机的信息交互如下：协同定位装置需要第二水声通信机接收本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于测距与信息交互的UUV集群协同定位系统，包括主UUV、从UUV和协同定位装置，其特征在于，具体构成包括：(1)一台主UUV，搭载多普勒测速仪DVL、高精度惯性导航系统INS、第一卫星单元模块、第一水声通信机、第一主控单元模块、第一动力系统、第一数据处理模块和第一时钟模块；其中：所述的多普勒测速仪进行对水和对水底锁定，用于测量主UUV航速；所述的高精度惯性导航系统INS用于估计主UUV自身位置和相应的运动姿态；所述的第一卫星单元模块用于主UUV浮出海面时，接收卫星位置更新和与控制中心的通信；所述的第一水声通信机用于主从UUV在水下的通信，主UUV通过水声通信机向控制中心汇报状态以及接收控制中心的指令与数据；所述的第一主控单元模块用于控制主UUV的上浮、下潜、任务切换；所述的第一动力系统用于输出主UUV所需动力；所述的第一数据处理模块用于结合DVL和INS数据，输出主UUV位置，并产生协同定位报文；所述的第一时钟模块用于提供时钟基准；(2)多台从UUV，每台从UUV搭载低精度惯性导航系统INS、第二卫星单元模块、第二水声通信机、第二主控单元模块、第二动力系统、第二数据处理模块和第二时钟模块；其中：所述的低精度惯性导航系统INS输出从UUV的定位结果与相应的运动姿态；所述的第二卫星单元模块用于从UUV浮出海面时，接收卫星位置更新和与控制中心的通信；所述的第二水声通信机用于从主UUV在水下的通信，以及接收协同定位数据报文；所述的第二主控单元模块用于控制从UUV的上浮、下潜、任务切换，具有通信和定位一体化功能；所述的第二动力系统用于输出从UUV所需动力；所述的第二数据处理模块用于从UUV的内部数据处理；所述的第二时钟模块用于提供时钟基准；主UUV搭载的高精度惯性导航系统INS与从UUV搭载的低精度惯性导航系统INS为精度相对高低；(3)协同定位装置，安装于从UUV上，用于协同定位的算法执行和输出协同定位结果；所述的协同定位装置包含主导航单元和副导航单元，利用从UUV的INS数据进行位置估计作为主导航单元；利用声学测距和协同定位报文滤波处理作为副导航单元；协同定位装置向外提供两个接口：与数据处理模块的通信接口和与水声通信机的通信接口；接口通信采用串口通信，发送TX、接收RX与地线连接的方式，使用软件握手XON/XOFF方式建立通信连接；需要通信时，接收端向发送端发送XON，开始接收数据；发送端接收到XON后开始发送数据；不需要通信时，接收端反馈XOFF结束通信；(3
‑
1)与数据处理模块的通信接口：从UUV默认以1Hz的频率向协同定位装置输入INS采集的经度、纬度、航速、航向、深度、时间戳数据；协同定位装置向从UUV输出协同定位后的经度、纬度数据；
协同定位装置和从UUV的信息交互如下：协同定位装置需要状态信息时，向第二数据处理模块发送XON开始接收信息，直至不需要时，发送XOFF结束通信；第二数据处理模块接收到协同定位装置的XON后，开始发送包含经度、纬度的状态信息，直至接收到XOFF后停止发送；第二数据处理模块需要协同定位结果时，向协同定位装置发送XON，直至不需要该结果后，发送XOFF停止通信；协同定位装置接收到从UUV的XON后开始发送协同定位结果，直至接收到XOFF后停止发送；(3
‑
2)与水声通信机的通信接口：第二水声通信机接收到主UUV协同定位报文后，将解析后的报文信息与水声通信机记录的该协同定位报文的到达时刻输入给协同定位装置；协同定位装置和声学通信接收机的信息交互如下：协同定位装置需要第二水声通信机接收的信息时，向第二水声通信机发送XON，直至不需要该信息，发送XOFF；第二水声通信机接收到XON后，接收到主UUV的协同定位报文，向协同定位装置输入协同定位报文数据和其到达时刻，直至接收到XOFF停止发送。2.如权利要求1所述的基于测距与信息交互的UUV集群协同定位系统，其特征在于，该协同定位系统的工作模式为：主UUV融合多普勒测速仪和高精度惯性导航系统INS数据，输出高精度的主UUV参考位置，并将关键信息打包成协同定位数据报文，以固定的时间间隔通过第一水声通信机广播给集群中的从UUV，关键信息包括自身的位置、状态协方差矩阵信息、发送时间戳；从UUV的低精度惯性导航系统INS更新频率高，将其采集的包括经度、纬度的数据作为协同定位装置中的主导航单元；协同定位装置中副导航单元更新频率低；当第二水声通信机接收到主UUV的协同定位报文之后，记录协同定位报文的到达时间戳，并结合解析的协同定位报文内容输入给协同定位装置；协同定位装置根据第二水声通信机输入的信息，经过协同定位处理，输出给从UUV更新后的定位信息，完成协同定位。3.采用权利要求1所述UUV集群协同定位系统的协同定位方法，其特征在于，具体是：步骤(1)主UUV、从UUV下水前进行内部时钟驯服，保持时钟同步，完成驯服后开始水下工作；主UUV的第一卫星单元模块和从UUV的第二卫星单元模块开始工作，主UUV和从UUV的定位信息进行初始化；步骤(2)进入稳定工作状态后，主UUV的第一数据处理模块以固定周期T
′
生成协同定位数据报文，协同定位数据报文包括经度L
M,k
...

【专利技术属性】
技术研发人员：陈惠芳，谢磊，刘峰，徐文，
申请(专利权)人：浙江大学，
类型：发明
国别省市：