CN115617039B - 一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法 - Google Patents

一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法 Download PDF

Info

Publication number
CN115617039B
CN115617039B CN202211121621.6A CN202211121621A CN115617039B CN 115617039 B CN115617039 B CN 115617039B CN 202211121621 A CN202211121621 A CN 202211121621A CN 115617039 B CN115617039 B CN 115617039B
Authority
CN
China
Prior art keywords
formation
unmanned ship
unmanned
representing
affine
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
CN202211121621.6A
Other languages
English (en)
Other versions
CN115617039A (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 CN202211121621.6A priority Critical patent/CN115617039B/zh
Publication of CN115617039A publication Critical patent/CN115617039A/zh
Application granted granted Critical
Publication of CN115617039B publication Critical patent/CN115617039B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

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)

Abstract

一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法,涉及一种分布式控制与仿射编队方法相结合的编队控制器,以及一种动态事件触发机制,属于无人艇控制技术领域,本发明为解决无人艇编队任务中存在的队形固定以及缺乏灵活性的问题,本发明提供的技术方案为:根据待编队的无人艇编队模型定义编队队形和应力矩阵;根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器;根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器;并设计了无人艇编队控制方法,本发明适合应用于无人艇编队控制技术领域。

Description

一种基于事件触发的分布式仿射无人艇编队控制器构建方法 和无人艇编队控制方法
技术领域
本发明涉及一种分布式控制与仿射编队方法相结合的编队控制器,以及一种动态事件触发机制,属与无人艇控制技术领域。
背景技术
随着科学技术的飞速发展,研究者们受到自然界中鸟类成群迁徙、鱼类成群游弋等各种动物群体活动的启发,开始将集群策略应用到多自主体系统中。多水面无人艇(MSVs)编队相较于单艇有分布式、自适应和鲁棒性等多种优点,在军事领域显得更为重要。MSVs编队控制的目标是由2艘或2艘以上的无人艇以期望的相对距离和角度在指定海域内完成军事战略任务或运输任务。近年来,MSVs的编队控制成为了海洋工程和控制领域研究的热点,同时也取得了大量的研究成果,例如:领航与跟随法、虚拟结构法、基于行为法、基于图论法、人工势场法等。其中,领航与跟随法由于在计算资源有限、通信距离短和通信带宽窄等约束条件下仍能较好完成编队任务而备受关注。需要指出的是,依据上述方法所设计的编队控制器均能使无人艇编队很好地保持期望的几何队形,但编队的几何队形往往是固定的,因此MSVs 控制系统在遇到障碍物时可能存在失效的情况;另外,编队需要提前设计,这限制了编队的灵活性。
在编队控制算法的实际应用中,可用的通信资源受到气候、环境和质量条件的限制,导致通信速率受限,而在传统的MSVs编队系统中采用连续或时间触发的通信策略,存在大量的冗余数据,浪费了大量的通信资源。为减轻系统负担,通过事件触发机制,即只有系统所设计的事件发生时才会对系统进行采样和控制,这已成为解决网络控制系统(NCS)通信量大及网络资源和能源浪费等问题的重要方法之一。同时也要避免事件触发机制下的Zeno行为,否则相应的控制行为无法进行,甚至导致系统不稳定。
因此从理论和实践的角度出发,为无人艇编队设计一个新的事件触发分布式编队跟踪控制算法以完成复杂多样的任务仍是个亟待解决的问题。
发明内容
本发明为解决无人艇编队任务中存在的队形固定以及缺乏灵活性的问题,提出一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法,具体技术方案如下:
所述控制器构建方法为:
步骤1:根据待编队的无人艇编队模型定义编队队形和应力矩阵;
步骤2:根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器;
步骤3:根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器;
步骤4:设计基于事件触发的编队控制器。
进一步地,一个优选实施例为,步骤1所述待编队的无人艇编队队形和应力矩阵定义为:
所述待编队的无人艇共有N艘,所述N艘无人艇组成的编队在水平面移动,引入两个坐标系描述无人艇的运动,将每艘无人艇的非线性运动学和动力学模型简化为:
Figure SMS_1
Figure SMS_2
f2(ui,vi,ri,t)=((m11-m22)uivi-d33ri)/m33
Figure SMS_3
式中f1(ui,vi,ri,t)和f2(ui,vi,ri,t)是无人艇模型的非线性耦合函数,
Figure SMS_4
是非奇异系数矩阵,qi=[uicosψi-visinψi,uisinψi+vicosψi]T是随体坐标系下的第i艘无人艇速度向量,pi=[xi,yi]T是固定坐标系OXY下的第i艘无人艇位置向量,其中ui第i艘无人艇前向速度,vi表示第i艘无人艇横向速度,ψi表示第i艘无人艇艏向角,ri表示第i艘无人艇艏向角速度,m11,m22和m33表示无人艇的惯性和附加质量,d11,d22和d33表示水动力阻尼系数,τui表示无人艇纵向控制力,τvi表示无人艇横向控制力,τri表示无人艇控制力矩,简便起见,令τi=[τui,τvi],/>
Figure SMS_5
在一个有向通信拓扑图
Figure SMS_8
中包含一个节点集/>
Figure SMS_12
和一个边集
Figure SMS_15
图中存在一条有向边(j,i)∈ε,节点j被称为尾,节点i称为头,定义
Figure SMS_9
为节点i的尾集合;定义一个非负邻接矩阵/>
Figure SMS_11
其中aij>0,(i,j)∈ε,否则aij=0,/>
Figure SMS_14
表示n×n 阶实矩阵;定义/>
Figure SMS_18
为拉普拉斯矩阵,其中当i≠j时lij=-aij,当i=j时/>
Figure SMS_6
设共有N 艘无人艇,选择前/>
Figure SMS_13
艘无人艇为领航者,剩余
Figure SMS_16
艘无人艇为跟随者;/>
Figure SMS_19
表示领航者集合,/>
Figure SMS_7
表示跟随者集合;
Figure SMS_10
表示领航者队形,/>
Figure SMS_17
表示跟随者队形,整个编队的队形定义为/>
Figure SMS_20
Id定义为d×d单位矩阵,则艏向角跟踪一致的条件表示为:
Figure SMS_21
/>
领导者能够跟踪期望的轨迹,能够得出
Figure SMS_22
和/>
Figure SMS_23
为简便起见,定义/>
Figure SMS_24
Figure SMS_25
其中
Figure SMS_26
Figure SMS_27
Figure SMS_28
表示m×n阶实矩阵;
标称队形的仿射映射表示为:
Figure SMS_29
式中,IN是表示N×N单位矩阵,1N是表示N×1单位向量,
Figure SMS_30
表示恒定构型,b表示无人艇平移的向量,A表示无人艇旋转、缩放和剪切的向量,通过合理设计矩阵A 和b来实现无人艇的平移、旋转、缩放、剪切等几何变换动作;/>
Figure SMS_31
表示m×n阶实矩阵;
基于领导-跟随法的无人艇编队位置集合的仿射张成表示为:
Figure SMS_32
设N艘无人艇的标称队形
Figure SMS_33
满足/>
Figure SMS_34
能在空间/>
Figure SMS_35
内仿射张成;给定的Nl个领航者的标称队形/>
Figure SMS_36
满足/>
Figure SMS_37
能够在空间/>
Figure SMS_38
内仿射张成;
由N个智能体构成的有向图
Figure SMS_39
的根集合包含d+1个领航者,且集合(d+1)包含每个跟随者,对于编队/>
Figure SMS_40
其各边(i,j)∈ε相对应的应力{ωij}(i,j)∈ε是一组标量,当i与j之间为吸引力时ωij>0,当i与j之间为排斥力时ωij<0,其余情况下ωij=0,应力与队形的关系描述为:
Figure SMS_41
为了让表达式更加紧凑,将{ωij}(i,j)∈ε写成如下的应力矩阵:
Figure SMS_42
将上式重写为:
Figure SMS_43
/>
定义
Figure SMS_44
为由N艘无人艇组成的编队,其中/>
Figure SMS_45
Figure SMS_46
表示领导者,/>
Figure SMS_47
表示跟随者,得到:
Figure SMS_48
其中,
Figure SMS_49
表示领航者的应力矩阵,/>
Figure SMS_50
表示领航者的应力矩阵,
Figure SMS_51
表示领航-跟随者之间的应力矩阵,/>
Figure SMS_52
表示跟随者-领航之间的应力矩阵,且/>
Figure SMS_53
和/>
Figure SMS_54
进一步地,一个优选实施例为,引入两个坐标系为两个相关坐标系,即固定坐标系OXY 和随体坐标系ObXbYb
进一步地,一个优选实施例为,步骤2所述根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器的方法,如下所示:
由编队队形的定义,得出:
Figure SMS_55
定义相对方向误差z1i和其余两个误差变量z2i,z3i
Figure SMS_56
Figure SMS_57
Figure SMS_58
式中,αψi表示虚拟控制律,
Figure SMS_59
表示滤波后的虚拟控制律,一阶滤波器设计如下:
Figure SMS_60
式中,γ1是滤波参数,定义·(t)为·当前时刻状态值;
Figure SMS_61
为·事件触发时刻状态值;/>
Figure SMS_62
对z1i求导得到:
Figure SMS_63
虚拟控制律设计如下:
Figure SMS_64
对z2i,z3i求导,再结合无人艇数学模型,得到:
Figure SMS_65
Figure SMS_66
根据上式,为每艘无人艇设计控制律如下:
Figure SMS_67
进一步地,一个优选实施例为,步骤3所述的根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器的方法,如下所示:
根据应力矩阵的性质,得到:
Figure SMS_68
定义相对位置误差z4i和两个误差变量z5i,z6i
Figure SMS_69
Figure SMS_70
Figure SMS_71
式中,αpi表示虚拟控制律,
Figure SMS_72
表示滤波后的虚拟控制律,一阶滤波器设计如下:
Figure SMS_73
式中,γ2是滤波参数,定义
Figure SMS_74
对z4i求导,再结合无人艇数学模型和z5i,z6i得到:
Figure SMS_75
虚拟控制律设计如下:
Figure SMS_76
对z5i和z6i求导,再结合无人艇数学模型,得到:
Figure SMS_77
Figure SMS_78
根据上式,设计控制律如下:
Figure SMS_79
进一步地,一个优选实施例为,步骤4所述设计基于事件触发的编队控制器的过程,如下所示:
定义第一次触发时间为
Figure SMS_80
则触发时间序列/>
Figure SMS_81
为:
Figure SMS_82
Figure SMS_83
/>
式中δi,i=1,2,3,4是事件触发机制的阈值,表示为
Figure SMS_84
其中βi>1,0≤ηi≤1,βi0≥0,i=1,2,3,4均为阈值参数,/>
Figure SMS_85
表示正整数,/>
Figure SMS_86
表示无人艇编队的方向单位向量一致性跟踪的触发条件,/>
Figure SMS_87
表示仿射编队位置跟踪的触发条件。
一种基于事件触发的分布式仿射无人艇编队控制方法,所述方法采用权利要求1-6任意一项所述的无人艇编队控制器构建方法获得的无人艇编队控制器实现,待编队的每艘无人艇上设置有一个无人艇编队控制器,所述无人艇编队控制方法为:所述无人艇编队控制器采集触发条件,并根据触发条件产生无人艇编队的相对状态测量信号,所述无人艇编队的相对状态测量信号通过通信网络发送至其相邻的无人艇编队控制器,同时更新控制信号,然后将所述控制信号发送到所在无人艇的执行器,控制无人艇动作完成编队。
与现有技术相比,本发明的有益效果是:
本发明提出了一种新的分布式事件触发仿射编队控制算法,通过设计仿射张量和应力矩阵,在有向通信图下实现无人艇编队机动控制,包括平移、旋转、缩放等几何动作以及这些变换的组合,在各种复杂的环境中执行任务有着不可替代的优势,包括穿越狭窄海域、避开障碍物等,提高了无人艇编队的机动灵活性。
本发明能够满足水面无人艇在穿越航道弯曲、收缩以及存在障碍物限制的复杂水域航行的队形变换需求,探索简单高效、可行性强的时变队形构建方法。使无人艇编队在编队系统通信受限约束下具有实时高效队形变换能力的自适应分布式编队机动能力。
针对无人艇集群分布式时变协同控制问题,本发明设计了新颖的事件触发仿射编队控制架构。为每艘无人艇设计分布式事件触发控制律,实现一组无人艇编队所需的几何队形,然后在保持所需编队的同时进行仿射变换,保证无人艇编队系统性能和稳定性。
现有的仿射编队大多基于应力约束实现,导致其仅能实现对位置的控制。本发明设计了一种基于应力矩阵和拉普拉斯矩阵的复合约束,以保证所提控制方法能够实现位置和艏向的耦合控制。
本发明降低无人艇集群编队控制器复杂度,使得艇间事件触发传输机制和随体坐标系约束能够在所提框架下被考虑。
本发明与现有的时间采样传输相比,本发明采用一种阈值动态调整的事件触发机制,是一种采样和更新采样间隔的控制策略,即当触发条件被满足时才进行数据更新和传输,可降低编队系统的通信频率和执行器的更新频率,实现了减少通信资源消耗的目的,提高了系统的稳定性和有效性,同时保持良好的闭环控制性能,很好地解决无人艇编队通信和计算资源有限问题。
附图说明
图1是7艘在固定坐标系OXY下的无人艇的标称编队图;
图2是在固定坐标系OXY下水平面中无人艇仿射编队的时变轨迹图;
图3是3艘跟随无人艇的相对位置和艏向角的误差折线图:(a)艏向角;(b)x轴;(c)y轴;
图4是3艘跟随无人艇的控制输入随时间的变化点状图:(a)用于纵荡的螺旋桨;(b) 用于艏摇的螺旋桨;
图5是采样次数和事件触发间隔的累积:(a)跟随无人艇1的事件触发间隔点状图;(b) 跟随无人艇2的事件触发间隔点状图;(c)跟随无人艇3的事件触发间隔点状图;(d)基于时间的方案和基于事件的通信数方案对比柱状图。
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述。
实施方式一:一种基于事件触发的分布式仿射无人艇编队控制器构建方法,所述控制器构建步骤为:
步骤1:根据待编队的无人艇编队模型定义编队队形和应力矩阵;
步骤2:根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器;
步骤3:根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器;
步骤4:设计基于事件触发的编队控制器。
实施方式二:本实施方式是对实施方式一所述的分布式仿射无人艇编队控制器构建方法中,步骤1的进一步说明,本实施方式中,所述待编队的无人艇编队队形和应力矩阵定义为:
本实施方式中,将无人艇集群之间的底层信息交互由有向图通信拓扑图
Figure SMS_89
表示,/>
Figure SMS_95
为节点集,/>
Figure SMS_97
为边集,有向图中(i,j)≠(j,i),设不存在/>
Figure SMS_91
在欧几里得空间/>
Figure SMS_94
内定义N艘无人艇的领航-跟随者类型编队,假设d≥2且N≥d+2,前/>
Figure SMS_101
艘无人艇为领航者,剩下的/>
Figure SMS_102
艘无人艇为跟随者,/>
Figure SMS_88
为领航者点集,
Figure SMS_92
表示跟随者点集;定义/>
Figure SMS_99
为由N艘无人艇组成的编队,
Figure SMS_100
表示为领航者,/>
Figure SMS_90
表示为跟随者,编队队形为
Figure SMS_93
Figure SMS_96
表示为领航者的队形,/>
Figure SMS_98
表示为跟随者的队形。
假设1由N个智能体构成的有向图
Figure SMS_103
的根集合包含d+1个领航者,且集合(d+1)包括每个跟随者;
标称队形的仿射映射表示为:
Figure SMS_104
式中,IN是表示N×N单位矩阵,1N是表示N×1单位向量,pi是固定坐标系OXY下的第i 艘无人艇位置向量,
Figure SMS_105
表示恒定构型,b表示无人艇平移的向量,A表示无人艇旋转、缩放和剪切的向量,通过合理设计矩阵A和b来实现无人艇的平移、旋转、缩放、剪切等几何变换动作;/>
Figure SMS_106
表示m×n阶实矩阵;/>
基于领导-跟随法的无人艇编队位置集合的仿射张成表示为:
Figure SMS_107
假设2设N艘无人艇的标称队形r满足
Figure SMS_108
能在空间/>
Figure SMS_109
内仿射张成;
假设3给定的Nl个领航者的标称队形
Figure SMS_110
满足/>
Figure SMS_111
能够在空间/>
Figure SMS_112
内仿射张成;
结合假设1、2,得到实现仿射定位的充要条件。
对于编队
Figure SMS_113
其各边(i,j)∈ε相对应的应力{ωij}(i,j)∈ε是一组标量。当i与j之间为吸引力时ωij>0,当i与j之间为排斥力时ωij<0,其余情况下ωij=0。应力与队形的关系描述为:
Figure SMS_114
为了让表达式更加紧凑,将{ωij}(i,j)∈ε写成如下的应力矩阵:
Figure SMS_115
将上式重写为:
Figure SMS_116
实施方式三:本实施方式是对实施方式一所述的分布式仿射无人艇编队控制器构建方法中步骤2的进一步限定,本实施方式中,步骤2所述根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器的方法,如下所示:
由编队队形的定义,得出:
Figure SMS_117
艏向角的跟踪误差定义为:
Figure SMS_118
将上述式子写为矩阵形式,即
Figure SMS_119
和/>
Figure SMS_120
得到:
Figure SMS_121
定义相对方向误差z1i和其余两个误差变量z2i,z3i
Figure SMS_122
Figure SMS_123
Figure SMS_124
式中,αψi表示要设计的虚拟控制律,
Figure SMS_125
表示滤波后的虚拟控制律,一阶滤波器设计如下:
Figure SMS_126
式中,γ1是滤波参数,定义·(t)为·当前时刻状态值;
Figure SMS_127
为·事件触发时刻状态值;
为了避免反步法带来的“复杂性爆炸”的问题,引入DSC方法,一阶滤波器的输入是虚拟控制律,输出是滤波后的虚拟控制律,则误差写为
Figure SMS_128
得出:
Figure SMS_129
Figure SMS_130
结合艏向角的跟踪误差,得到:
Figure SMS_131
Figure SMS_132
若能证明z1f稳定,则eψ也稳定。对z1i求导得到:
Figure SMS_133
控制器将使用最新接收到的信号来计算控制信号,根据上式,我们将虚拟控制律设计为:
Figure SMS_134
将虚拟控制律设计和ε2i(t)代入
Figure SMS_135
得出:
Figure SMS_136
对z2i,z3i求导,再结合无人艇数学模型,得出:
Figure SMS_137
Figure SMS_138
根据上式,推导每艘无人艇设计控制律如下:
Figure SMS_139
选取候选Lyapunov函数:
Figure SMS_140
对V1求导,得出:
Figure SMS_141
对于
Figure SMS_142
恒存在矩阵Q1和Q2,使得/>
Figure SMS_143
上式写为:/>
Figure SMS_144
若满足λmin(Q1 TQ1/2ω1)>-k1,k2>1/2,
Figure SMS_145
上式写为:
Figure SMS_146
其中:
Figure SMS_147
Figure SMS_148
由此得出,在水平面航行的一组无人艇编队的方向单位向量跟踪的一致性控制是一致最终有界稳定的。
实施方式四:本实施方式是对实施方式一所述的一种基于事件触发的分布式仿射无人艇编队控制器的构建方法的进一步限定,本实施方式中,步骤3所述的根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器的方法,具体设计方案如下所示:
根据应力矩阵的性质,得到:
Figure SMS_149
位置的跟踪误差表示为:
Figure SMS_150
将上述式子写为矩阵形式,即
Figure SMS_151
和/>
Figure SMS_152
即:
Figure SMS_153
定义相对位置误差z4i和两个误差变量z5i,z6i
Figure SMS_154
Figure SMS_155
Figure SMS_156
其中αpi表示要设计的虚拟控制律,
Figure SMS_157
表示滤波后的虚拟控制律,一阶滤波器设计如下:
Figure SMS_158
/>
其中γ2为对角矩阵,令,
Figure SMS_159
则误差写为/>
Figure SMS_160
根据z4i,得出:
Figure SMS_161
结合应力矩阵的性质和上式,以及
Figure SMS_162
得出:
Figure SMS_163
能证明z4f稳定,则ep也稳定。对z4i求导,再结合无人艇数学模型和z5i,z6i得出:
Figure SMS_164
根据上式,设计虚拟控制律如下:
Figure SMS_165
将上式代入
Figure SMS_166
得出:
Figure SMS_167
对z5i和z6i求导,再结合无人艇数学模型,得出:
Figure SMS_168
Figure SMS_169
根据上式,设计控制律如下:
Figure SMS_170
选取候选Lyapunov函数:
Figure SMS_171
对V2求导得出:
Figure SMS_172
对于
Figure SMS_173
恒存在矩阵Q3和Q4,使得/>
Figure SMS_174
上式写为:
Figure SMS_175
/>
若满足λmin(Q3 TQ3/2ω2)>-k3,k4>1/2,
Figure SMS_176
上式写为:
Figure SMS_177
其中:
ρ2=2min((k3min(Q3 TQ3/2ω2)),(k4-1/2),(γ2 -1-1/2-λmin2Q4 TQ4)))
Figure SMS_178
由此得出,在水平面上航行的一组无人艇仿射编队的位置跟踪的一致性控制是一致最终有界的。
实施方式五:本实施方式是对实施方式一所述的一种基于事件触发的分布式仿射无人艇编队控制器的构建方法的进一步限定,本实施方式中,步骤4所述设计基于事件触发的编队控制器的过程如下所示:
定义第一次触发时间为
Figure SMS_179
则触发时间序列/>
Figure SMS_180
为:
Figure SMS_181
Figure SMS_182
式中δi,i=1,2,3,4是事件触发机制的阈值,表示为
Figure SMS_183
其中βi>1,0≤ηi≤1,βi0≥0,i=1,2,3,4均为阈值参数,/>
Figure SMS_184
表示正整数,/>
Figure SMS_185
和/>
Figure SMS_186
分别是MSVs编队的方向单位向量一致性跟踪和仿射编队位置跟踪的触发条件。
实施方式六:证明实施方式五中事件触发机制不存在Zeno现象,如下所示:
在所有的触发时间间隔内,对应执行器的输入信号和编队的相对状态测量信号均保持
Figure SMS_187
和/>
Figure SMS_188
不变。此外,事件触发机制的阈值为/>
Figure SMS_189
是严格单调递减函数。下一个采样时间将发生在/>
Figure SMS_190
将触发间隔的下限定义为/>
Figure SMS_191
由以下公式获得:
Figure SMS_192
式中
Figure SMS_193
以下不等式成立:
Figure SMS_194
/>
同理,对于其他三种触发机制,同样的方法计算出最小触发时间间隔如下:
Figure SMS_195
综上,无论A1是否为零,均满足
Figure SMS_196
通过上述分析,我们能够准确地确定在任意时间/>
Figure SMS_197
编队内的无人艇均有一个最小触发间隔/>
Figure SMS_198
上述实施方式提出了一种新的分布式事件触发仿射编队控制算法,通过设计仿射张量和应力矩阵,在有向通信图下实现无人艇编队机动控制,包括平移、旋转、缩放以及这些变换的组合。值得注意的是,在所提出的控制算法下,不仅提高了编队的机动灵活性,而且大大减少了通信资源。能够满足水面无人艇在穿越航道弯曲、收缩以及存在障碍物限制的复杂水域航行的队形变换需求,探索简单高效、可行性强的时变队形构建方法。在编队系统通信受限约束下具有实时高效队形变换能力的自适应分布式编队机动能力。
实施方式七:一种基于事件触发的分布式仿射无人艇编队控制方法,所述方法采用实施方式一至六任意一项所述的无人艇编队控制器构建方法获得的无人艇编队控制器实现,待编队的每艘无人艇上设置有一个无人艇编队控制器,所述无人艇编队控制方法为:所述无人艇编队控制器采集触发条件,并根据触发条件产生无人艇编队的相对状态测量信号,所述无人艇编队的相对状态测量信号通过通信网络发送至其相邻的无人艇编队控制器,同时更新控制信号,然后将所述控制信号发送到所在无人艇的执行器,控制无人艇动作完成编队。
实施方式八:本实施方式用数值模拟结果来说明上述提出的一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法的可行性和有效性。在整个仿真过程中,无人艇的模型参数如表1所示,在数值仿真中考虑一组7艘无人艇,其中4艘领导无人艇和3辆跟随无人艇,同时,选择无人艇编队的初始条件如表2所示,所建立的控制器的相关参数如表3所示。
Figure SMS_199
表1主要型号参数
Figure SMS_200
表2编队的初始状态
Figure SMS_201
表3控制律和自适应律的设计参数
7艘无人艇的标称编队如图1所示,相对于的拉普拉斯矩阵
Figure SMS_202
和有向图/>
Figure SMS_203
的应力矩阵如下所示:
Figure SMS_204
/>
Figure SMS_205
仿真结果如图2-5所示:
图2为水平面中无人艇仿射编队的时变轨迹图,由图可知,本发明所述的构建方法构建的无人艇编队控制器具有良好的跟踪性能和仿射变换能力。
图3为3艘跟随无人艇的相对位置和艏向角的误差图,由图可知,在上述事件触发控制律的作用下,编队跟踪控制在100秒左右达到稳态阶段,稳态下,无人艇姿态角跟踪误差可控制在0.15以内,相对位置跟踪误差可控制在0.02以内,这种控制精度可以满足一般编队跟踪控制任务的要求。
图4为3艘跟随无人艇的控制输入随时间的变化图,由图可知,事件触发控制命令具有明显的离散化特征,即系统的采样和控制只有在预定义事件为真时才会发生。
图5为采样时间、事件触发间隔和通信次数的累积图,由图可知,在事件触发的通信策略下,为每艘跟随无人艇节省了85%以上的通信资源,有效降低通信频率,减少整个编队控制过程中无人艇之间以及控制器和执行器之间的通信总量,同时保持良好的闭环控制性能。

