一种多水下机器人协同目标搜索方法技术

本发明专利技术属于多水下机器人应用领域，具体涉及多水下机器人在深海目标搜索过程中的协同估计问题，实现水下有源目标的目标位置与时钟偏差估计，并实现多普勒测速仪无法底跟踪情况下的速度补偿，提高了多水下机器人定位精度，满足了大范围的航海作业需求的一种多水下机器人协同目标搜索方法，包括多普勒测速仪模块、水声同步通信机模块、非线性估计模块、协同编队控制模块。本发明专利技术使得多水下机器人在深海执行搜索任务的过程中，既能够有效估计出失事目标位置，又能够保持足够的定位精度，在不过度增加系统复杂性和不大幅提高设备成本的条件下，满足了多水下机器人系统大范围目标搜索作业需求。方法逻辑清晰、实践简单。

A cooperative target searching method for multiple underwater robots

【技术实现步骤摘要】
一种多水下机器人协同目标搜索方法
本专利技术属于多水下机器人应用领域，具体涉及多水下机器人在深海目标搜索过程中的协同估计问题，实现水下有源目标的目标位置与时钟偏差估计，并实现多普勒测速仪无法底跟踪情况下的速度补偿，提高了多水下机器人定位精度，满足了大范围的航海作业需求的一种多水下机器人协同目标搜索方法。
技术介绍
深海水下目标搜索是水下机器人领域的重要应用方向，多水下机器人目标搜索是MH370搜索过程中为数不多的手段之一。然而，深海目标搜索需要面临两个问题：(1)有源目标(如黑匣子)等时钟误差会逐渐累积，导致所获得的距离测量信息存在误差，降低搜索精度，甚至会导致搜索结果发散；(2)深海环境往往超过多普勒测速仪的使用范围，且水下无法使用GNSS定位方法，导致水下机器人在深海作业时定位偏差较大，需要多次出水校准，降低了作业效率。本专利中的多水下机器人协同目标搜索方法，利用水声同步通信机模块实现水下机器人与失事目标、其他水下机器人间信息交互，最终完成目标位置、时钟偏差和海流信息的估计，并将海流信息补偿给多普勒测速仪，提高速度信息的观测精度，进而完成深海水下目标协同搜索的目的。
技术实现思路
本专利技术的目的是提供一种基于多水下机器人的深海失事目标搜索方法，并且在获取失事目标位置信息的同时能够保证多水下航行器深海海域航行时定位精度。一种多水下机器人协同目标搜索方法，包括多普勒测速仪模块、水声同步通信机模块、非线性估计模块、协同编队控制模块。多普勒测速仪模块:多普勒测速仪(120kHz)对典型海底测量范围大约300-400米，当水深超出测量范围无法实现对底测速时，可自动切换为对流测速模式。水声同步通信机模块：水声同步通信机在典型海洋环境下通信范围不小于3km，具备1PPM的高精度晶振，在实现通信功能基础上，可实现单向传播时间(OneWayTravelTime)测距。非线性估计模块：利用有源目标的距离测量信息、其他水下机器人的位置估计信息、海流估计信息、距离信息，采用因子图优化方法，实现目标位置、时钟偏差的最优估计。协同编队控制模块：利用多水下机器人间的位置信息，实现多水下机器人编队队形变换，本专利中主要指收缩与膨胀变换。一种多水下机器人协同目标搜索方法，包括以下几个步骤：1.开始航行任务，启动多普勒测速仪、水声同步通信机、非线性估计模块和协同编队控制模块；2.水下机器人利用多普勒测速仪获取的相对水体的测速信息完成位置估计，协同编队控制模块开始进行队形变换任务。与此同时，水下机器人开始广播自身位置信息、流速估计信息；3.在队形变换任务开始后，非线性估计模块根据失事目标测距信息、其他水下机器人的自身位置与海流估计信息，利用因子图优化方法，实现海流流速的估计；4.水下机器人完成队形变换任务，融合海流估计结果与多普勒测速信息，补偿多普勒测速仪对流测速带来的位置误差，实现水下机器人自身位置估计；5.水下机器人在自身位置估计基础上，实现目标位置与时钟偏差的估计，判断估计数据是否收敛，若收敛结束协同目标搜索任务，否则回到步骤2。本专利技术的有益效果:本专利技术使得多水下机器人在深海执行搜索任务的过程中，既能够有效估计出失事目标位置，又能够保持足够的定位精度，在不过度增加系统复杂性和不大幅提高设备成本的条件下，满足了多水下机器人系统大范围目标搜索作业需求。方法逻辑清晰、实践简单。附图说明图1多水下机器人协同目标搜索系统结构框图；图2多水下机器人信息广播示意图；图3目标搜索方法因子图；图4收缩与膨胀队形变换示意图；图5目标搜索方法流程图。具体实施方式下面将结合附图对本专利技术做进一步详细说明。本专利技术公开了一种多水下机器人协同目标搜索方法，包括多普勒测速仪模块、水声同步通信机模块、非线性估计模块、协同编队控制模块。在多水下机器人系统搜索深海失事有源目标的过程中，水下机器人利用水声同步通信机模块发送自身位置信息、海流估计信息、目标位置估计信息和目标时钟偏差估计信息，在多普勒测速仪模块获取对流测速信息的基础上，通过非线性估计模块实现对于海流流速、目标位置和目标时钟偏差的估计。与此同时，通过协同编队控制模块实现多水下机器人系统的队形变换，保障目标搜索过程中的系统可观测性。本专利技术使得多水下机器人在深海执行搜索任务的过程中，既能够有效估计出失事目标位置，又能够保持足够的定位精度，满足了多水下机器人系统大范围目标搜索作业需求。结合图1,多水下机器人协同目标搜索系统结构如下：如图1所示，多水下机器人协同目标搜索系统结构包括多普勒测速仪模块、水声同步通信机模块、非线性估计模块、协同编队控制模块.水下机器人利用水声同步通信机模块发送自身位置信息、海流估计信息、目标位置估计信息和目标时钟偏差估计信息，在多普勒测速仪模块获取对流测速信息的基础上，通过非线性估计模块实现对于海流流速、目标位置和目标时钟偏差的估计。结合图2,介绍多水下机器人信息广播方法：假设有m个水下机器人，ΔT为系统内所有单元发送信息的周期，在整数信息广播时间点kΔT，失事目标发送脉冲信息Ptarget(kΔT),在时间点，第i个水下机器人发送自身位置信息Xauvi(kΔT)和海流估计信息Cauvi(kΔT)。结合图3和图4，多水下机器人目标搜索方法表示如下：如图3所示，为简化因子图的复杂程度，以两个水下机器人构成的搜索方法为例，表示第i个机器人k时刻的位置估计，表示第i个机器人k时刻的海流速度估计，表示失事目标的位置信息，表示时钟偏差带来的距离测量误差信息，黑色实心点表示变量间的因子关系，即观测与预测间的误差。如图4所示，目标搜索时多水下机器人队形变换策略为收缩与膨胀队形变换方法，即多水下机器人减少或增加队形内的机器人间相对距离，实现队形的收缩与膨胀，提高系统的观测性。结合图5，介绍多水下机器人目标搜索方法的算法流程：1.开始航行任务，启动多普勒测速仪、水声同步通信机、非线性估计模块和协同编队控制模块；2.水下机器人利用多普勒测速仪获取的相对水体的测速信息完成位置估计，协同编队控制模块开始进行队形变换任务。与此同时，水下机器人开始广播自身位置信息、流速估计信息；3.在队形变换任务开始后，非线性估计模块根据失事目标测距信息、其他水下机器人的自身位置与海流估计信息，利用因子图优化方法，实现海流流速的估计；4.水下机器人完成队形变换任务，融合海流估计结果与多普勒测速信息，补偿多普勒测速仪对流测速带来的位置误差，实现水下机器人自身位置估计；5.水下机器人在自身位置估计基础上，实现目标位置与时钟偏差的估计，判断估计数据是否收敛，若收敛结束协同目标搜索任务，否则回到步骤2。本文档来自技高网...

