CN113433955B - 有向切换拓扑下多auv编队队形一致性控制方法 - Google Patents

有向切换拓扑下多auv编队队形一致性控制方法 Download PDF

Info

Publication number
CN113433955B
CN113433955B CN202110780170.6A CN202110780170A CN113433955B CN 113433955 B CN113433955 B CN 113433955B CN 202110780170 A CN202110780170 A CN 202110780170A CN 113433955 B CN113433955 B CN 113433955B
Authority
CN
China
Prior art keywords
auv
formation
speed
matrix
directed
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110780170.6A
Other languages
English (en)
Other versions
CN113433955A (zh
Inventor
张勋
周立广
邢文
郑岩
吴迪
张宏瀚
徐健
陈涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN202110780170.6A priority Critical patent/CN113433955B/zh
Publication of CN113433955A publication Critical patent/CN113433955A/zh
Application granted granted Critical
Publication of CN113433955B publication Critical patent/CN113433955B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/04—Control of altitude or depth
    • G05D1/06—Rate of change of altitude or depth
    • G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

有向切换拓扑下多AUV编队队形一致性控制方法，它属于多自主式水下航行器的协调控制技术领域。本发明解决了在随机切换拓扑和编队队形变换时，现有控制方法的鲁棒性和稳定性差的问题。本发明在有向切换拓扑和变换编队队形情况下，通过反馈线性化方法将AUV运动学模型和动力学模型转化为二阶积分器形式，并在控制算法中加入水下航行器之间的相对位置信息和速度阻尼器，形成编队队形控制律。多AUV编队收敛速度提高，可以形成稳定的编队队形的速度更快，在切换拓扑和队形变换的情况下，控制器可以保持很好的稳定性和鲁棒性，多AUV系统可以收敛到期望位置。本发明可以应用于对多自主式水下航行器的协调控制。

Description

有向切换拓扑下多AUV编队队形一致性控制方法
技术领域
本发明属于多自主式水下航行器的协调控制技术领域，具体涉及有向切换拓扑下多AUV(Autonomous Underwater Vehicle，自主式水下航行器)编队队形一致性控制方法。
背景技术
自主水下航行器利用其搭载的各种传感器模块和其他任务模块，在水下资源勘测，水下扫雷，情报搜集等军事和民用领域起着重要的作用。随着执行海洋任务的难度增加，执行任务的环境变得更加复杂，单水下航行器体现出了执行任务效率低、工作范围小、系统冗余性差等不可避免的局限性。为了解决上述问题，多航行器协同执行任务成了发展的必然方向。多水下航行器协同执行任务可以增加系统的冗余性和鲁棒性，降低完成任务的成本，提高工作效率。
近些年来，许多科研人员提出了适用于不同模型的先进编队控制方法，其中更多的是将动力学模型抽象为一阶积分器，实际中，动力学模型抽象为二阶积分器更加真实。文献(CUI Rongxin,GE Sam Shuzhi,BernardVoon Ee How,et al.Leader–followerformation control of underactuated autonomous underwater vehicles[J])提出了一种基于李雅普诺夫反步法的多自主水下航行器编队协同运动控制方法。文献(QI,Xue,CAIZhi-jun.Three-dimensional formation control based on nonlinear small gainmethod for multiple underactuated underwater vehicles[J])针对在三维空间运动的欠驱动水下航行器，提出了一种分布式编队跟踪控制器。文献(R.Raja,S.Bidyadhar.Abackstepping approach for the formation control of multiple autonomousunderwater vehicles using a leader–follower strategy[J])建立了多艘由于通信故障而导致编队不完善的自主水下航行器的一致控制问题。文献(CHEN Shun,DanielW.C.Ho.Consensus control for multiple AUVs under imperfect information causedby communication faults[J])设计了一种基于反馈线性化的姿态控制器，使每个水下机器人的姿态收敛到其期望值。文献(YANG Hui,WANG Chuanfeng,Zhang Fumin.RobustGeometric Formation Control of Multiple Autonomous[C])利用一致性理论和速度通信拓扑控制多水下航行器编队保持，实现速度和航向一致性。任伟等人提出了一个二阶积分编队控制协议，为多智能体编队的固定拓扑和变换拓扑的情况提供了充分条件。
基于有向通信拓扑结构，文献(XIA Guoqing,ZHANG Yu,YANG Ying.ControlMethod of Multi-AUV Circular Formation Combining Consensus Theory andArtificial Potential Field Method[C])考虑了二阶积分器动力学模型的一致性算法，证明了与速度控制增益大于某个界限时，具有有向生成树的编队一致性是渐进达成的。文献(REN Wei.On consensus algorithms for double-integrator dynamics[C])提出了一种采样周期性间歇采样一致性控制协议，将多智能体间的误差控制在一定范围内，降低了控制器的采样时间。文献(YU Zhiyong,JIANG Haijun,HU Cheng.Second-Order Consensusfor Multiagent Systems via Intermittent Sampled Data Control[J])研究了高阶线性时变编队控制，提出一种通用的编队控制协议，数值仿真表明切换拓扑的群系统可以实现一致。文献(DONG Xiwang,SHI Zongying,GENG Lu,et al.Time-varying formationcontrol for high-order linear swarm systems with switching interactiontopologies[J]以及YANG Daopeng,REN Wei,LIU Xiangdong,et al.Decentralizedevent-triggered consensus for linear multi-agent systems under generaldirected graphs[J])研究了一般线性模型的多智能体系统的一致性控制协议以及事件触发一致性，通过在离散的采样时间，实现了多智能体编队的一致性。文献(二阶时滞多智能体系统分组一致性分析[J])研究了强连通图结构下，二阶多智能体系统的分组一致性。文献(NIAN Xiaohong,SU SaiJun,PAN Huan.Consensus tracking protocol and formationcontrol of multi-agent systems with switching topology[J])在已知拓扑集合下，设计了一阶编队控制协议，解决了已知拓扑集合下的一阶多智能体编队控制问题。文献(有向切换通信拓扑下多无人机分布式编队控制[J])的有向拓扑图条件为强连通且平衡条件，显然结果不具有一般性。
综上所述，虽然现有方法在多自主水下航行器协调控制方面已经取得了一定的成就，但是在随机切换拓扑和编队队形变换时，现有控制方法的鲁棒性和稳定性仍然较差，因此，提高现有控制方法的鲁棒性和稳定性是目前亟需解决的问题。
发明内容
本发明的目的是为解决在随机切换拓扑和编队队形变换时，现有控制方法的鲁棒性和稳定性差的问题，而提出一种在有向切换拓扑下多AUV编队队形一致性控制方法。
本发明为解决上述技术问题所采取的技术方案是：
有向切换拓扑下多AUV编队队形一致性控制方法，所述方法具体包括以下步骤：
步骤一、定义用于描述多AUV之间通信拓扑关系的有向图；
步骤二、基于反馈线性化方法，将AUV的运动学方程和动力学方程线性化为二阶积分形式的反馈线性化动态模型；
步骤三、利用有向图表示的AUV之间通信拓扑关系和二阶积分形式的反馈线性化动态模型，设计有向切换拓扑下多AUV编队队形一致性控制器；
步骤四、基于步骤三中的控制器，得到每个AUV的闭环控制形式。
本发明的有益效果是：
本发明在有向切换拓扑和变换编队队形情况下，通过反馈线性化方法将AUV运动学模型和动力学模型转化为二阶积分器形式，并在控制算法中加入水下航行器之间的相对位置信息和速度阻尼器，形成编队队形控制律。仿真结果表明，多AUV编队收敛速度提高，可以形成稳定的编队队形的速度更快，在切换拓扑和队形变换的情况下，控制器可以保持很好的稳定性和鲁棒性，多AUV系统可以收敛到期望位置。
附图说明
图1为AUV固定坐标系及运动坐标系的示意图；
图中，I为固定坐标系，E为海平面或海里某一点，即固定坐标系的原点，ξ,η,ζ为固定坐标系下的三个坐标轴，ξ轴的坐标表示AUV北向位置，η轴的坐标表示AUV东向位置，ζ轴的坐标表示AUV纵向位置，ψ为艏向角，θ为纵倾角，
Figure BDA0003156402330000031
为横倾角，B为运动坐标系，O为AUV重心，即运动坐标系的原点，x,y,z为运动坐标系下的三个坐标轴，x轴的正方向为由原点O指向AUV艏部的方向，y轴的正方向为由原点O指向AUV右舷的方向，z轴的正方向为AUV垂直向下方向，w为纵向速度，p为横倾角速度，u为北向速度，v为东向速度；
图2a为多AUV系统通信拓扑图一；
图2b为多AUV系统通信拓扑图二；
图2c为多AUV系统通信拓扑图三；
图2d为多AUV系统通信拓扑图四；
图3a为位姿切换拓扑时序图；
图3b为速度切换拓扑时序图；
图4为多AUV编队队形变换图；
图5为切换拓扑下多AUV的纵倾角曲线图；
图6为切换拓扑下多AUV的艏向角曲线图；
图7为切换拓扑下多AUV的北向速度曲线图；
图8为切换拓扑下多AUV的东向速度曲线图；
图9为切换拓扑下多AUV的纵向速度曲线图；
图10为切换拓扑下多AUV的纵倾角速度曲线图；
图11为切换拓扑下多AUV的艏向角速度曲线图。
具体实施方式
具体实施方式一、本实施方式所述的有向切换拓扑下多AUV编队队形一致性控制方法，所述方法具体包括以下步骤：
步骤一、定义用于描述多AUV之间通信拓扑关系的有向图；
步骤二、基于反馈线性化方法，将AUV的运动学方程和动力学方程线性化为二阶积分形式的反馈线性化动态模型；
步骤三、利用有向图表示的AUV之间通信拓扑关系和二阶积分形式的反馈线性化动态模型，设计有向切换拓扑下多AUV编队队形一致性控制器；
步骤四、基于步骤三中的控制器，得到每个AUV的闭环控制形式。
具体实施方式二、本实施方式与具体实施方式一不同的是：所述步骤一的具体过程为：
将每个AUV作为有向图的一个顶点，有向图记为G＝(V,ε,C)，其中，V代表全部顶点的集合，V＝{v1,v2,…,vn}，n为编队内AUV的个数，(vi,vj)∈ε，ε代表顶点之间边的集合，也就是各AUV成员通信链的集合，(vi,vj)表示由顶点vi和vj构成的有向边，顶点vj接收顶点vi的信息，vi称为边的父顶点，vj称为边的子顶点，C为邻接矩阵；
邻接矩阵C满足：
Figure BDA0003156402330000041
对于
Figure BDA0003156402330000042
若i＝j，则cij＝0，若i≠j且集合ε中存在有向边(vi,vj)，则cij＝1，否则cij＝0。
有向图的入度矩阵D＝diag(deg(v1),deg(v2),…,deg(vn))，如果矩阵L满足L＝D-C，那么称矩阵L为有向图G＝(V,ε,A)的Laplacian矩阵(拉普拉斯矩阵)。
其它步骤及参数与具体实施方式一相同。
具体实施方式三、本实施方式与具体实施方式一或二之一不同的是：所述AUV的运动学方程为：
Figure BDA0003156402330000043
式中，
Figure BDA0003156402330000044
为η的一阶导数，
Figure BDA0003156402330000045
表示位置状态和欧拉角状态，ξ0为AUV的北向坐标，η0为AUV的东向坐标，ζ0为AUV的纵向坐标，θ为AUV的纵倾角，ψ为AUV的艏向角，
Figure BDA0003156402330000059
代表实数域，
Figure BDA00031564023300000510
表示速度的状态，u0为AUV的北向速度，v0为AUV的东向速度，w0为AUV的纵向速度，q为AUV的纵倾角速度，r为AUV的艏向角速度，J(η)为AUV从运动坐标系到固定坐标系下的雅可比矩阵。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四、本实施方式与具体实施方式一至三之一不同的是：所述AUV的动力学方程为：
Figure BDA0003156402330000051
式中，
Figure BDA0003156402330000052
为υ的一阶导数，非奇异矩阵M＝MR+MA，MR为惯性矩阵，MA为附加惯性矩阵，τ0表示控制输入力和力矩，C(υ)＝Cr(v)+CA(v)，Cr(v)表示刚体哥氏力和向心力矩阵，CA(v)是由于流体的附加质量所产生的力矩，D(υ)为总的水动力阻尼，g(η)为重力和浮力所产生的恢复力和力矩。
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五、本实施方式与具体实施方式一至四之一不同的是：所述二阶积分形式的反馈线性化动态模型为：
Figure BDA0003156402330000053
其中，xi(t)和vi(t)分别表示第i个AUV在t时刻的位置和速度，
Figure BDA0003156402330000054
Figure BDA0003156402330000055
为vi(t)的一阶导数，
Figure BDA0003156402330000056
是第i个AUV在t时刻的控制输入，i＝1,2,…n，
Figure BDA0003156402330000057
为xi(t)的一阶导数。
其它步骤及参数与具体实施方式一至四之一相同。
将AUV的运动学方程和动力学方程线性化为二阶积分形式的反馈线性化动态模型时采用的是现有方法，其具体过程如下：
由于横摇对平动的影响不大，本发明忽略横摇速度。从而得到了运动学和动力学的非线性耦合方程：
Figure BDA0003156402330000058
其中，M＝MR+MA包括了惯性矩阵和附加惯性矩阵，并且M一定是非奇异矩阵。τ表示控制输入力和力矩。将模型中C(υ)υ,D(υ)υ,g(η)三项合并成一个列向量W(η,υ)υ表示惯性质量及附加惯性质量之外的部分。
Figure BDA0003156402330000061
为方便反馈线性化过程，将上式写成下面的形式，
Figure BDA0003156402330000062
将航行器的位姿状态信息和速度状态信息构成向量ξ＝[ηT,υT]T。
将式(25)表示成
Figure BDA0003156402330000063
其中，
Figure BDA0003156402330000064
Figure BDA0003156402330000065
Figure BDA0003156402330000066
表示控制输入向量,
Figure BDA0003156402330000067
其中：
Figure BDA0003156402330000068
为了简化表示取Σ1和Σ2，
Figure BDA0003156402330000069
Figure BDA00031564023300000610
Figure BDA0003156402330000071
那么，定义一个输出函数ζ＝h(ξ)后，与式(26)一起，将AUV系统动力学模型表示为一般非线性系统。
Figure BDA0003156402330000072
为了更清楚地理解反馈线性化过程，现将反馈线性化中需要的数学基础进行简要介绍。
【向量场】：考虑单输入—单输出系统
Figure BDA0003156402330000073
其中，f,g和h在定义域
Figure BDA0003156402330000074
上足够光滑。映射
Figure BDA0003156402330000075
和
Figure BDA0003156402330000076
称为D上的向量场。导数
【Lie导数】：导数
Figure BDA0003156402330000077
为
Figure BDA0003156402330000078
其中
Figure BDA0003156402330000079
称为h关于f或沿f的Lie导数，这种表示方法类似于h沿系统
Figure BDA00031564023300000710
轨迹的导数。当重复计算关于同一向量场或一新向量场的导数时，这种新表示法较为方便。例如，要用到以下表示：
Figure BDA00031564023300000711
Figure BDA00031564023300000712
如果Lgh(x)＝0，则
Figure BDA00031564023300000713
与u无关。则继续计算y的二阶导数，那么对于有y的二阶导数有：
Figure BDA0003156402330000081
【相对阶】如果对于所有
Figure BDA0003156402330000082
有
Figure BDA0003156402330000083
并且
Figure BDA0003156402330000084
也就是可表示为如下形式：
Figure BDA0003156402330000085
时称非线性系统在区域
Figure BDA0003156402330000086
上具有相对阶ρ，1≤ρ≤n。
【MIMO相对阶】给出如下的多输入多输出系统：
Figure BDA0003156402330000087
其中：
Figure BDA0003156402330000088
为AUV编队的状态向量，
Figure BDA0003156402330000089
为AUV编队的输出向量，
Figure BDA00031564023300000810
为AUV编队的控制输入向量，f(xi),g(xi)为n维向量场，且g(x)＝[g1(x),…,gm(x)]，h(x)＝[h1(x),…,hm(x)]T。
若上述MIMO系统存在相对阶，则须满足下述条件：
Figure BDA00031564023300000811
对于任意1≤i≤m，至少存在一个j满足
Figure BDA00031564023300000812
且存在m×m维矩阵
Figure BDA00031564023300000813
Γ(x)是非奇异矩阵，多输入多输出系统的相对阶向量为
Figure BDA00031564023300000814
其中每一个ρi代表相对于hi(x)的子相对阶。
那么，针对非线性耦合的潜航器数学模型，精确反馈线性化的方法思想是：寻找一个反馈控制率u以及坐标变换。对于式(31)的一般非线性表示的潜航器数学模型，可取
h(x)＝[h1(x),h2(x),h3(x),h4(x),h5(x)]T＝[x,y,z,θ,ψ]T (41)
从AUV的运动学模型和动力学模型中可获取f(x),g(x)，控制输入
Figure BDA00031564023300000815
仍是三个轴方向的推进器的推力和两个舵的舵角。
Figure BDA0003156402330000091
其中f(x)的表示形式如下：
Figure BDA0003156402330000092
根据Lie导数的定义，可得式(31)的一般非线性系统形式AUV模型的Lie导数，
Figure BDA0003156402330000093
由h(x)的定义可以得到偏微分方程如下：
Figure BDA0003156402330000094
根据gi(x)可知，它的前五行元素都为0，所以对于任意1≤i≤5，1≤j≤5，
Lgihj(x)＝0 (46)
求得h(x)沿f(x)求取李导数有如下结果：
Figure BDA0003156402330000095
同理，根据二阶Lie导数的定义(36)可导出，
Figure BDA0003156402330000101
设由Γij(x)＝LgjLfhi(x)，1≤i≤5，1≤j≤5构成的矩阵
Figure BDA0003156402330000102
可表示为
Figure BDA0003156402330000103
其中，m*g*＝m33g′34+m33g′44，m′g′＝m22g′24+m25g′55。
因此AUV系统存在相对阶：ρ1＝2,ρ2＝2,ρ3＝2,ρ4＝2,ρ5＝2，且相对阶ρ1+ρ2+ρ3+ρ4+ρ5＝10和系统阶数相同。
取坐标变换：
Figure BDA0003156402330000104
由Lie导数的定义可知，
Figure BDA0003156402330000105
Figure BDA0003156402330000106
在新的坐标变换下，控制输入u可以表示为
Figure BDA0003156402330000107
可得
Figure BDA0003156402330000111
由此可得该坐标系统下的线性二阶积分模型，即在坐标变换(50)以及反馈输入(55)下可得
Figure BDA0003156402330000112
Figure BDA0003156402330000113
上面的精确反馈线性化过程是针对潜航器单体。由于本发明研究的潜航器编队是建立在同构的基础上，所以编队中全部潜航器具有相同的水动力方程及运动学方程。所以编队中其他成员可以进行相同的反馈线性化。那么针对编队第i个潜航器个体，可以有
Figure BDA0003156402330000114
Figure BDA0003156402330000115
其中，
Figure BDA0003156402330000116
具体实施方式六、本实施方式与具体实施方式一至五之一不同的是：所述有向切换拓扑下多AUV编队队形一致性控制器的形式为：
Figure BDA0003156402330000117
其中：u(t)为控制器，vd(t)是t时刻的阻尼速度，即航行器形成编队后的行驶速度，k0，k1，k2是控制增益，Ni为父顶点vi的子顶点的集合，τ是AUV之间的通信延迟，xj(t-τ)表示第j个AUV在t-τ时刻的位置，vj(t-τ)表示第j个AUV在t-τ时刻的速度，
Figure BDA0003156402330000118
表示第i个AUV相对于第j个AUV的期望位置，
Figure BDA0003156402330000119
表示第j个AUV相对于第i个AUV的期望位置，aij表示位置耦合项的邻接矩阵，bij表示速度耦合项的邻接矩阵。
本实施方式设计一种分布式多航行器系统，只需知道局部航行器之间的相对位置和速度信息，就可以实现全局的协调一致。控制律由速度阻尼项，航行器位置耦合项和速度耦合项组成，当vd(t)＝0时，水下航行器形成静态编队；当vd(t)≠0时，整个编队以速度vd(t)前进。为了实现稳定的编队，水下航行器达到相同的速度，为了使其保持一定的队形，要求与相邻的水下航行器保持预先设定的位置。
位置耦合项的邻接矩阵aij和速度耦合项的邻接矩阵bij均根据邻接矩阵C的定义方式获得。
其它步骤及参数与具体实施方式一至五之一相同。
具体实施方式七、本实施方式与具体实施方式一至六之一不同的是：所述步骤四的具体过程为：
Figure BDA0003156402330000121
本实施方式表明，水下航行器能否形成期望队形、收敛至期望速度，不仅与多AUV之间通信拓扑相关，还取决于反馈增益系数和时延大小。
定义：对于多AUV系统的任意初始状态，给定闭环控制形式在一个有限时间的区间内t0∈[0,+∞)，使得
Figure BDA0003156402330000122
当t＞t0时，有xj(t)-hj＝xi(t)-hi，vj(t)＝vi(t)，i,j＝1,2,…n,则称多AUV系统可以在有限时间里达成一致。
其它步骤及参数与具体实施方式一至六之一相同。
1、控制算法稳定性分析
1.1模型简化
对一个时延系统进行稳定性分析，需要采用泛函微分方程，本发明通过构造合适的Lyapunov-Krasovskii函数沿着其求导，再通过适当放缩，得出使得含时延系统实现一致性的充分条件。
证明：
令
Figure BDA0003156402330000123
则式(1)有
Figure BDA0003156402330000124
aij为系统邻接矩阵，令
Figure BDA0003156402330000131
将式(3)写成紧凑形式
Figure BDA0003156402330000132
存在正交矩阵U，使UTAU＝In-λ，UTBU＝In-λ，其中U是Laplacian矩阵L的特征向量组成的矩阵，λ＝diag(λ1,λ2,…,λn)，考虑坐标变换
Figure BDA0003156402330000133
则式(8)可以写成
Figure BDA0003156402330000134
上式经过线性变换表示为下式，
Figure BDA0003156402330000135
令，
Figure BDA0003156402330000136
Figure BDA0003156402330000137
将上式简写为：
Figure BDA0003156402330000138
1.2稳定性分析
定义Lyapunov-Krasovskii函数为：
Figure BDA0003156402330000141
对V(t)沿着系统求导得：
Figure BDA0003156402330000142
将系统方程代入上式得
Figure BDA0003156402330000143
由于
Figure BDA0003156402330000144
且对于任意的x,y∈Rn和正定对称矩阵∑∈Rn×n，有：
±2xTy≤xT∑-1x+yT∑y (17)
所以：
Figure BDA0003156402330000145
式(18)可以写成：
Figure BDA0003156402330000146
令
Figure BDA0003156402330000147
可将
Figure BDA0003156402330000148
改写为矩阵形式：
Figure BDA0003156402330000151
令Λ1＝(E+F)TP+P(E+F)+τETRE+Q，并由引理1可得：
Figure BDA0003156402330000152
如果M＜0，那么
Figure BDA0003156402330000153
根据Lyapunov稳定性判据可知，如果
Figure BDA0003156402330000154
那么误差系统全局渐近稳定，时延编队控制算法可以保持队形并使速度达到一致。
引理1：(Schur补)给定对称矩阵
Figure BDA0003156402330000155
其中A∈Rr×r，则下面条件等价：
1).S是正定的；
2).当且仅当C和A-BC-1BT都是正定的或者A和C-BTA-1B均是正定的。
2、仿真结果
在本发明中，给出了数值仿真例子来验证编队队形控制算法的有效性，本发明考虑4个AUV组成的多AUV系统，其有向通信拓扑结构如图2a，图2b，图2c，图2d所示。
多AUV编队所示通信拓扑结构的邻接矩阵C可表示为：
Figure BDA0003156402330000156
Figure BDA0003156402330000157
下面对水下航行器编队过程进行仿真分析，一致性控制算法中参数设置为k0＝0.4,k1＝0.1,k2＝0.2,水下航行器的期望速度设为vd＝0.2，常数时延τ＝0.1s，编队队形矩阵h设置为
Figure BDA0003156402330000161
将一致性控制算法中位置和速度的通信拓扑在图2a至图2d中4个通信拓扑状态下进行随机变化，位置和速度的通信拓扑变化时序图如图3a和图3b所示，多AUV系统编队队形变化如图4所示，多AUV系统的纵倾角和艏向角变化如图5和图6所示，多AUV系统的北向速度变化如图7所示，东向速度变化如图8所示，纵向速度如图9所示，纵倾角速度如图10所示，艏向角速度如图11所示。
随机布放4个水下航行器，多AUV编队在不同位置开始形成编队，并在300s时形成稳定编队队形，保持编队一段时间后，在1000s时进行编队队形变换。通过仿真验证多AUV编队在切换拓扑的情况下可以快速形成稳定的编队，并在编队队形变化时，能够快速改变编队队形，并保持稳定队形，证明了控制算法的稳定性和鲁棒性。
在图7、图8和图9的仿真结果中可以大体看出，AUV1，AUV2，AUV3，AUV4组成的多水下航行器系统，在切换拓扑条件下和编队进行变换时，水下航行器的北向速度，东向速度和纵向速度在动态变化的情况下可以快速达成一致，并保持和变化编队队形。
在图10和图11的仿真结果中可以大体看出，AUV1，AUV2，AUV3，AUV4组成的水下航行器系统，在通信拓扑动态变化的情况下，多AUV系统形成稳定编队后，纵倾角速度和艏向角速度保持稳定，在编队队形变化时也可保持稳定。
本发明提出了一种带有速度阻尼器的一致性编队队形控制算法，利用Lyapunov-Krasovskii函数，以及积分不等式和矩阵不等式数学方法证明，得出了使多AUV编队系统可以实现一致的充分条件，并验证了在实际环境中可能出现的有向通信拓扑发生变化和编队队形发生变化下本发明控制方法的有效性和稳定性。
本发明的上述算例仅为详细地说明本发明的计算模型和计算流程，而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说，在上述说明的基础上还可以做出其它不同形式的变化或变动，这里无法对所有的实施方式予以穷举，凡是属于本发明的技术方案所引伸出的显而易见的变化或变动仍处于本发明的保护范围之列。

