CN112859915B - 基于饱和阈值事件触发的高层消防无人机编队控制方法及*** - Google Patents
基于饱和阈值事件触发的高层消防无人机编队控制方法及*** Download PDFInfo
- Publication number
- CN112859915B CN112859915B CN202110054885.3A CN202110054885A CN112859915B CN 112859915 B CN112859915 B CN 112859915B CN 202110054885 A CN202110054885 A CN 202110054885A CN 112859915 B CN112859915 B CN 112859915B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- control
- controller
- trigger
- 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 40
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000011217 control strategy Methods 0.000 claims abstract description 15
- 238000013528 artificial neural network Methods 0.000 claims description 30
- 238000004891 communication Methods 0.000 claims description 27
- 238000013461 design Methods 0.000 claims description 25
- 238000013178 mathematical model Methods 0.000 claims description 14
- 230000007704 transition Effects 0.000 claims description 13
- 230000003044 adaptive effect Effects 0.000 claims description 11
- 230000001960 triggered effect Effects 0.000 claims description 10
- 230000009471 action Effects 0.000 claims description 8
- 238000013459 approach Methods 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 8
- 230000007246 mechanism Effects 0.000 claims description 7
- 230000006399 behavior Effects 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 description 13
- 230000000875 corresponding effect Effects 0.000 description 12
- 238000005516 engineering process Methods 0.000 description 10
- 230000001360 synchronised effect Effects 0.000 description 10
- 230000006870 function Effects 0.000 description 9
- 230000000694 effects Effects 0.000 description 6
- 238000004088 simulation Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 238000012546 transfer Methods 0.000 description 4
- 238000005299 abrasion Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 238000005265 energy consumption Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000004134 energy conservation Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
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
技术领域
本公开属于无人机编队控制技术领域,尤其涉及基于饱和阈值事件触发的高层消防无人机编队控制方法及***。
背景技术
本部分的陈述仅仅是提供了与本公开相关的背景技术信息,不必然构成在先技术。
随着城市建设规模不断扩大,如何在复杂多变的火场条件中进行高层建筑灭火及人员逃生越来越受到人们的关注。无人机由于行动迅速灵活并且成本低廉,借助无人机进行现场火情勘察及人员逃生引导成为了一个有效手段。但是高层建筑往往建筑结构复杂,救援任务繁重,单靠一架无人机无法完成实际的需要。与单架无人机相比,无人机集群具有的协同控制、能力互补等特点,极大的提高了任务的执行效率。因此,多无人机***的协同控制是当今无人机领域的研究热点。而多无人机编队控制是其中最受瞩目的研究方向。这其中姿态的一致控制对编队控制的实现具有举足轻重的地位。
第五代通信(5G)技术拥有高速率(峰值传输速率达到10Gbit/s)、低延时(端到端时延达到ms级)、节能、减少成本、更高的***容量(连接设备密度增加10~100倍,流量密度提升1000倍)和为大量设备提供联接,且能在速度为500km/h左右为用户提供稳定的用户体验。随着信息技术及5G技术的高速发展,信息物理***(CPS,Cyber-Physical Systems)也随之发展壮大。CPS是一个综合计算、网络和物理环境的多维复杂***,通过3C(Computation、Communication、Control)技术的有机融合与深度协作,实现大型工程***的实时感知、动态控制和信息服务。CPS实现计算、通信与物理***的一体化设计,可使***更加可靠、高效、实时协同,具有重要而广泛的应用前景。CPS的意义在于将物理设备联网,让物理设备具有计算、通信、精确控制、远程协调和自治等五大功能。CPS本质上是一个具有控制属性的网络,但它又有别于现有的控制***。CPS则把通信放在与计算和控制同等地位上,因为CPS强调的分布式应用***中物理设备之间的协调是离不开通信的。CPS对网络内部设备的远程协调能力、自治能力、控制对象的种类和数量,特别是网络规模上远远超过现有的工控网络。美国国家科学基金会认为,CPS将让整个世界互联起来。如同互联网改变了人与人的互动一样,CPS将会改变我们与物理世界的互动。
高层消防四旋翼无人机的高危的工作环境导致无人机的损耗甚至报废在所难免,因此,在能够完成消防相关任务的前提下,尽可能地削减单架无人机成本是合理的要求。第五代通信技术和CPS研究的高速发展为降低单架无人机的成本提供了可靠的技术支撑。
发明人在研究中发现,为了削减单架消防无人机的成本,可用于检测无人机***状态的传感器有限,同样,低成本也意味着无人机所携带的能源有限。传统上,控制任务以周期性的方式执行,即***控制采用时间触发控制策略,这种控制策略在控制单元的每一次刷新都会发送控制信号给无人机,无人机根据控制信号做出相应的动作。时间触发控制策略为了保障***的良好性能,***稳定时也需要维持长时间的快速采样,这样不仅会导致***的能耗过高,还会增加执行器的机械磨损,从而缩短***的使用寿命。
发明内容
为克服上述现有技术的不足,本公开提供了基于饱和阈值事件触发的高层消防无人机编队控制方法,采用只有符合触发条件时才执行控制任务的事件触发控制策略,保证***有良好控制性能的同时,而不会产生一个非常大的控制更新,对***造成冲击。
为实现上述目的,本公开的一个或多个实施例提供了如下技术方案:
第一方面,公开了基于饱和阈值事件触发的高层消防无人机编队控制方法,包括:
构建基于饱和阈值事件触发策略的控制器,该控制器被配置为:设定随控制器幅值变化的触发阈值,符合触发条件时执行控制任务的事件触发控制策略,事件触发控制策略将触发阈值与控制器的幅值相关联,以保证控制性能的同时不会产生对***造成冲击的控制更新。
进一步的技术方案,基于饱和阈值事件触发策略的控制器,使得每一僚机能以与领机的姿态保持同步,即每一架僚机的侧倾角能与领机的侧倾角保持一致;俯仰角能与领机的俯仰角保持一致;偏航角能与领机的偏航角保持一致。
进一步的技术方案,还包括:处在工作现场的消防无人机通过传感器采集***输出信息,发送到处于安全位置的控制中心,控制中心基于构建的基于饱和阈值事件触发策略的控制器计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程。
进一步的技术方案,构建基于饱和阈值事件触发策略的控制器之前还包括:
建立信息物理***框架下的四旋翼无人机姿态***数学模型;
基于上述模型描述无人机编队中各个无人机之间通信拓扑结构;
针对拓扑结构利用神经网络逼近***中的未知非线性项,然后基于逼近结果构建神经网络状态观测器;
进一步的技术方案,基于逼近得到的状态信息构建同步误差和误差面,并基于李雅普诺夫稳定性定义,引入了跟踪微分器逼近虚拟控制的导数设计虚拟控制器和自适应律。
进一步的技术方案,所述四旋翼无人机姿态***数学模型构建针对对象是:仅配备少量的***输出传感器,执行器和通信器件,没有装备控制单元的消防四旋翼无人机***。
进一步的技术方案,所述四旋翼无人机姿态***数学模型构建时:忽略飞行器复杂的空气动力学特性,简化无人机模型,假设各无人机高度固定,仅关注无人机编队的姿态行为,从而得到每个无人机姿态***的数学模型。
进一步的技术方案,描述无人机编队中各个无人机之间通信拓扑结构时,利用有向图描述编队中无人机之间的有向通信拓扑关系。
优选的,有向图G={V,E}中,V={1,2,...,N}表示图G中节点的集合,且″1,2,...,N″表示僚机的编号,表示图中有向边的集合,且(j,i)意味着僚机i能接收到来自节点j的信息,并称节点j是僚机i的一个邻居。
第二方面,公开了基于饱和阈值事件触发的高层消防无人机编队控制***,包括:传感器采集***、控制中心;
所述传感器采集***采集处在工作现场的消防无人机输出信息,发送到处于安全位置的控制中心,所述控制中心基于构建的基于饱和阈值事件触发策略的控制器计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程;
基于饱和阈值事件触发策略的控制器,该控制器被配置为:设定随控制器幅值变化的触发阈值,符合触发条件时执行控制任务的事件触发控制策略,事件触发控制策略将触发阈值与控制器的幅值相关联,以保证控制性能的同时不会产生对***造成冲击的控制更新。
以上一个或多个技术方案存在以下有益效果:
1.本公开技术方案在完成高层消防无人机编队任务的基础上,传感器采集信息通过网络发送给控制中心,控制信号通过网络传输回无人机,这里的网络可以是自己搭建的简易通信基站,可以是第5代(5G)通信技术,充分利用当下最新通信技术,削减单架无人机的成本,体现在不需要装备传感器检测无人机状态,只需传感器检测***输出。无人机中不需要搭载控制单元,由于设计了事件触发机制,无人机也不需要搭载过多的能源。
2.本公开技术方案不需要测得***状态,也不需要就无人机***精确建模。利用神经网络技术逼近无人机***中的未知部分,然后基于神经网络的逼近值构建状态观测器。
3.本公开技术方案提出了一种饱和阈值事件触发策略,当控制器幅值较大时,较大的阈值可以避免高频更新行为。另一方面,由于***处于稳态运行,且幅值保持较小,较小的阈值有利于实现更精确的控制。但是,当控制器的幅值过大时,会导致阈值过大。在这种情况下,一旦满足触发条件,控制信号会突然跳变,从而给***施加较大的冲击。这肯定会降低***性能。因此,本公开技术方案公开了一个饱和阈值策略来将触发阈值与控制器的幅值联系起来,保证***有良好控制性能的同时,而不会产生一个非常大的控制更新,对***造成冲击,正如饱和阈值事件触发机制所示,触发阈值与控制器的幅值τφi(t)有关。
本发明附加方面的优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
构成本公开的一部分的说明书附图用来提供对本公开的进一步理解,本公开的示意性实施例及其说明用于解释本公开,并不构成对本公开的不当限定。
图1为实际消防现场中无人机与控制中心的示意图;
图2为信息物理***框架下的控制框图;
图3为无人机群有向图;
图4为无人机群实际侧倾角与观测侧倾角的曲线图;
图5为无人机群实际俯仰角与观测俯仰角的曲线图;
图6为无人机群实际偏航角与观测偏航角的曲线图;
图7为无人机群实际侧倾角速度与观测侧倾角速度的曲线图;
图8为无人机群实际俯仰角速度与观测俯仰角速度的曲线图;
图9为无人机群实际偏航角速度与观测偏航角速度的曲线图;
图10~图21为僚机相应事件控制器的阈值曲线和误差的曲线。
具体实施方式
应该指出,以下详细说明都是示例性的,旨在对本公开提供进一步的说明。除非另有指明,本文使用的所有技术和科学术语具有与本公开所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本公开的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
在不冲突的情况下,本公开中的实施例及实施例中的特征可以相互组合。
本发明是基于CPS框架实现的。即,物理***(消防无人机)的传感器采集信息通过网络传输控制中心,控制中心根据设计的控制器计算出控制信号。这里的计算可以由自己的电脑计算出,也可以由云计算技术计算出。计算出的控制信号再通过网络传输回物理***(参考附图1~2)。本发明通过3C技术的有机融合与深度协作,实现对消防无人机群的实时感知和动态控制。本发明将物理设备(消防无人机)联网,让物理设备具有了较多功能。
实施例一
本实施例公开了基于饱和阈值事件触发的高层消防无人机编队控制方法,该方法首先利用神经网络逼近***中的未知非线性项,然后基于逼近结果构建神经网络状态观测器;基于逼近得到的状态信息构建同步误差和误差面,并基于李雅普诺夫稳定性定义设计合适的虚拟控制器和自适应律,在这个过程中,引入了跟踪微分器逼近虚拟控制的导数,减少基于反步法框架控制设计的计算量。最后设计一种饱和阈值事件触发策略,在保证控制效果的前提下,减少执行器所需接收的信息,进一步减少无人机的能耗和机械磨损,延长使用寿命。接下来将提供本发明的的简单实现方式,但不代表具体实现方式,也不限于该实现方式。
具体步骤包括:
S1:建立信息物理***框架下的四旋翼无人机姿态***数学模型;
S2:描述无人机编队中各个无人机之间通信拓扑结构;
S3:构建神经网络逼近***的未知***动态;
S4:针对第i(i=1,2,...N)个僚机,构建状态观测器;
S5:基于***状态的观测值,定义合适协同一致性误差以及合适的误差面;
S6:设计虚拟控制器及神经网络权值自适应律;
S7:设计一种基于饱和阈值事件触发策略的实际控制器。
在实际实施时,针对一群无人机,首先建立无人机的数学模型(S1),为了实现编队同步的目的,需要运用通信拓扑的知识描述这群无人机之间的通信关系(S2)。由于无人机数学模型中存在未知的***动态(fi1和fi2)和不可测状态。因此,为了能够顺利设计出有效的控制器,构建神经网络逼近未知的非线性***动态(S3),基于神经网络逼近的结果构建状态观测器观测不可测***状态(S4)。通过神经网络和状态观测器,获得了一个可用于控制器设计的***模型。
定义误差来反映一致的控制目标,即误差小到一定程度,就可以认为实现了一致的控制目标。但是由于***的状态不可测,需要运用状态的观测值来定义误差(S6)。由于直接设计控制器比较困难,本发明先设计虚拟控制器(S6),再通过虚拟控制器设计出实际的控制器(S7).应该注意到,***中的fi1和fi2是未知的,因此设计虚拟控制器时,关于这部分的知识,运用神经网络的逼近值来代替。为了实现良好的逼近效果和控制效果,运用自适应控制的方法来更新神经网络的权值,因此构建了神经网络权值自适应律(S6)。
具体实施例子中,步骤S1:建立信息物理***框架下的四旋翼无人机姿态***数学模型:
高层消防四旋翼无人机的高危的工作环境导致无人机的损耗甚至报废在所难免,因此,在能够完成消防相关任务的前提下,尽可能地削减单架无人机成本是合理的要求。第五代通信技术和信息物理***研究的高速发展为降低单架无人机的成本提供了可靠的技术支撑。因此,本发明针对仅配备少量的***输出传感器,执行器和通信器件,而没有装备控制单元的消防四旋翼无人机***,提出这样的控制框架,即处在工作现场的消防无人机通过传感器采集***输出信息,发送到处于安全位置的控制中心,控制中心基于控制方案计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程。为了简化问题的表述,关注高层消防四旋翼无人机的编队行为,假设每架无人机都配备了节气门、方向舵和高度自动驾驶仪。因此可以忽略飞行器复杂的空气动力学特性,简化无人机模型。假设各无人机高度固定,仅关注无人机编队的姿态行为,从而得到每个无人机姿态***的数学模型为
其中,φi,θi,ψi分别表示侧倾角,俯仰角和偏航角;ωxi,ωyi,ωzi为相对应的角速度;Ix,Iy,Iz为旋转惯性参数,τφi,τθi,τψi分别为侧倾力矩,俯仰力矩和偏航力矩。
令
Xi1=[φi,θi,ψi]T,Xi2=[ωxi,ωyi,ωzi]T,τi=[τφi,τθi,τψi]T,γi=diag{Ix,Iy,Iz},
则姿态***可重写为
yi=Ai0[Xi1 T,Xi2 T]T
其中,yi表示***的输出,
为了利用较少***知识,减少消防无人机编队控制的实现成本,本发明不需要无人机搭载传感器检测无人机状态,也不需要为无人机建立精确模型,但是依然需要传感器测得无人机***输出。即重写后的姿态***中,yi为可测得的输出,Xi1,Xi2为不可测***状态,γi为已知非零***参数,fi1,fi2为***未知非线性结构。
步骤S2:描述无人机编队中各个无人机之间通信拓扑结构:
利用有向图G={V,E}描述编队中无人机之间的有向通信拓扑关系;其中,V={1,2,...,N}表示图G中节点的集合,且″1,2,...,N″表示僚机的编号。表示图中有向边的集合,且(j,i)意味着僚机i能接收到来自节点j的信息,并称节点j是僚机i的一个邻居。进一步,定义节点i邻居的集合为Ni={j∈V|(i,j)∈E,i≠j}。定义A=[aij]∈Rn×n为有向图G的权重矩阵;若僚机i能够收到来自僚机j的信息,那么aij=1(i≠j),否则,aij=0;定义入度矩阵D为D=diag{d1,...dN},其中假设aii=0,有向图为严格连接;僚机i和领机的连接关系表示为对角矩阵C=diag{a10,...,aN0},若僚机i能够从领导者接收信息,则ai0=1,否则ai0=0。
所谓有向图,即信息的传递是有方向的,僚机i能传递信息给僚机j,僚机j不一定能传递给僚机i。之所以要考虑无人机之间的信息传递,是为了实现同步。只有直接或间接知道其他无人机的信息,才能够调整自身状态,与其他无人机保持一致。在本发明中,传感器采集信息传递给控制中心,在控制中心中,对应每个无人机又有对应的控制单元,这些控制单元之间的信息传递是有方向的。之所以考虑信息的传递是有方向的是因为,有时对某一僚机的轨迹精准度要求较高以实现避免碰撞等目的。因此,它可以直接接收领机的信息而不接收僚机的信息,避免其他僚机影响轨迹精确度。但是该僚机可以传递信息给其他僚机,以便其他僚机与它的轨迹一致,进而和领机的轨迹一致,即该僚机与其他僚机的信息传递是单向的。
值得指出的是,有向图适用范围更广,能够表示多种图,包括无向图和全连通图。所谓无向图即信息的传递是没有方向的,僚机i如果能传递给僚机j,僚机j也能够传递给僚机i。这种情况在有向图中只需aij=1,aji=1即可。所谓全连通图,即所有僚机之间的信息可以相互传递。僚机i能接收到其他所有僚机的信息,其他僚机也都能接收到僚机i的信息,只需相应的aij=1即可。
步骤S3:构建神经网络逼近***的未知***动态:
消防无人机的存在难以精确建模的问题,为了利用较少的模型知识完成编队控制,增广本发明的适用范围,本发明采用神经网络逼近消防无人机中***中的未知***动态。径向基神经网络可以在紧集上以任意精度/>逼近连续函数f(x)如下:
f(x)=θ*Tφ(x)+ε(x)
其中,x为神经网络输入,q为神经网络输入维度,逼近误差满足φ(x)=[φ1(x),φ2(x),…,φl(x)]是基函数向量,φi(x)通常选择为高斯函数其中l是神经网络的节点数,ζi=[ζi,1,…,ζiq]是基函数的接受域,/>是高斯函数的宽度。理想权重/>是定义为:对所有/>使逼近误差|ε(x)|最小的θ的值,即
步骤S4针对第i(i=1,2,...N)个僚机,构建状态观测器具体步骤如下:
构建状态观测器如下:
其中为***状态Xi1,Xi2的观测值,并且满足/> 为未知非线性项fi1,fi2的逼近值,其表达式为:
Li1=diag{li,1,1,li,1,2,li,1,3},Li2=diag{li,2,1,li,2,2,li,2,3},li,1,1,li,1,2,li,1,3,li,2,1,li,2,2,li,2,3为观测器增益,令Li=[li,1,1,li,1,2,li,1,3,li,2,1,li,2,2,li,2,3]T。
步骤S5:基于***状态的观测值,定义合适协同一致性误差以及合适的误差面,然后设计控制器减小这些误差以实现控制目的。比如:接下来定义的同步误差,同步误差反映该无人机与它邻居(它能接收到信息的无人机)之间的输出误差,当ei1趋于0的附近时,就可以认为该无人机的输出就与邻居的输出达到同步:
定义高层消防无人机编队中姿态行为的同步误差ei1为
其中,y0表示给定跟踪控制信号。
定义误差面为
其中,ξi表示跟踪微分器输出。利用跟踪微分器可以获得输入信号一阶导数的近似值,其表达式为
其中ri,为合适设计参数矩阵,αi1为接下来设计的虚拟控制器。设计控制器αi1的目的是使同步误差趋于0的附近。但是如重写后的姿态***所示,只有实际控制器τi,没有控制器αi1,所以称为虚拟控制器。
步骤S6:设计虚拟控制器及神经网络权值自适应律:
设计第一个虚拟控制器为
其中,mi1,ρi,βi1为合适维度的的设计参数方阵,为对角元素均大于0的对角矩阵,bi=di+ai0。为神经网络高斯函数,/>为自适应参数,其决定于如下的自适应律:
其中,Γi,1,Ξi1为自适应律增益矩阵,σi,0,σi,1为σ修正参数矩阵。
设计第二个虚拟控制器为
其中,mi2,βi2为合适维度的的设计参数方阵,为对角元素均大于0的对角矩阵。决定于如下自适应律
其中,Γi,2为自适应律增益矩阵,σi,2为σ修正参数矩阵。
步骤S7:设计一种基于饱和阈值事件触发策略的实际控制器:
令αi,2=[αi,2,1,αi,2,2,αi,2,3]T,ei,2=[ei,2,1,ei,2,2,ei,2,3]T
设计如下的过渡连续控制律
其中,∈i1,∈i2,∈i3,均为大于0的设计参数,/>
设计事件触发控制器如下
触发时刻由以下饱和阈值事件触发机制决定
其中,均为大于0的设计参数。
下面将介绍本发明的控制器设计方法,并解释说明定义同步误差和误差面,设计虚拟控制器和自适应律的原因。
简单来说,定义的误差反映的是控制效果,当误差ei1和ei2都趋于零的附近时,就认为实现了控制目的。设计虚拟控制器是控制这两个误差为趋于0的附近。因为较难直接设计出合适的实际控制器,因此先设计了虚拟控制器,再通过虚拟控制器设计出实际控制器。由于***中含有未知的***动态,我们运用神经网络来逼近它,设计自适应律的目的是使得神经网络有更好的逼近效果。
进一步讲,如***所示:
yi=Ai0[Xi1 T,Xi2 T]T=Xi1
注意到***中的fi1和fi2是未知的,因此用神经网络来逼近它们,为了拥有良好的逼近效果和控制效果,设计自适应律来在线更新神经网络的权重,即权重是一个变化的值。我们的目的是使得yi=Xi1≈y0(i=1,2,...,N),因此定义同步误差ei1。第一阶***中并没有控制器来控制Xi1,因此设计了一个能使ei1趋于零的附近的第一个虚拟控制器αi1,然后把Xi2当作一个控制器,当Xi2≈αi1,就能使得ei1趋于零的附近。定义应该注意到,/>ξi1是αi1经过跟踪微分器的输出,故ξi1≈αi1。当ei2趋于0的附近时,/>因此我们需设计第二个虚拟控制器αi2使得ei2趋于0的附近。由于设计的实际事件触发控制器是不光滑的,为了减小αi2与实际控制器τi之间的误差,设计了过渡连续控制律。
为了证实本实施例的有效性,下面进行仿真实验:
在本仿真实验中,控制目标是针对在固定高度的僚机编队群,设计基于饱和阈值的事件触发控制器,使得每一僚机能以与领机的姿态保持同步。即每一架僚机的侧倾角能与领机的侧倾角保持一致;俯仰角能与领机的俯仰角/>保持一致;偏航角能与领机的偏航角ψ0=0保持一致。
进一步的解释说明,当控制器使得误差ei1趋于0的附近便实现了同步。注意到在编队控制中aij和ai0不能全部为0,即它至少接收到一条信息,才能确定输出什么样的同步轨迹。基于同步误差下面分两种情况讨论:(1)ai0=1,则当ei1趋于0的附近时,yi≈y0,则可以认为该僚机与领机的姿态实现了一致。(2)ai0=0,但aij=1。虽然僚机i不能接收到领机的信息,但是僚机i与僚机j实现了同步,若僚机j和领机达到了同步,则僚机i也间接与领机达到了同步。因此,当ei1(i=1,2,3,4)趋于0的附近时,只要无人机群中有一个僚机与领机的姿态实现了同步,每一僚机均与领机的姿态实现了同步。在仿真中体现为,如图4~图6所示,僚机的输出轨迹(脚标编号为1,2,3,4)与领机的输出轨迹(脚标编号为0)基本重合,因此可认为实现了同步。
***参数Ix=0.0027,Iy=0.0027,Iz=0.0047,不失一般性,随机选择无人机
状态的初值和观测器的初值为:
无人机群的通信拓扑如图3所示,因此无人机群的邻接矩阵为
a10=1,a20=0,a30=0,a40=0
控制器参数为
mi1=diag{4,4,4},mi2=diag{15,15,15},i=1,2,3,4
设计观测器增益为
L1=[50,50,70,50,60,70]T,L2=L3=L4=[40,40,50,40,50,50]T
事件触发机制相关参数为:
∈i1=∈i2=∈i3=10-5,
自适应律参数为:
Γi,1=Γi,2=1,Ξi1=3,σi,0=σi,1=σi,2=20
仿真结果如图4~图21所示,由图4~图6可知,经过极短的调整时间后,僚机的姿态实现了与领机的姿态保持同步,并且观测器能够很好地观测领机的姿态信息,证明了本方案的有效性。图7~图9为姿态相应速度的曲线图。图10~图21为事件触发机制阈值的变化,实线为相应阈值曲线,点实线为测量误差曲线,(例如,图10中实线为阈值点实线为测量误差/>),显然阈值不会超过uNi+hi,由于只有τi为时变函数,故该曲线也能反映事件控制器只有满足触发阈值才更新的特性,即点实线条测量误差达到阈值曲线后,阈值曲线更新到新的值,否则阈值保持不变,控制器也维持不变。因此,信息层的控制中心通过网络传输给无人机的控制信号减少,无人机中执行器需要接收的信号减少,能耗减少,执行器不需要频繁调整状态,因此机械磨损也减少。故数值***明了所提出的有效性。
实施例二
本实施例的目的是提供一种计算装置,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述实施例子一中的方法的步骤。
实施例三
本实施例的目的是提供一种计算机可读存储介质。
一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时执行上述实施例子一中的方法的步骤。
实施例四
本实施例的目的是提供了基于饱和阈值事件触发的高层消防无人机编队控制***,包括:传感器采集***、控制中心;
所述传感器采集***采集处在工作现场的消防无人机输出信息,发送到处于安全位置的控制中心,所述控制中心基于构建的基于饱和阈值事件触发策略的控制器计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程;
基于饱和阈值事件触发策略的控制器,该控制器被配置为:设定随控制器幅值变化的触发阈值,符合触发条件时执行控制任务的事件触发控制策略,事件触发控制策略将触发阈值与控制器的幅值相关联,以保证控制性能的同时不会产生对***造成冲击的控制更新。
以上实施例二、三和四的装置中涉及的各步骤与方法实施例一相对应,具体实施方式可参见实施例一的相关说明部分。术语“计算机可读存储介质”应该理解为包括一个或多个指令集的单个介质或多个介质;还应当被理解为包括任何介质,所述任何介质能够存储、编码或承载用于由处理器执行的指令集并使处理器执行本公开中的任一方法。
本领域技术人员应该明白,上述本公开的各模块或各步骤可以用通用的计算机装置来实现,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。本公开不限制于任何特定的硬件和软件的结合。
以上所述仅为本公开的优选实施例而已,并不用于限制本公开,对于本领域的技术人员来说,本公开可以有各种更改和变化。凡在本公开的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。
上述虽然结合附图对本公开的具体实施方式进行了描述,但并非对本公开保护范围的限制,所属领域技术人员应该明白,在本公开的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本公开的保护范围以内。
Claims (8)
1.基于饱和阈值事件触发的高层消防无人机编队控制方法,其特征是,包括:
构建基于饱和阈值事件触发策略的控制器,该控制器被配置为:设定随控制器幅值变化的触发阈值,符合触发条件时才执行控制任务的事件触发控制策略,事件触发控制策略将触发阈值与控制器的幅值相关联,以保证控制性能的同时不会产生对***造成冲击的控制更新,具体为:设计事件触发控制器如下
其中,和/>分别为无人机侧倾角、俯仰角和偏航角相应控制器距离当前时刻t最近的触发时刻,/>表示无人机处于侧倾角姿态在/>时刻的过渡连续控制律,/>表示无人机处于俯仰角姿态在/>时刻的过渡连续控制律,/>表示无人机处于偏航角姿态在/>时刻的过渡连续控制律;
触发时刻由以下饱和阈值事件触发机制决定:
其中,wφi(t)表示无人机处于侧倾角姿态的过渡连续控制律,wθi(t)表示无人机处于俯仰角姿态的过渡连续控制律,wψi(t)表示无人机处于偏航角姿态的过渡连续控制律;为设计参数,满足/> 均为大于0的设计参数;
处在工作现场的消防无人机通过传感器采集***输出信息,发送到处于安全位置的控制中心,控制中心基于构建的基于饱和阈值事件触发策略的控制器计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程;
所述无人机编队控制方法具体步骤包括:
S1:建立信息物理***框架下的四旋翼无人机姿态***数学模型;
S2:描述无人机编队中各个无人机之间通信拓扑结构;
S3:构建神经网络逼近***的未知***动态;
S4:针对第i(i=1,2,...N)个僚机,构建状态观测器;
S5:基于***状态的观测值,定义合适协同一致性误差以及合适的误差面;
S6:设计虚拟控制器及神经网络权值自适应律;
S7:设计一种基于饱和阈值事件触发策略的实际控制器。
2.如权利要求1所述的基于饱和阈值事件触发的高层消防无人机编队控制方法,其特征是,基于饱和阈值事件触发策略的控制器,使得每一僚机能以与领机的姿态保持同步,即每一架僚机的侧倾角能与领机的侧倾角保持一致;俯仰角能与领机的俯仰角保持一致;偏航角能与领机的偏航角保持一致。
3.如权利要求1所述的基于饱和阈值事件触发的高层消防无人机编队控制方法,其特征是,基于状态观测器得到的状态信息构建同步误差和误差面,然后基于李雅普诺夫稳定性定义,设计虚拟控制器和自适应律,并引入了跟踪微分器逼近虚拟控制器的导数。
4.如权利要求1所述的基于饱和阈值事件触发的高层消防无人机编队控制方法,其特征是,所述四旋翼无人机姿态***数学模型构建针对对象是:仅配备少量的***输出传感器,执行器和通信器件,没有装备控制单元的消防四旋翼无人机***;
进一步的技术方案,所述四旋翼无人机姿态***数学模型构建时:忽略飞行器复杂的空气动力学特性,简化无人机模型,假设各无人机高度固定,仅关注无人机编队的姿态行为,从而得到每个无人机姿态***的数学模型。
5.如权利要求1所述的基于饱和阈值事件触发的高层消防无人机编队控制方法,其特征是,描述无人机编队中各个无人机之间通信拓扑结构时,利用有向图描述编队中无人机之间的有向通信拓扑关系;
有向图G={V,E}中,V={1,2,...,N}表示图G中节点的集合,且”1,2,...,N”表示僚机的编号,表示图中有向边的集合,且(j,i)意味着僚机i能接收到来自节点j的信息,并称节点j是僚机i的一个邻居。
6.基于饱和阈值事件触发的高层消防无人机编队控制***,其特征是,包括:传感器采集***、控制中心;
所述传感器采集***采集处在工作现场的消防无人机输出信息,发送到处于安全位置的控制中心,所述控制中心基于构建的基于饱和阈值事件触发策略的控制器计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程;
基于饱和阈值事件触发策略的控制器,该控制器被配置为:设定随控制器幅值变化的触发阈值,符合触发条件时才执行控制任务的事件触发控制策略,事件触发控制策略将触发阈值与控制器的幅值相关联,以保证控制性能的同时不会产生对***造成冲击的控制更新,具体为:设计事件触发控制器如下
其中,和/>分别为无人机侧倾角、俯仰角和偏航角相应控制器距离当前时刻t最近的触发时刻,/>表示无人机处于侧倾角姿态在/>时刻的过渡连续控制律,/>表示无人机处于俯仰角姿态在/>时刻的过渡连续控制律,/>表示无人机处于偏航角姿态在/>时刻的过渡连续控制律;
触发时刻由以下饱和阈值事件触发机制决定:
其中,wφi(t)表示无人机处于侧倾角姿态的过渡连续控制律,wθi(t)表示无人机处于俯仰角姿态的过渡连续控制律,wψi(t)表示无人机处于偏航角姿态的过渡连续控制律;为设计参数,满足/> 均为大于0的设计参数;
处在工作现场的消防无人机通过传感器采集***输出信息,发送到处于安全位置的控制中心,控制中心基于构建的基于饱和阈值事件触发策略的控制器计算出控制信号后通过网络传输回无人机***,无人机接收信号后执行器做出相应的执行动作,从而完成控制过程;
所述无人机编队控制方法具体步骤包括:
S1:建立信息物理***框架下的四旋翼无人机姿态***数学模型;
S2:描述无人机编队中各个无人机之间通信拓扑结构;
S3:构建神经网络逼近***的未知***动态;
S4:针对第i(i=1,2,...N)个僚机,构建状态观测器;
S5:基于***状态的观测值,定义合适协同一致性误差以及合适的误差面;
S6:设计虚拟控制器及神经网络权值自适应律;
S7:设计一种基于饱和阈值事件触发策略的实际控制器。
7.一种计算装置,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征是,所述处理器执行所述程序时实现上述权利要求1-5任一所述方法的步骤。
8.一种计算机可读存储介质,其上存储有计算机程序,其特征是,该程序被处理器执行时执行上述权利要求1-5任一所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110054885.3A CN112859915B (zh) | 2021-01-15 | 2021-01-15 | 基于饱和阈值事件触发的高层消防无人机编队控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110054885.3A CN112859915B (zh) | 2021-01-15 | 2021-01-15 | 基于饱和阈值事件触发的高层消防无人机编队控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112859915A CN112859915A (zh) | 2021-05-28 |
CN112859915B true CN112859915B (zh) | 2024-04-26 |
Family
ID=76006749
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110054885.3A Active CN112859915B (zh) | 2021-01-15 | 2021-01-15 | 基于饱和阈值事件触发的高层消防无人机编队控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112859915B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113342037B (zh) * | 2021-06-07 | 2023-05-26 | 广东工业大学 | 具有输入饱和的多旋翼无人机时变编队控制方法及*** |
CN114115335A (zh) * | 2021-11-05 | 2022-03-01 | 桂林航天工业学院 | 一种基于跟踪微分器的多四旋翼无人机安全编队控制方法 |
CN115108053A (zh) * | 2022-07-08 | 2022-09-27 | 中南大学 | 基于事件触发的空间多星协同编队控制方法 |
CN115981375B (zh) * | 2023-03-17 | 2023-07-28 | 南京信息工程大学 | 基于事件触发机制的多无人机时变编队控制器设计方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110262245A (zh) * | 2019-07-02 | 2019-09-20 | 南京理工大学 | 基于事件触发机制的多智能体***的控制器设计方法 |
CN110253572A (zh) * | 2019-05-31 | 2019-09-20 | 广东工业大学 | 一种基于扰动观测器的输入饱和多单臂机械手的事件触发控制方法 |
CN111273688A (zh) * | 2020-02-17 | 2020-06-12 | 南京邮电大学 | 基于事件触发的四旋翼无人机一致性编队控制方法 |
CN111338213A (zh) * | 2020-03-17 | 2020-06-26 | 大连海事大学 | 一种基于事件触发机制的多水下航行器自适应模糊二部一致控制方法 |
CN111638726A (zh) * | 2020-05-27 | 2020-09-08 | 北京理工大学 | 基于事件触发通信的多无人机编队一致性控制方法 |
-
2021
- 2021-01-15 CN CN202110054885.3A patent/CN112859915B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110253572A (zh) * | 2019-05-31 | 2019-09-20 | 广东工业大学 | 一种基于扰动观测器的输入饱和多单臂机械手的事件触发控制方法 |
CN110262245A (zh) * | 2019-07-02 | 2019-09-20 | 南京理工大学 | 基于事件触发机制的多智能体***的控制器设计方法 |
CN111273688A (zh) * | 2020-02-17 | 2020-06-12 | 南京邮电大学 | 基于事件触发的四旋翼无人机一致性编队控制方法 |
CN111338213A (zh) * | 2020-03-17 | 2020-06-26 | 大连海事大学 | 一种基于事件触发机制的多水下航行器自适应模糊二部一致控制方法 |
CN111638726A (zh) * | 2020-05-27 | 2020-09-08 | 北京理工大学 | 基于事件触发通信的多无人机编队一致性控制方法 |
Non-Patent Citations (2)
Title |
---|
基于固定阈值事件触发扩张状态观测器的 多智能体协同目标环绕控制;邵星灵 等;导航定位与授时;第8卷(第1期);第41-54页 * |
基于干扰观测器的输入饱和多智能体***事件触发控制;周琪 等;中国科学:信息科学;第49卷(第11期);第1502-1516页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112859915A (zh) | 2021-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112859915B (zh) | 基于饱和阈值事件触发的高层消防无人机编队控制方法及*** | |
Dong et al. | Time-varying formation control for unmanned aerial vehicles with switching interaction topologies | |
CN111522258B (zh) | 多无人机协同控制仿真***及其构建方法、仿真方法 | |
CN113342037B (zh) | 具有输入饱和的多旋翼无人机时变编队控制方法及*** | |
CN112631335B (zh) | 一种基于事件触发的多四旋翼无人机固定时间编队方法 | |
Sun et al. | Path planning for dense drone formation based on modified artificial potential fields | |
CN112925347B (zh) | 一种基于数据驱动的多无人机滑模编队控制方法 | |
CN112947086B (zh) | 一种无人机和无人车组成的异构多智能体***编队控制中执行器故障的自适应补偿方法 | |
CN112650290B (zh) | 带有扰动补偿的高层消防无人机编队优化控制方法及*** | |
Wang et al. | Multiple quadrotors formation flying control design and experimental verification | |
CN113759935B (zh) | 基于模糊逻辑的智能群体编队移动控制方法 | |
Min et al. | Decentralized UAV formation tracking flight control using gyroscopic force | |
CN110162084B (zh) | 基于一致性理论的飞航导弹集群***编队控制方法 | |
Jain et al. | Self-triggered cooperative path following control of fixed wing unmanned aerial vehicles | |
Yu et al. | Formation-containment control for unmanned aerial vehicle swarm system | |
CN114265315A (zh) | 异构线性集群***时变输出编队跟踪控制方法及*** | |
CN114415734B (zh) | 基于adp和避障机制的四旋翼无人机编队重构控制*** | |
Vega-Alonzo et al. | Event-based control strategy for consensus of a group of VTOL-UAVs | |
Huang | Consensus control of multiple-quadcopter systems under communication delays | |
CN116774735B (zh) | 一种基于边缘计算的无人机集群轨迹规划方法及*** | |
CN114020038B (zh) | 一种多四旋翼无人机自适应滑模姿态跟踪控制方法及*** | |
Shang et al. | Adaptive prescribed time control for quadrotor formation with stochastic links failure | |
Ghabcheloo et al. | Nonlinear coordinated path following control of multiple wheeled robots with communication constraints | |
Ma et al. | Comprehensive fault-tolerant control of leader–follower unmanned aerial vehicles (uavs) formation | |
Chen et al. | Research Article UAV Formation Control under Communication Constraints Based on Distributed Model Predictive Control |
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 |