一种多UUV跟踪围捕系统及围捕方法

摘要

本发明公开了一种多UUV跟踪围捕系统及围捕方法，包括四艘同构UUV；每艘UUV由感知模块、通信模块、行为控制模块、协作规划模块、协调控制模块组成。感知模块对自身状态和水下环境进行联系检测；协作规划模块根据通信模块接收其他UUV状态和目标状态做出任务规划；协调控制模块根据协作规划模块输出给予每个UUV期望的控制输入，形成正四面体型编队精确监控闯入目标的行为，根据分布式一致性算法对目标进行跟踪围捕。本发明实现多UUV目标跟踪围捕，能够对跟踪目标的精确定位，并根据跟踪精度自主形成期望跟踪队形；当水下通信不畅有延时或丢失时，多UUV根据所接收不完整的状态信息可对目标进行跟踪围捕。