Claims (4)

1.一种有向切换拓扑下多AUV编队队形一致性控制方法，其特征在于，所述方法具体包括以下步骤：
步骤一、定义用于描述多AUV之间通信拓扑关系的有向图；
所述步骤一的具体过程为：
将每个AUV作为有向图的一个顶点，有向图记为G＝(V,ε,C)，其中，V代表全部顶点的集合，V＝{v1,v2,…,vn}，n为编队内AUV的个数，(vi,vj)∈ε，ε代表顶点之间边的集合，(vi,vj)表示由顶点vi和vj构成的有向边，顶点vj接收顶点vi的信息，vi称为边的父顶点，vj称为边的子顶点，C为邻接矩阵；
邻接矩阵C满足：
Figure FDF0000018984550000011
对于
Figure FDF0000018984550000012
若i＝j，则cij＝0，若i≠j且集合ε中存在有向边(vi,vj)，则cij＝1，否则cij＝0；
步骤二、基于反馈线性化方法，将AUV的运动学方程和动力学方程线性化为二阶积分形式的反馈线性化动态模型；
步骤三、利用有向图表示的AUV之间通信拓扑关系和二阶积分形式的反馈线性化动态模型，设计有向切换拓扑下多AUV编队队形一致性控制器；
所述有向切换拓扑下多AUV编队队形一致性控制器的形式为：
Figure FDF0000018984550000013
其中：u(t)为控制器，vd(t)是t时刻的阻尼速度，即航行器形成编队后的行驶速度，k0，k1，k2是控制增益，Ni为父顶点vi的子顶点的集合，τ是AUV之间的通信延迟，xj(t-τ)表示第j个AUV在t-τ时刻的位置，vj(t-τ)表示第j个AUV在t-τ时刻的速度，
Figure FDF0000018984550000014
表示第i个AUV相对于第j个AUV的期望位置，
Figure FDF0000018984550000015
表示第j个AUV相对于第i个AUV的期望位置，aij表示位置耦合项的邻接矩阵，bij表示速度耦合项的邻接矩阵；
位置耦合项的邻接矩阵aij和速度耦合项的邻接矩阵bij均根据邻接矩阵C的定义方式获得；
步骤四、基于步骤三中的控制器，得到每个AUV的闭环控制形式；
所述步骤四的具体过程为：
Figure FDF0000018984550000021
2.根据权利要求1所述的一种有向切换拓扑下多AUV编队队形一致性控制方法，其特征在于，所述AUV的运动学方程为：
Figure FDF0000018984550000022
式中，
Figure FDF0000018984550000023
为η的一阶导数，
Figure FDF0000018984550000028
表示位置状态和欧拉角状态，ξ0为AUV的北向坐标，η0为AUV的东向坐标，ζ0为AUV的纵向坐标，θ为AUV的纵倾角，ψ为AUV的艏向角，
Figure FDF0000018984550000024
代表实数域，
Figure FDF0000018984550000025
表示速度的状态，u0为AUV的北向速度，v0为AUV的东向速度，w0为AUV的纵向速度，q为AUV的纵倾角速度，r为AUV的艏向角速度，J(η)为AUV从运动坐标系到固定坐标系下的雅可比矩阵。
3.根据权利要求2所述的一种有向切换拓扑下多AUV编队队形一致性控制方法，其特征在于，所述AUV的动力学方程为：
Figure FDF0000018984550000026
式中，
Figure FDF0000018984550000027
为υ的一阶导数，非奇异矩阵M＝MR+MA，MR为惯性矩阵，MA为附加惯性矩阵，τ0表示控制输入力和力矩，C(υ)＝Cr(v)+CA(v)，Cr(v)表示刚体哥氏力和向心力矩阵，CA(v)是由于流体的附加质量所产生的力矩，D(υ)为总的水动力阻尼，g(η)为重力和浮力所产生的恢复力和力矩。
4.根据权利要求3所述的一种有向切换拓扑下多AUV编队队形一致性控制方法，其特征在于，所述二阶积分形式的反馈线性化动态模型为：
Figure FDF0000018984550000031
其中，xi(t)和vi(t)分别表示第i个AUV在t时刻的位置和速度，
Figure FDF0000018984550000032
Figure FDF0000018984550000033
为vi(t)的一阶导数，
Figure FDF0000018984550000034
是第i个AUV在t时刻的控制输入，i＝1,2,…n，
Figure FDF0000018984550000035
为xi(t)的一阶导数。
CN202110780170.6A 2021-07-09 2021-07-09 有向切换拓扑下多auv编队队形一致性控制方法 Active CN113433955B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110780170.6A CN113433955B (zh) 2021-07-09 2021-07-09 有向切换拓扑下多auv编队队形一致性控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110780170.6A CN113433955B (zh) 2021-07-09 2021-07-09 有向切换拓扑下多auv编队队形一致性控制方法