Claims (3)

1.一种基于事件触发的分布式仿射无人艇编队控制器构建方法,其特征在于,所述控制器构建方法为:
步骤1:根据待编队的无人艇编队模型定义编队队形和应力矩阵;
步骤2:根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器;
步骤3:根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器;
步骤4:设计基于事件触发的编队控制器;
步骤1所述待编队的无人艇编队队形和应力矩阵定义为:
所述待编队的无人艇共有N艘,所述N艘无人艇组成的编队在水平面移动,引入两个坐标系描述无人艇的运动,将每艘无人艇的非线性运动学和动力学模型简化为:
Figure FDA0004178684850000011
Figure FDA0004178684850000012
f2(ui,vi,ri,t)=((m11-m22)uivi-d33ri)/m33
Figure FDA0004178684850000013
式中f1(ui,vi,ri,t)和f2(ui,vi,ri,t)是无人艇模型的非线性耦合函数,
Figure FDA0004178684850000018
是非奇异系数矩阵,qi=[uicosψi-visinψi,uisinψi+vicosψi]T是随体坐标系下的第i艘无人艇速度向量,pi=[xi,yi]T是固定坐标系OXY下的第i艘无人艇位置向量,其中ui第i艘无人艇前向速度,vi表示第i艘无人艇横向速度,ψi表示第i艘无人艇艏向角,ri表示第i艘无人艇艏向角速度,m11,m22和m33表示无人艇的惯性和附加质量,d11,d22和d33表示水动力阻尼系数,τui表示无人艇纵向控制力,τvi表示无人艇横向控制力,τri表示无人艇控制力矩,简便起见,令τi=[τuivi],/>
Figure FDA0004178684850000014
在一个有向通信拓扑图
Figure FDA0004178684850000015
中包含一个节点集/>
Figure FDA0004178684850000016
和一个边集/>
Figure FDA0004178684850000017
图中存在一条有向边(j,i)∈ε,节点j被称为尾,节点i称为头,定义/>
Figure FDA0004178684850000021
为节点i的尾集合;定义一个非负邻接矩阵/>
Figure FDA0004178684850000022
其中aij>0,(i,j)∈ε,否则aij=0,/>
Figure FDA0004178684850000023
表示n×n阶实矩阵;定义/>
Figure FDA0004178684850000024
为拉普拉斯矩阵,其中当i≠j时lij=-aij,当i=j时/>
Figure FDA0004178684850000025
设共有N艘无人艇,选择前Nl艘无人艇为领航者,剩余Nf=N-Nl艘无人艇为跟随者;/>
Figure FDA0004178684850000026
表示领航者集合,/>
Figure FDA0004178684850000027
表示跟随者集合;/>
Figure FDA0004178684850000028
表示领航者队形,/>
Figure FDA0004178684850000029
表示跟随者队形,整个编队的队形定义为/>
Figure FDA00041786848500000210
Id定义为d×d单位矩阵,则艏向角跟踪一致的条件表示为:
Figure FDA00041786848500000211
领导者能够跟踪期望的轨迹,能够得出
Figure FDA00041786848500000212
和/>
Figure FDA00041786848500000213
为简便起见,定义
Figure FDA00041786848500000214
Figure FDA00041786848500000215
其中
Figure FDA00041786848500000216
Figure FDA00041786848500000217
Figure FDA00041786848500000218
表示m×n阶实矩阵;
标称队形的仿射映射表示为:
Figure FDA00041786848500000219
式中,IN是表示N×N单位矩阵,1N是表示N×1单位向量,
Figure FDA00041786848500000220
表示恒定构型,b表示无人艇平移的向量,A表示无人艇旋转、缩放和剪切的向量,通过合理设计矩阵A和b来实现无人艇的平移、旋转、缩放、剪切等几何变换动作;/>
Figure FDA00041786848500000221
表示m×n阶实矩阵;
基于领导-跟随法的无人艇编队位置集合的仿射张成表示为:
Figure FDA00041786848500000222
设N艘无人艇的标称队形r满足
Figure FDA0004178684850000031
能在空间/>
Figure FDA0004178684850000032
内仿射张成;给定的Nl个领航者的标称队形rl满足/>
Figure FDA0004178684850000033
能够在空间/>
Figure FDA0004178684850000034
内仿射张成;
由N个智能体构成的有向图
Figure FDA0004178684850000035
的根集合包含d+1个领航者,且集合(d+1)包含每个跟随者,对于编队/>
Figure FDA0004178684850000036
其各边(i,j)∈ε相对应的应力{ωij}(i,j)∈ε是一组标量,当i与j之间为吸引力时ωij>0,当i与j之间为排斥力时ωij<0,其余情况下ωij=0,应力与队形的关系描述为:
Figure FDA0004178684850000037
为了让表达式更加紧凑,将{ωij}(i,j)∈ε写成如下的应力矩阵:
Figure FDA0004178684850000038
将上式重写为:
Figure FDA0004178684850000039
定义
Figure FDA00041786848500000310
为由N艘无人艇组成的编队,其中/>
Figure FDA00041786848500000311
Figure FDA00041786848500000312
和/>
Figure FDA00041786848500000313
分别表示领导者和跟随者,得到:
Figure FDA00041786848500000314
其中,
Figure FDA00041786848500000315
表示领航者的应力矩阵,/>
Figure FDA00041786848500000316
表示领航者的应力矩阵,
Figure FDA00041786848500000317
表示领航-跟随者之间的应力矩阵,/>
Figure FDA00041786848500000318
表示跟随者-领航之间的应力矩阵,且/>
Figure FDA00041786848500000319
和/>
Figure FDA00041786848500000320
步骤2所述根据定义的编队队形,设计无人艇编队的分布式仿射变换艏向跟踪控制器的方法如下所示:
由编队队形的定义,得出:
Figure FDA00041786848500000321
定义相对方向误差z1i和其余两个误差变量z2i,z3i
Figure FDA0004178684850000041
Figure FDA0004178684850000042
Figure FDA0004178684850000043
式中,αψi表示虚拟控制律,
Figure FDA0004178684850000044
表示滤波后的虚拟控制律,一阶滤波器设计如下:
Figure FDA0004178684850000045
式中,γ1是滤波参数,定义·(t)为·当前时刻状态值;
Figure FDA0004178684850000046
为·事件触发时刻状态值;
Figure FDA0004178684850000047
对z1i求导得到:
Figure FDA0004178684850000048
虚拟控制律设计如下:
Figure FDA0004178684850000049
对z2i,z3i求导,再结合无人艇数学模型,得到:
Figure FDA00041786848500000410
Figure FDA00041786848500000411
根据上式,为每艘无人艇设计控制律如下:
Figure FDA00041786848500000412
/>
步骤3所述的根据应力矩阵的性质,设计无人艇编队的分布式仿射变换位置跟踪控制器的方法如下所示:
根据应力矩阵的性质,得到:
Figure FDA00041786848500000413
定义相对位置误差z4i和两个误差变量z5i,z6i
Figure FDA00041786848500000414
Figure FDA00041786848500000415
Figure FDA00041786848500000416
式中,αpi表示虚拟控制律,
Figure FDA0004178684850000051
表示滤波后的虚拟控制律,一阶滤波器设计如下:
Figure FDA0004178684850000052
式中,γ2是滤波参数,定义
Figure FDA0004178684850000053
对z4i求导,再结合无人艇数学模型和z5i,z6i得到:
Figure FDA0004178684850000054
虚拟控制律设计如下:
Figure FDA0004178684850000055
对z5i和z6i求导,再结合无人艇数学模型,得到:
Figure FDA0004178684850000056
Figure FDA0004178684850000057
根据上式,设计控制律如下:
Figure FDA0004178684850000058
步骤4所述设计基于事件触发的编队控制器的过程如下所示:
定义第一次触发时间为
Figure FDA0004178684850000059
则触发时间序列/>
Figure FDA00041786848500000510
为:
Figure FDA00041786848500000511
Figure FDA00041786848500000512
式中δi,i=1,2,3,4是事件触发机制的阈值,表示为
Figure FDA00041786848500000513
其中βi>1,0≤ηi≤1,βi0≥0,i=1,2,3,4均为阈值参数,/>
Figure FDA00041786848500000514
表示正整数,/>
Figure FDA00041786848500000515
和/>
Figure FDA00041786848500000516
分别是MSVs编队的方向单位向量一致性跟踪和仿射编队位置跟踪的触发条件。
2.根据权利要求1所述的一种基于事件触发的分布式仿射无人艇编队控制器构建方法,其特征在于,引入两个坐标系为两个相关坐标系,即固定坐标系OXY和随体坐标系ObXbYb
3.一种基于事件触发的分布式仿射无人艇编队控制方法,其特征在于,所述方法采用权利要求1-2任意一项所述的无人艇编队控制器构建方法获得的无人艇编队控制器实现,待编队的每艘无人艇上设置有一个无人艇编队控制器,所述无人艇编队控制方法为:所述无人艇编队控制器采集触发条件,并根据触发条件产生无人艇编队的相对状态测量信号,所述无人艇编队的相对状态测量信号通过通信网络发送至其相邻的无人艇编队控制器,同时更新控制信号,然后将所述控制信号发送到所在无人艇的执行器,控制无人艇动作完成编队。
CN202211121621.6A 2022-09-15 2022-09-15 一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法 Active CN115617039B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211121621.6A CN115617039B (zh) 2022-09-15 2022-09-15 一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211121621.6A CN115617039B (zh) 2022-09-15 2022-09-15 一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法

Publications (2)

Publication Number Publication Date
CN115617039A CN115617039A (zh) 2023-01-17
CN115617039B true CN115617039B (zh) 2023-06-13

Family

ID=84859363

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211121621.6A Active CN115617039B (zh) 2022-09-15 2022-09-15 一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法

Country Status (1)

Country Link
CN (1) CN115617039B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115993844B (zh) * 2023-03-23 2023-05-30 西北工业大学深圳研究院 一种群体智能系统自适应事件触发时变分组编队控制方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016132295A1 (en) * 2015-02-19 2016-08-25 Francesco Ricci Guidance system and automatic control for vehicles
CN107074377A (zh) * 2016-12-29 2017-08-18 深圳市大疆创新科技有限公司 一种控制方法、装置、设备及无人机
CN107203221A (zh) * 2017-06-01 2017-09-26 合肥工业大学 无人机和有人机混合编队内的在线信息分发方法和装置
CN109379125A (zh) * 2018-09-30 2019-02-22 北京航空航天大学 一种多智能体编队控制方法及系统
CN111339826A (zh) * 2020-05-06 2020-06-26 山西大学 一种滑坡无人机线性传感器网络框架检测系统
CN112771843A (zh) * 2020-06-15 2021-05-07 深圳市大疆创新科技有限公司 信息处理方法、装置和成像系统
CN113759979A (zh) * 2021-09-23 2021-12-07 天津大学 基于事件驱动的无人机吊挂系统在线轨迹规划方法
CN113885548A (zh) * 2021-10-28 2022-01-04 南京邮电大学 一种多四旋翼无人机输出约束状态一致博弈控制器
WO2022000945A1 (zh) * 2020-07-01 2022-01-06 武汉理工大学 DoS攻击下基于切换T-S模糊系统的无人船艇控制方法
CN114594760A (zh) * 2021-12-14 2022-06-07 南京信息工程大学 一种基于动态事件触发的多无人船航向一致性控制方法
CN114756029A (zh) * 2022-04-19 2022-07-15 哈尔滨工程大学 基于动态事件触发的无人艇无模型控制方法
CN114879657A (zh) * 2022-03-29 2022-08-09 哈尔滨工程大学 一种基于随体坐标系的无模型全分布式无人艇协同时变队形控制方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020154948A1 (zh) * 2019-01-30 2020-08-06 深圳市大疆创新科技有限公司 一种负载的控制方法及装置

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016132295A1 (en) * 2015-02-19 2016-08-25 Francesco Ricci Guidance system and automatic control for vehicles
CN107074377A (zh) * 2016-12-29 2017-08-18 深圳市大疆创新科技有限公司 一种控制方法、装置、设备及无人机
CN107203221A (zh) * 2017-06-01 2017-09-26 合肥工业大学 无人机和有人机混合编队内的在线信息分发方法和装置
CN109379125A (zh) * 2018-09-30 2019-02-22 北京航空航天大学 一种多智能体编队控制方法及系统
CN111339826A (zh) * 2020-05-06 2020-06-26 山西大学 一种滑坡无人机线性传感器网络框架检测系统
CN112771843A (zh) * 2020-06-15 2021-05-07 深圳市大疆创新科技有限公司 信息处理方法、装置和成像系统
WO2022000945A1 (zh) * 2020-07-01 2022-01-06 武汉理工大学 DoS攻击下基于切换T-S模糊系统的无人船艇控制方法
CN113759979A (zh) * 2021-09-23 2021-12-07 天津大学 基于事件驱动的无人机吊挂系统在线轨迹规划方法
CN113885548A (zh) * 2021-10-28 2022-01-04 南京邮电大学 一种多四旋翼无人机输出约束状态一致博弈控制器
CN114594760A (zh) * 2021-12-14 2022-06-07 南京信息工程大学 一种基于动态事件触发的多无人船航向一致性控制方法
CN114879657A (zh) * 2022-03-29 2022-08-09 哈尔滨工程大学 一种基于随体坐标系的无模型全分布式无人艇协同时变队形控制方法
CN114756029A (zh) * 2022-04-19 2022-07-15 哈尔滨工程大学 基于动态事件触发的无人艇无模型控制方法

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
Composite Learning Event-triggered Control for Target Tracking of Underactuated Autonomous Underwater Vehicle;Jian Xu, Yunfei Cui, Fei Huang, Zheping Yan, Xue Du;《Proceedings of the 41st Chinese Control Conference 》;第2755-2760页 *
Event-Triggered Composite Learning Finite-Time Trajectory Tracking Control for Underactuated MSVs Subject to Uncertainties;BAOFENG PAN etal;《IEEE Access》;第14440-14449页 *
Yong Hao;Shuo Song;Bing Huang;Jun Li.Distributed Edge-event Triggered Formation Control for Multiple Unmanned Surface Vessels with Connectivity Preservation.《2022 IEEE 17th International Conference on Control &amp Automation (ICCA)》.2022,第359-364页. *
一种基于在线仿真的多无人机任务调度方法研究;赵宏伟等;《2009年中国高校通信类院系学术研讨会论文集》;第54-59页 *
基于事件驱动的多智能体系统的环形编队控制;王航飞等;《Proceedings of the 33rd Chinese Control Conference》;第1321-1326页 *
基于事件驱动的连续时间动态系统脉冲最优控制研究;白全钰等;《Proceedings of the 40rd Chinese Control Conference》;第8756-8760页 *

Also Published As

Publication number Publication date
CN115617039A (zh) 2023-01-17

Similar Documents

Publication Publication Date Title
Li et al. Adaptive NN event-triggered control for path following of underactuated vessels with finite-time convergence
CN110658829B (zh) 一种基于深度强化学习的群无人艇智能避碰方法
Ihle et al. Formation control of marine surface craft: A Lagrangian approach
CN108445892A (zh) 一种欠驱动无人船编队控制器结构及设计方法
Yan et al. Consensus formation tracking for multiple AUV systems using distributed bioinspired sliding mode control
CN110989639B (zh) 一种基于应力矩阵的水下航行器编队控制方法
CN110262494B (zh) 一种同构多无人艇系统的协同学习与编队控制方法
CN110347181B (zh) 基于能耗的无人机分布式编队控制方法
CN109799818B (zh) 多参数化路径导引的无人船协同操纵控制器的设计方法
CN110703795A (zh) 一种基于切换拓扑的无人机群协同安全控制方法
Zhang et al. Receding horizon control for multi-UAVs close formation control based on differential evolution
CN115617039B (zh) 一种基于事件触发的分布式仿射无人艇编队控制器构建方法和无人艇编队控制方法
CN114779645B (zh) 一种有向固定通信拓扑下胸鳍拍动式机器鱼编队控制方法
CN113296507A (zh) 一种基于时空解耦的多动力定位船舶协同编队控制方法
Gao et al. Online optimal control for dynamic positioning of vessels via time-based adaptive dynamic programming
CN114879671A (zh) 一种基于强化学习mpc的无人艇轨迹跟踪控制方法
CN114779647A (zh) 无人艇集群的围堵控制方法
CN115016277A (zh) 一种考虑船间事件触发通信的多船分布式容错控制方法
You et al. Adaptive neural sliding mode control for heterogeneous ship formation keeping considering uncertain dynamics and disturbances
Zhang et al. Hybrid threshold event-triggered control for sail-assisted USV via the nonlinear modified LVS guidance
CN112099506A (zh) 一种欠驱动无人船时变编队的跟踪控制方法和系统
CN116974278A (zh) 基于改进los的滑模无人船路径跟踪控制系统及方法
CN115903820A (zh) 多无人艇追逃博弈控制方法
Amendola et al. Batch reinforcement learning of feasible trajectories in a ship maneuvering simulator
CN114578819A (zh) 一种基于人工势场法的多水面船分布式编队的控制方法

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