[发明专利]一种考虑执行器故障的UUV自适应容错集群协调控制方法

说明书

本发明公开了一种考虑执行器故障的UUV自适应容错集群协调控制方法，通过利用编队中各UUV局部状态信息估计容错控制器参数，设计自适应容错跟踪控制器，保证跟随者UUV的运动状态渐进跟踪领导者状态，从而实现稳定的编队跟踪控制。本发明可有效实现执行器故障条件下的UUV集群协调控制，并且做到跟随者航行器能够跟踪预先设定的机动路径。本发明可以有效解决UUV在执行器故障下的集群控制问题。可以保证集群中各UUV在执行器故障干扰的情况下，启动自适应容错机制，最终跟随者航迹均收敛于编队领航者的期望轨迹，实现多UUV编队队形保持。

技术领域

本发明属于水下无人航行器集群协调控制技术领域，具体涉及一种考虑执行器故障的UUV自适应容错集群协调控制方法。

背景技术

UUV(水下无人航行器)是一种体积小、成本低、可完成大范围深海任务的海洋工具，可应用于海洋科学考察、水下目标搜索与探测等广泛领域，多UUV的集群机动性能是大规模探测任务的关键技术。由于水下环境复杂且存在极大的不确定性，以及水声通讯受限等根本原因，造成多水下航行器集群系统在执行任务的过程中发生推进器破损等故障，因此，当航行器系统发生故障时，需要采取及时有效的容错控制措施，使得航行器系统在执行器故障下依然能够完成集群机动勘测任务。

针对UUV集群控制方法，较多编队控制方法没有考虑执行器故障的情况，如李乐强在文章《模型参数不确定条件下的自主水下航行器自适应编队控制研究》(发表于2022，舰船电子工程，第一期)中提出一种自适应分布式控制律，与编队参考中心保持期望的距离，形成编队。吕达在文章《弱通讯条件下水下航行器编队行为分析》(发表于2022，兵器装备工程学报第十二期)针对水下无人航行器编队控制提出了一种弱通讯条件下的非主从编队控制策略。而在实际海洋机动作业中，由于通讯技术限制和环境不确定因素影响等原因，UUV往往会发生多种执行器故障。

发明内容

本发明的目的在于提供一种考虑执行器故障的UUV自适应容错集群协调控制方法。

本发明的目的通过如下技术方案来实现：

一种考虑执行器故障的UUV自适应容错集群协调控制方法，具体步骤如下：

步骤1：利用反馈线性化方法建立UUV运动学和动力学模型；

步骤2：初始化编队设置，设置UUV编队系统中各成员的随机初始状态和系统预设参数；

步骤3：通过UUV所搭载的导航设备和传感器采集编队系统的位姿信息和速度信息；

步骤4：UUV系统集群结构为领航-跟随类型，根据使命任务，获得领航者需跟随的期望轨迹，跟随者航行器之间的通讯拓扑图为固定拓扑图；

步骤5：判断UUV集群过程中是否发生执行器故障，若出现执行器故障则进行数据推算判别故障类型；

步骤6：建立系统位置和速度状态误差方程；

步骤7：对于跟随者UUV，利用通讯拓扑信息，结合自适应机制，估计跟随者UUV故障参数，设计自适应容错编队跟踪控制器，以及参数自适应更新律；

步骤8：利用步骤7设计的自适应容错编队跟踪控制器计算出各跟随者UUV的状态信息，并根据步骤4中通信拓扑向编队内成员进行信息传输；

步骤9：将步骤8中各跟随者UUV状态信息输入步骤7设计的自适应容错编队跟踪控制器中，推算编队成员各个自由度的推力，输入到UUV的各个执行机构，消除执行器故障的影响；

步骤10：在步骤4的通讯交互下，经过较短时间的容错状态调整，编队中各跟随者UUV的运动状态最终收敛到其领航者状态，即实现执行器故障下的多UUV自适应编队队形保持并跟踪领航者期望路径，任务结束。