Publications (2)

Publication Number Publication Date
CN113433955A CN113433955A (zh) 2021-09-24
CN113433955B true CN113433955B (zh) 2023-01-17

Family

ID=77759832

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110780170.6A Active CN113433955B (zh) 2021-07-09 2021-07-09 有向切换拓扑下多auv编队队形一致性控制方法

Country Status (1)

Country Link
CN (1) CN113433955B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114779825B (zh) * 2022-06-20 2022-08-26 北京大学 基于稀疏采样和信息交互的无人集群编队机动控制方法
CN114942646B (zh) * 2022-07-27 2022-10-25 山东省科学院海洋仪器仪表研究所 异构无人系统三维空间编队控制方法
CN115268476B (zh) * 2022-08-23 2024-02-06 海南大学 一种分布式的水面舰艇和水下航行器协同控制系统和方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10983532B1 (en) * 2017-08-03 2021-04-20 University Of South Florida Distributed control of heterogeneous multi-agent systems
CN108646758B (zh) * 2018-03-20 2019-11-01 南京邮电大学 一种多移动机器人预设性能编队控制器结构及设计方法
CN108594846A (zh) * 2018-03-23 2018-09-28 哈尔滨工程大学 一种障碍环境下多auv编队队形优化控制方法
CN109582036B (zh) * 2018-12-03 2021-04-27 南京航空航天大学 四旋翼无人机一致性编队控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
不同时变延迟下的多AUV编队协调控制;唐会林等;《计算机测量与控制》;20170825(第08期);全文 *

Also Published As

Publication number Publication date
CN113433955A (zh) 2021-09-24

Similar Documents

Publication Publication Date Title
CN113433955B (zh) 有向切换拓扑下多auv编队队形一致性控制方法
Zhang et al. Distributed control of coordinated path tracking for networked nonholonomic mobile vehicles
Ihle et al. Passivity-based designs for synchronized path-following
Nodland et al. Neural network-based optimal adaptive output feedback control of a helicopter UAV
Aguiar et al. Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty
CN110196599B (zh) 一种避碰与连接保持约束下的无人艇分布式编队控制方法
Cichella et al. Cooperative path following of multiple multirotors over time-varying networks
Xiang et al. Synchronized path following control of multiple homogenous underactuated AUVs
Karimi et al. Optimal maneuver-based motion planning over terrain and threats using a dynamic hybrid PSO algorithm
Wang et al. Path planning under constraints and path following control of autonomous underwater vehicle with dynamical uncertainties and wave disturbances
Yan et al. Consensus formation tracking for multiple AUV systems using distributed bioinspired sliding mode control
CN110262494B (zh) 一种同构多无人艇系统的协同学习与编队控制方法
CN112363517B (zh) 一种水下滑翔机的编队控制方法
CN112965371B (zh) 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法
CN110658821A (zh) 一种多机器人抗干扰分组时变编队控制方法及系统
Patel et al. An intelligent hybrid artificial neural network-based approach for control of aerial robots
Rendón et al. Path following control tuning for an autonomous unmanned quadrotor using particle swarm optimization
CN112947572A (zh) 一种基于地形跟随的四旋翼飞行器自适应运动规划方法
CN115639830A (zh) 一种空地智能体协同编队控制系统及其编队控制方法
Enjiao et al. Finite-time control of formation system for multiple flight vehicles subject to actuator saturation
Sandino et al. On the applicability of linear control techniques for autonomous landing of helicopters on the deck of a ship
Peymani et al. Leader-follower formation of marine craft using constraint forces and lagrange multipliers
Xiang et al. Coordinated path following control of multiple nonholonomic vehicles
Børhaug et al. Cross-track formation control of underactuated autonomous underwater vehicles
Aguiar Single and multiple motion control of autonomous robotic vehicles

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant