CN113433955B - 有向切换拓扑下多auv编队队形一致性控制方法 - Google Patents
有向切换拓扑下多auv编队队形一致性控制方法 Download PDFInfo
- 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
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 94
- 238000000034 method Methods 0.000 title claims abstract description 41
- 238000005755 formation reaction Methods 0.000 claims abstract description 93
- 239000011159 matrix material Substances 0.000 claims description 44
- 238000004891 communication Methods 0.000 claims description 27
- 230000008569 process Effects 0.000 claims description 9
- 238000010168 coupling process Methods 0.000 claims description 5
- 238000005859 coupling reaction Methods 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 3
- 239000012530 fluid Substances 0.000 claims description 2
- 238000004422 calculation algorithm Methods 0.000 abstract description 11
- 230000008859 change Effects 0.000 abstract description 9
- 238000006243 chemical reaction Methods 0.000 abstract description 2
- 239000003795 chemical substances by application Substances 0.000 description 9
- 238000004088 simulation Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 230000009466 transformation Effects 0.000 description 7
- 238000005070 sampling Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000013178 mathematical model Methods 0.000 description 2
- KFOPKOFKGJJEBW-ZSSYTAEJSA-N methyl 2-[(1s,7r,8s,9s,10r,13r,14s,17r)-1,7-dihydroxy-10,13-dimethyl-3-oxo-1,2,6,7,8,9,11,12,14,15,16,17-dodecahydrocyclopenta[a]phenanthren-17-yl]acetate Chemical compound C([C@H]1O)C2=CC(=O)C[C@H](O)[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H](CC(=O)OC)[C@@]1(C)CC2 KFOPKOFKGJJEBW-ZSSYTAEJSA-N 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 241000251737 Raja Species 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012067 mathematical method Methods 0.000 description 1
- 239000000178 monomer Substances 0.000 description 1
- 150000007524 organic acids Chemical class 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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(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纵向位置,ψ为艏向角,θ为纵倾角,为横倾角,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为邻接矩阵;
有向图的入度矩阵D=diag(deg(v1),deg(v2),…,deg(vn)),如果矩阵L满足L=D-C,那么称矩阵L为有向图G=(V,ε,A)的Laplacian矩阵(拉普拉斯矩阵)。
其它步骤及参数与具体实施方式一相同。
具体实施方式三、本实施方式与具体实施方式一或二之一不同的是:所述AUV的运动学方程为:
式中,为η的一阶导数,表示位置状态和欧拉角状态,ξ0为AUV的北向坐标,η0为AUV的东向坐标,ζ0为AUV的纵向坐标,θ为AUV的纵倾角,ψ为AUV的艏向角,代表实数域,表示速度的状态,u0为AUV的北向速度,v0为AUV的东向速度,w0为AUV的纵向速度,q为AUV的纵倾角速度,r为AUV的艏向角速度,J(η)为AUV从运动坐标系到固定坐标系下的雅可比矩阵。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四、本实施方式与具体实施方式一至三之一不同的是:所述AUV的动力学方程为:
式中,为υ的一阶导数,非奇异矩阵M=MR+MA,MR为惯性矩阵,MA为附加惯性矩阵,τ0表示控制输入力和力矩,C(υ)=Cr(v)+CA(v),Cr(v)表示刚体哥氏力和向心力矩阵,CA(v)是由于流体的附加质量所产生的力矩,D(υ)为总的水动力阻尼,g(η)为重力和浮力所产生的恢复力和力矩。
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五、本实施方式与具体实施方式一至四之一不同的是:所述二阶积分形式的反馈线性化动态模型为:
其它步骤及参数与具体实施方式一至四之一相同。
将AUV的运动学方程和动力学方程线性化为二阶积分形式的反馈线性化动态模型时采用的是现有方法,其具体过程如下:
由于横摇对平动的影响不大,本发明忽略横摇速度。从而得到了运动学和动力学的非线性耦合方程:
其中,M=MR+MA包括了惯性矩阵和附加惯性矩阵,并且M一定是非奇异矩阵。τ表示控制输入力和力矩。将模型中C(υ)υ,D(υ)υ,g(η)三项合并成一个列向量W(η,υ)υ表示惯性质量及附加惯性质量之外的部分。
为方便反馈线性化过程,将上式写成下面的形式,
将航行器的位姿状态信息和速度状态信息构成向量ξ=[ηT,υT]T。
将式(25)表示成
其中:
为了简化表示取Σ1和Σ2,
那么,定义一个输出函数ζ=h(ξ)后,与式(26)一起,将AUV***动力学模型表示为一般非线性***。
为了更清楚地理解反馈线性化过程,现将反馈线性化中需要的数学基础进行简要介绍。
【向量场】:考虑单输入—单输出***
【MIMO相对阶】给出如下的多输入多输出***:
其中:为AUV编队的状态向量,为AUV编队的输出向量,为AUV编队的控制输入向量,f(xi),g(xi)为n维向量场,且g(x)=[g1(x),…,gm(x)],h(x)=[h1(x),…,hm(x)]T。
若上述MIMO***存在相对阶,则须满足下述条件:
那么,针对非线性耦合的潜航器数学模型,精确反馈线性化的方法思想是:寻找一个反馈控制率u以及坐标变换。对于式(31)的一般非线性表示的潜航器数学模型,可取
h(x)=[h1(x),h2(x),h3(x),h4(x),h5(x)]T=[x,y,z,θ,ψ]T (41)
其中f(x)的表示形式如下:
根据Lie导数的定义,可得式(31)的一般非线性***形式AUV模型的Lie导数,
由h(x)的定义可以得到偏微分方程如下:
根据gi(x)可知,它的前五行元素都为0,所以对于任意1≤i≤5,1≤j≤5,
Lgihj(x)=0 (46)
求得h(x)沿f(x)求取李导数有如下结果:
同理,根据二阶Lie导数的定义(36)可导出,
其中,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和***阶数相同。
取坐标变换:
由Lie导数的定义可知,
在新的坐标变换下,控制输入u可以表示为
可得
由此可得该坐标***下的线性二阶积分模型,即在坐标变换(50)以及反馈输入(55)下可得
上面的精确反馈线性化过程是针对潜航器单体。由于本发明研究的潜航器编队是建立在同构的基础上,所以编队中全部潜航器具有相同的水动力方程及运动学方程。所以编队中其他成员可以进行相同的反馈线性化。那么针对编队第i个潜航器个体,可以有
具体实施方式六、本实施方式与具体实施方式一至五之一不同的是:所述有向切换拓扑下多AUV编队队形一致性控制器的形式为:
其中:u(t)为控制器,vd(t)是t时刻的阻尼速度,即航行器形成编队后的行驶速度,k0,k1,k2是控制增益,Ni为父顶点vi的子顶点的集合,τ是AUV之间的通信延迟,xj(t-τ)表示第j个AUV在t-τ时刻的位置,vj(t-τ)表示第j个AUV在t-τ时刻的速度,表示第i个AUV相对于第j个AUV的期望位置,表示第j个AUV相对于第i个AUV的期望位置,aij表示位置耦合项的邻接矩阵,bij表示速度耦合项的邻接矩阵。
本实施方式设计一种分布式多航行器***,只需知道局部航行器之间的相对位置和速度信息,就可以实现全局的协调一致。控制律由速度阻尼项,航行器位置耦合项和速度耦合项组成,当vd(t)=0时,水下航行器形成静态编队;当vd(t)≠0时,整个编队以速度vd(t)前进。为了实现稳定的编队,水下航行器达到相同的速度,为了使其保持一定的队形,要求与相邻的水下航行器保持预先设定的位置。
位置耦合项的邻接矩阵aij和速度耦合项的邻接矩阵bij均根据邻接矩阵C的定义方式获得。
其它步骤及参数与具体实施方式一至五之一相同。
具体实施方式七、本实施方式与具体实施方式一至六之一不同的是:所述步骤四的具体过程为:
本实施方式表明,水下航行器能否形成期望队形、收敛至期望速度,不仅与多AUV之间通信拓扑相关,还取决于反馈增益系数和时延大小。
定义:对于多AUV***的任意初始状态,给定闭环控制形式在一个有限时间的区间内t0∈[0,+∞),使得
当t>t0时,有xj(t)-hj=xi(t)-hi,vj(t)=vi(t),i,j=1,2,…n,则称多AUV***可以在有限时间里达成一致。
其它步骤及参数与具体实施方式一至六之一相同。
1、控制算法稳定性分析
1.1模型简化
对一个时延***进行稳定性分析,需要采用泛函微分方程,本发明通过构造合适的Lyapunov-Krasovskii函数沿着其求导,再通过适当放缩,得出使得含时延***实现一致性的充分条件。
证明:
上式经过线性变换表示为下式,
令,
将上式简写为:
1.2稳定性分析
定义Lyapunov-Krasovskii函数为:
对V(t)沿着***求导得:
将***方程代入上式得
±2xTy≤xT∑-1x+yT∑y (17)
所以:
式(18)可以写成:
令
令Λ1=(E+F)TP+P(E+F)+τETRE+Q,并由引理1可得:
1).S是正定的;
2).当且仅当C和A-BC-1BT都是正定的或者A和C-BTA-1B均是正定的。
2、仿真结果
在本发明中,给出了数值仿真例子来验证编队队形控制算法的有效性,本发明考虑4个AUV组成的多AUV***,其有向通信拓扑结构如图2a,图2b,图2c,图2d所示。
多AUV编队所示通信拓扑结构的邻接矩阵C可表示为:
下面对水下航行器编队过程进行仿真分析,一致性控制算法中参数设置为k0=0.4,k1=0.1,k2=0.2,水下航行器的期望速度设为vd=0.2,常数时延τ=0.1s,编队队形矩阵h设置为
将一致性控制算法中位置和速度的通信拓扑在图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为邻接矩阵;
步骤二、基于反馈线性化方法,将AUV的运动学方程和动力学方程线性化为二阶积分形式的反馈线性化动态模型;
步骤三、利用有向图表示的AUV之间通信拓扑关系和二阶积分形式的反馈线性化动态模型,设计有向切换拓扑下多AUV编队队形一致性控制器;
所述有向切换拓扑下多AUV编队队形一致性控制器的形式为:
其中:u(t)为控制器,vd(t)是t时刻的阻尼速度,即航行器形成编队后的行驶速度,k0,k1,k2是控制增益,Ni为父顶点vi的子顶点的集合,τ是AUV之间的通信延迟,xj(t-τ)表示第j个AUV在t-τ时刻的位置,vj(t-τ)表示第j个AUV在t-τ时刻的速度,表示第i个AUV相对于第j个AUV的期望位置,表示第j个AUV相对于第i个AUV的期望位置,aij表示位置耦合项的邻接矩阵,bij表示速度耦合项的邻接矩阵;
位置耦合项的邻接矩阵aij和速度耦合项的邻接矩阵bij均根据邻接矩阵C的定义方式获得;
步骤四、基于步骤三中的控制器,得到每个AUV的闭环控制形式;
所述步骤四的具体过程为:
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 (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114852376B (zh) * | 2022-04-01 | 2024-05-21 | 南京航空航天大学 | 一种基于解析预测的航天器变轨控制方法 |
CN114779645B (zh) * | 2022-04-29 | 2024-04-26 | 北京航空航天大学 | 一种有向固定通信拓扑下胸鳍拍动式机器鱼编队控制方法 |
CN114779825B (zh) * | 2022-06-20 | 2022-08-26 | 北京大学 | 基于稀疏采样和信息交互的无人集群编队机动控制方法 |
CN114942646B (zh) * | 2022-07-27 | 2022-10-25 | 山东省科学院海洋仪器仪表研究所 | 异构无人***三维空间编队控制方法 |
CN115268476B (zh) * | 2022-08-23 | 2024-02-06 | 海南大学 | 一种分布式的水面舰艇和水下航行器协同控制***和方法 |
CN116125881B (zh) * | 2023-01-05 | 2024-04-26 | 北京航空航天大学 | 一种有向切换拓扑胸鳍拍动式机器鱼编队切换控制方法 |
CN116627053B (zh) * | 2023-05-29 | 2024-05-03 | 武汉船舶通信研究所(中国船舶集团有限公司第七二二研究所) | 一种无人平台集群通信网络的半实物仿真*** |
Family Cites Families (4)
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 | 南京航空航天大学 | 四旋翼无人机一致性编队控制方法 |
-
2021
- 2021-07-09 CN CN202110780170.6A patent/CN113433955B/zh active Active
Non-Patent Citations (1)
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编队队形一致性控制方法 | |
Yan et al. | Consensus formation tracking for multiple AUV systems using distributed bioinspired sliding mode control | |
Almeida et al. | Cooperative control of multiple surface vessels in the presence of ocean currents and parametric model uncertainty | |
Zhang et al. | Distributed control of coordinated path tracking for networked nonholonomic mobile vehicles | |
Wang et al. | Path planning under constraints and path following control of autonomous underwater vehicle with dynamical uncertainties and wave disturbances | |
Ihle et al. | Passivity-based designs for synchronized path-following | |
Aguiar et al. | Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty | |
Cichella et al. | Cooperative path following of multiple multirotors over time-varying networks | |
Karimi et al. | Optimal maneuver-based motion planning over terrain and threats using a dynamic hybrid PSO algorithm | |
Xiang et al. | Synchronized path following control of multiple homogenous underactuated AUVs | |
CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制***及工作方法 | |
CN110262494B (zh) | 一种同构多无人艇***的协同学习与编队控制方法 | |
CN112363517B (zh) | 一种水下滑翔机的编队控制方法 | |
CN106707749B (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
CN110658821A (zh) | 一种多机器人抗干扰分组时变编队控制方法及*** | |
CN114779645B (zh) | 一种有向固定通信拓扑下胸鳍拍动式机器鱼编队控制方法 | |
Patel et al. | An intelligent hybrid artificial neural network-based approach for control of aerial robots | |
CN112965371A (zh) | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 | |
CN112947572A (zh) | 一种基于地形跟随的四旋翼飞行器自适应运动规划方法 | |
CN115639830A (zh) | 一种空地智能体协同编队控制***及其编队控制方法 | |
Enjiao et al. | Finite-time control of formation system for multiple flight vehicles subject to actuator saturation | |
CN117389312B (zh) | 一种基于模型的水下航行器抗横滚三维跟踪控制方法 | |
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 | |
Ghommam et al. | Distance‐Based Formation Control for Quadrotors with Collision Avoidance via Lyapunov Barrier Functions |
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 |