【技术保护点】
1.一种多水下机器人协同目标搜索方法，包括多普勒测速仪模块、水声同步通信机模块、非线性估计模块、协同编队控制模块；/n多普勒测速仪模块：多普勒测速仪对典型海底测量范围大约300-400米，当水深超出测量范围无法实现对底测速时，可自动切换为对流测速模式；/n水声同步通信机模块：水声同步通信机在典型海洋环境下通信范围不小于3km，具备1PPM的高精度晶振，在实现通信功能基础上，可实现单向传播时间测距；/n非线性估计模块：利用有源目标的距离测量信息、其他水下机器人的位置估计信息、海流估计信息、距离信息，采用因子图优化方法，实现目标位置、时钟偏差的最优估计；/n协同编队控制模块：利用多水下机器人间的位置信息，实现多水下机器人编队队形变换，本专利中主要指收缩与膨胀变换。/n

【技术特征摘要】
1.一种多水下机器人协同目标搜索方法，包括多普勒测速仪模块、水声同步通信机模块、非线性估计模块、协同编队控制模块；
多普勒测速仪模块：多普勒测速仪对典型海底测量范围大约300-400米，当水深超出测量范围无法实现对底测速时，可自动切换为对流测速模式；
水声同步通信机模块：水声同步通信机在典型海洋环境下通信范围不小于3km，具备1PPM的高精度晶振，在实现通信功能基础上，可实现单向传播时间测距；
非线性估计模块：利用有源目标的距离测量信息、其他水下机器人的位置估计信息、海流估计信息、距离信息，采用因子图优化方法，实现目标位置、时钟偏差的最优估计；
协同编队控制模块：利用多水下机器人间的位置信息，实现多水下机器人编队队形变换，本专利中主要指收缩与膨胀变换。


2.根据权利要求1所述的一种多水下机器人协同目标搜索方法，其特征在于：水声同步通信机具备1PPM的高精度时钟，可利用单向传播时间...

【专利技术属性】
技术研发人员：吴迪，严浙平，秦东亚，陈涛，李本银，张伟，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙;23