基于零化控制障碍函数的多AUV协同巡检避障控制方法

摘要: 本发明属于多auv协同巡检控制,具体涉及一种基于零化控制障碍函数的多auv协同巡检避障控制方法。背景技术:1、随着海洋资源开发、深海养殖及水下设施运维需求的不断...
基于零化控制障碍函数的多AUV协同巡检避障控制方法

本发明属于多auv协同巡检控制,具体涉及一种基于零化控制障碍函数的多auv协同巡检避障控制方法。

背景技术:

1、随着海洋资源开发、深海养殖及水下设施运维需求的不断增加,自主水下航行器(autonomous underwater vehicle,auv)逐渐应用于水下设备检测、养殖网箱巡查、海洋环境监测等任务。相较于单auv作业,多auv协同巡检能够通过任务分工和空间协同扩大巡检范围、提高作业效率,并增强复杂水下环境中的任务执行能力。然而,实际水下环境中通常存在网箱附属设施、锚泊装置、水下照明设备及其他障碍物,同时受到通信距离有限、定位精度不足和环境扰动等因素影响,使多auv在保持协同巡检队形的同时实现安全避障具有较大难度。

2、目前,多auv协同巡检控制主要采用编队控制、路径跟踪、人工势场及局部路径规划等方法。部分方法依赖全局坐标、预先规划轨迹或较完整的环境信息,需要各auv持续获取自身及其他auv的精确位置信息,在水下通信和定位条件受限时,其实际应用受到一定限制。此外,现有巡检方法通常侧重于巡检路径跟踪或队形保持,对不同auv沿不同半径巡检路径进行协同运行的研究相对不足。

3、在障碍物避让方面,传统人工势场法、速度障碍法及局部路径规划方法虽然能够在一定程度上实现避障,但容易出现局部极值、控制突变或巡检队形明显破坏等问题,并且通常难以从控制层面对auv与障碍物之间的安全距离提供明确保证。已有控制障碍函数方法能够通过安全约束对控制输入进行修正,但多数方法主要关注单auv避障或多auv碰撞规避,对完成巡检任务同时避开障碍物的全过程的协调控制考虑不足。

4、因此,如何在主要依赖局部相对信息的条件下,在尽量保持巡检控制性能的同时,对存在碰撞风险的auv控制指令进行安全修正,并使auv在完成障碍物避让后恢复至预定巡检半径、相位关系及航向状态,是多auv协同巡检控制中亟待解决的技术问题。

技术实现思路

1、本发明的主要目的在于克服现有技术的缺点与不足,提出一种基于零化控制障碍函数的多auv协同巡检避障控制方法。

2、为了达到上述目的,本发明采用以下技术方案:

3、基于零化控制障碍函数的多auv协同巡检避障控制方法,包括以下步骤:

4、s1、构建多auv运动学模型,根据巡检任务为各auv设置不同的期望巡检半径;

5、s2、构建基于局部信息的分布式巡检控制器,将局部相对位置信息驱动的巡检控制项与相位、半径和航向恢复辅助项相结合,使各auv收敛至对应巡检路径并保持期望相位关系;

6、s3、设置基于前视点的zcbf安全滤波器,根据障碍物、auv安全半径以及安全裕度构造安全边界,并通过加权最小修改获得满足安全约束的控制输入;

7、s4、根据得到的满足安全约束的控制输入驱动各auv,实现协同巡检、障碍物避让及避障后的队形恢复。

8、本发明与现有技术相比,具有如下优点和有益效果:

9、1、本发明通过构建基于局部信息的分布式巡检控制器,使各auv能够根据预设的不同期望巡检半径形成巡检路径,并主要利用auv与下一邻居以及巡检中心之间的相对位置信息实现巡检运动与协同关系保持,降低了对全局精确定位和高带宽通信的依赖;通过引入相位、半径和航向恢复辅助项,使auv在受到避障控制作用而偏离原有巡检状态后,能够逐步恢复至期望巡检半径、相位关系及航向状态,提高了协同巡检队形的恢复能力和稳定性;同时,针对复杂水下环境中的障碍物安全问题,本发明设置基于前视点的零化控制障碍函数安全滤波器,综合考虑障碍物尺寸、auv安全半径及安全裕度构造安全约束,并采用加权最小修改方式对名义巡检控制指令进行实时修正,在尽可能保持原有巡检控制性能的同时满足安全避障要求;本发明实现了多auv正常协同巡检、局部安全避障以及避障后巡检队形恢复的统一控制,提高了复杂水下环境中多auv巡检作业的安全性、稳定性和适应能力。

1.基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,包括以下步骤:

2.根据权利要求1所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,步骤s1中,多auv运动学模型,表示为:

3.根据权利要求1所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,步骤s2具体包括:

4.根据权利要求3所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,恢复辅助项具体为:

5.根据权利要求1所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,步骤s3中,设置基于前视点的zcbf安全滤波器,具体包括:

6.根据权利要求5述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,设置基于前视点的zcbf安全滤波器还包括:

7.根据权利要求6所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,为了使第个auv在运动过程中保持在安全集内,对安全函数施加zcbf条件,其表达式为:

8.根据权利要求7所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,zcbf安全约束的激活条件具体为:

9.根据权利要求1所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,步骤s3中,通过加权最小修改获得满足安全约束的控制输入,具体为:

10.根据权利要求9所述的基于零化控制障碍函数的多auv协同巡检避障控制方法,其特征在于,步骤s4中,根据得到的满足安全约束的控制输入驱动各auv,具体为: