CN112527015A - 一种基于事件触发的消防无人机编队滑膜控制方法 - Google Patents
一种基于事件触发的消防无人机编队滑膜控制方法 Download PDFInfo
- Publication number
- CN112527015A CN112527015A CN202011403190.3A CN202011403190A CN112527015A CN 112527015 A CN112527015 A CN 112527015A CN 202011403190 A CN202011403190 A CN 202011403190A CN 112527015 A CN112527015 A CN 112527015A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- fire
- aerial vehicle
- attitude
- fighting unmanned
- 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.)
- Granted
Links
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 61
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000004891 communication Methods 0.000 claims abstract description 23
- 230000007246 mechanism Effects 0.000 claims abstract description 13
- 230000014509 gene expression Effects 0.000 claims description 36
- 238000013461 design Methods 0.000 claims description 32
- 239000011159 matrix material Substances 0.000 claims description 30
- 230000008569 process Effects 0.000 claims description 13
- 230000009466 transformation Effects 0.000 claims description 6
- 230000001960 triggered effect Effects 0.000 claims description 6
- 239000013598 vector Substances 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 4
- 230000002457 bidirectional effect Effects 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 210000001258 synovial membrane Anatomy 0.000 claims description 2
- 230000009471 action Effects 0.000 abstract description 3
- 230000007547 defect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 6
- 238000011161 development Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization 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/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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- Health & Medical Sciences (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出一种基于事件触发的消防无人机编队滑膜控制方法,消防无人机编队控制的技术领域,解决了现有控制方法无法同时兼顾消防无人机的姿态控制和位置控制的问题,而且克服了现有控制方法导致无人机控制器更新次数多,性能衰减快的缺陷,首先需要建立四旋翼无人机的模型,以及无人机之间通信的拓扑关系。然后,设计基于误差的滑模动态面,进一步结合事件触发机制设计对应的控制器,以此实现无人机的快速编队。该方法针对实际应用的四旋翼的消防无人机模型,根据无人机的位置和姿态的信息分别设计了位置控制器和姿态控制器,在这两个控制器作用下,最终实现多无人机间的编队的形成及姿态的稳定,兼顾无人机的姿态控制和位置控制。
Description
技术领域
本发明涉及消防无人机编队控制的技术领域,更具体地,涉及一种基于事件触发的消防无人机编队滑膜控制方法。
背景技术
近年来,随着消防无人机科技技术的发展,消防无人机的应用领域越来越广泛,且消防无人机的功能也越来越强大。另外,随着四旋翼消防无人机市场份额的大幅增加,多旋翼消防无人机的形成更是一个具有吸引力的研究热点。
消防无人机对高层建筑消防工作可以起到很大的作用,例如能进行火灾定位、火灾侦查和高层灭火等,这些工作对于正常消防车和消防人员都是比较难完成的任务。所以,目前出现了许多有关消防无人机研究的课题,但是研究也处于初步阶段,消防无人机还不能广泛应用于实际。而消防无人机编队控制是实现多消防无人机协同工作的基础。所以,设计好的编队控制算法,对消防无人机的发展具有重大的理论和实际意义。
2019年7月5日,中国专利(公开号:CN109976361A)中公开了一种面向事件触发的四旋翼消防无人机姿态控制方法,解决四旋翼消防无人机在模型参数不确定、未建模动态和外界干扰等综合影响下的高精度快速姿态跟踪控制,达到在保证四旋翼消防无人机控制性能的前提下,节约网络和计算资源、提高***续航能力的目的,但该专利中提出的控制方法控制器更新的次数较多,另外此专利提出的方法仅针对消防无人机的姿态控制,不能实现消防无人机位置控制,因此,无法完成多消防无人机间的编队协同控制,不能保证消防无人机的编队效果。
发明内容
为解决现有消防无人机控制的方法无法同时兼顾消防无人机的姿态控制和位置控制的问题,而且为克服现有控制方法导致无人机控制器更新次数多,性能衰减快的缺陷,本发明提出一种基于事件触发的消防无人机编队滑膜控制方法,兼顾无人机的姿态控制和位置控制,在保证多无人机间优良编队效果的同时,减少无人机控制器更新的次数,防止控制器性能衰减的现象发生,促进消防无人机的应用发展。
为了达到上述技术效果,本发明的技术方案如下:
一种基于事件触发的消防无人机编队滑膜控制方法,至少包括以下步骤:
S1.建立四旋翼消防无人机的模型,得到消防无人机连续的位置动态方程以及姿态动态方程;
S2.基于图论确认消防无人机间的通信拓扑关系图,设定消防无人机期望的编队队形;
S3.根据设定消防无人机期望的编队队形,求解消防无人机的位置误差,并利用位置误差信息设计位置滑模动态面,基于滑模动态面设计位置控制输入量;
S4.根据位置控制输入量,通过逆解求出期望姿态;
S5.求解消防无人机的姿态误差,并利用姿态误差信息设计姿态滑模动态面,基于滑模动态面设计姿态控制输入量;
S6.设计位置控制器和姿态控制器的事件触发机制;
S7.根据事件触发机制,判断是否符合位置控制器和/或姿态控制器的更新标准,若是,更新位置控制器和/或姿态控制器;否则,不更新。
在本技术方案中,首先建立四旋翼消防无人机的模型,得到无人机连续的位置动态方程以及姿态动态方程,在此建立的消防无人机的模型是具体模型,针对性强且准确性高;然后建立无人机间通信的拓扑关系图,给出编队的期望队形,接着求出消防无人机的位置误差,并利用误差信息设计位置滑模动态面,基于滑模动态面设计位置控制输入量,根据位置控制输入量,通过逆解求出期望姿态,再求出姿态误差信息,并利用用误差信息设计姿态滑模动态面,基于滑模动态面设计姿态控制输入量,设计位置控制器和姿态控制器的事件触发机制,根据事件触发机制,判断是否更新位置控制和/或姿态的控制器,从而减少控制器更新次数,保证控制器性能不会大大衰减,延长寿命的同时兼顾了消防无人机的姿态控制和位置控制的问题,实现了消防无人机的快速编队。
优选地,步骤S1所述建立四旋翼消防无人机的模型,得到消防无人机连续的位置动态方程以及姿态动态方程的综合表达式为:
其中,i表示第i台消防无人机,i=1,…,N,N表示消防无人机台数;Pi=[xi,yi,zi]T及Vi=[vix,viy,viz]T分别表示消防无人机i在惯性坐标系下的坐标以及速度,表示相量形式;g为重力加速度,e3=[0,0,1]T,mi为第i台消防无人机的质量;Θi=[φi,θi,ψi]T、Ωi=[Ωφi,Ωθi,Ωψi]T分别为姿态角和角速率,φi,θi,ψi分别为滚转角、俯仰角、偏航角;R(Θi)表示消防无人机从机体坐标转化为惯性坐标的旋转矩阵;T(Θi)为姿态角速率与姿态角速度的转化矩阵;
消防无人机从机体坐标转化为惯性坐标的旋转矩阵R(Θi)表达式为:
姿态角速率与姿态角速度的转化矩阵T(Θi)的表达式为:
其中,Ji为惯性矩阵;Gi为回转力矩;ui、τi分别为位置控制器和姿态控制器的输入。
优选地,步骤S2所述的图论为无向图图论,基于无向图论确认消防无人机间的通信拓扑关系图的过程为:
设无向图表示为G={V,E,A},其中,V={1,…,N}代表无向图G的节点集合,表示无向图G中边的集合;A表示权重矩阵,根据无向图G中边的集合E的边关系得到权重矩阵,A=[aij]∈RN×N,其中,aij表示权重矩阵中的元素,代表消防无人机i与消防无人机j的通信关系,aij=0或1;
若aij=0代表消防无人机i与消防无人机j是不连接的,不存在通信;若aij=1代表消防无人机i与消防无人机j是连接的,存在通信交流。
优选地,基于无向图论确认的消防无人机间的通信拓扑关系图的节点间是双向且连通的,不存在自身与自身通信,即满足:aij=aji,aii=0。
优选地,权重矩阵A中的任意一行或任意一列的元素不全为零。
优选地,若aij=1,所述消防无人机期望的编队队形表达式为:
Pi-Pj=pij,Vi-Vj=0
其中,Pi表示消防无人机i在惯性坐标系下的坐标;Pj表示消防无人机j在惯性坐标系下的坐标;Vi表示消防无人机i在惯性坐标系下的速度;Vj表示消防无人机j在惯性坐标系下的速度;pij能表示时变的函数,也能表示常数向量,且pij=-pji;pij为消防无人机i与消防无人机j期望的位置向量。
优选地,步骤S3所述根据设定消防无人机期望的编队队形,求解位置误差的表达式为:
利用位置误差信息设计位置滑模动态面的表达式为:
基于滑模动态面设计位置控制输入量的过程为:
为方便设计位置控制输入量,令期望位置控制输入量Ui为:
其中,υi为设计的位置控制输入量,基于滑模动态面,设计对应的期望位置控制输入为:
υi=mi[Uix(sinθicosφicosψi+sinψisinθi)+Uiy(sinψisinθicosφi-cosψisinθi)+(Uiz+g)cosθicosφi]。
优选地,步骤S4所述根据位置控制输入量,通过逆解求出期望姿态Θdi=[φdi,θdi,ψdi]T的表达式为:
其中,ψdi表示期望姿态Θdi中自定的期望偏航角。
优选地,步骤S5所述求解姿态误差,并利用姿态误差信息设计姿态滑模动态面,基于滑模动态面设计姿态控制输入量的过程为:
第i台消防无人机的姿态误差表达式为:
其中,ci,2为设计需要的大于零的参数;
基于滑模动态面设计姿态控制输入量的表达式为:
优选地,步骤S6所述的位置控制器和姿态控制器的事件触发机制为:
步骤S7所述的位置控制器和/或姿态控制器的更新标准为:
位置控制器更新后的表达式为:
姿态控制器更新后的表达式为:
其中,ui、τi分别为位置控制器和姿态控制器的输入。
在此,位置控制器和/或姿态控制器的更新包括仅更新位置控制器、仅更新姿态控制器、同时更新位置控制器及姿态控制器,而位置控制器更新和/或姿态控制器的更新后保证了消防无人机的优良编队效果。
与现有技术相比,本发明技术方案的有益效果是:
本发明提出一种基于事件触发的消防无人机编队滑膜控制方法,首先需要建立四旋翼无人机的模型,以及无人机之间通信的拓扑关系。然后,设计基于误差的滑模动态面,进一步结合事件触发机制设计对应的控制器,以此实现无人机的快速编队。该方法针对实际应用的四旋翼的消防无人机模型,根据无人机的位置和姿态的信息分别设计了位置控制器和姿态控制器,在这两个控制器作用下,最终实现多无人机间的编队的形成及姿态的稳定,兼顾无人机的姿态控制和位置控制,在保证多无人机间优良编队效果的同时,减少无人机控制器更新的次数,防止控制器性能衰减的现象发生,促进消防无人机的应用发展。
附图说明
图1表示本发明实施例中提出的基于事件触发的消防无人机编队滑膜控制方法的流程示意图;
图2表示本发明实施例中提出的基于事件触发的消防无人机编队滑膜控制的控制框图;
图3表示本发明实施例中提出的四旋翼消防无人机队形形成过程中的运动曲线图;
图4表示本发明实施例中提出的四旋翼消防无人机队形形成过程中位置误差变化的仿真图;
图5表示发明实施例中提出的四旋翼消防无人机队形形成过程中速度误差变化的仿真图。
具体实施方式
附图仅用于示例性说明,不能理解为对本专利的限制;
为了更好地说明本实施例,附图某些部位会有省略、放大或缩小,并不代表实际尺寸;
对于本领域技术人员来说,附图中某些公知内容说明可能省略是可以理解的。
下面结合附图和实施例对本发明的技术方案做进一步的说明。
实施例1
附图中描述位置关系的用于仅用于示例性说明,不能理解为对本专利的限制;
如图1所示的基于事件触发的消防无人机编队滑膜控制方法的流程示意图,参见图1,所述方法的步骤包括:
S1.建立四旋翼消防无人机的模型,得到消防无人机连续的位置动态方程以及姿态动态方程,表达式为:
其中,i表示第i台消防无人机,i=1,…,N,N表示消防无人机台数;Pi=[xi,yi,zi]T及Vi=[vix,viy,viz]T分别表示消防无人机i在惯性坐标系下的坐标以及速度,表示相量形式;g为重力加速度,e3=[0,0,1]T,mi为第i台消防无人机的质量;Θi=[φi,θi,ψi]T、Ωi=[Ωφi,Ωθi,Ωψi]T分别为姿态角和角速率,φi,θi,ψi分别为滚转角、俯仰角、偏航角;R(Θi)表示消防无人机从机体坐标转化为惯性坐标的旋转矩阵;T(Θi)为姿态角速率与姿态角速度的转化矩阵;
消防无人机从机体坐标转化为惯性坐标的旋转矩阵R(Θi)表达式为:
姿态角速率与姿态角速度的转化矩阵T(Θi)的表达式为:
其中,Ji为惯性矩阵;Gi为回转力矩;ui、τi分别为位置控制器和姿态控制器的输入。
S2.基于图论确认消防无人机间的通信拓扑关系图,设定消防无人机期望的编队队形;
所述的图论为无向图图论,基于无向图论确认消防无人机间的通信拓扑关系图的过程为:
设无向图表示为G={V,E,A},其中,V={1,…,N}代表无向图G的节点集合,表示无向图G中边的集合;A表示权重矩阵,根据无向图G中边的集合E的边关系得到权重矩阵,A=[aij]∈RN×N,其中,aij表示权重矩阵中的元素,代表消防无人机i与消防无人机j的通信关系,aij=0或1;
若aij=0代表消防无人机i与消防无人机j是不连接的,不存在通信;若aij=1代表消防无人机i与消防无人机j是连接的,存在通信交流。
基于无向图论确认的消防无人机间的通信拓扑关系图的节点间是双向且连通的,不存在自身与自身通信,即满足:aij=aji,aii=0。
权重矩阵A中的任意一行或任意一列的元素不全为零。
优选地,若aij=1,所述消防无人机期望的编队队形表达式为:
Pi-Pj=pij,Vi-Vj=0
其中,Pi表示消防无人机i在惯性坐标系下的坐标;Pj表示消防无人机j在惯性坐标系下的坐标;Vi表示消防无人机i在惯性坐标系下的速度;Vj表示消防无人机j在惯性坐标系下的速度;pij能表示时变的函数,也能表示常数向量,且pij=-pji;pij为消防无人机i与消防无人机j期望的位置向量。
S3.根据设定消防无人机期望的编队队形,求解消防无人机的位置误差,并利用位置误差信息设计位置滑模动态面,基于滑模动态面设计位置控制输入量;
根据设定消防无人机期望的编队队形,求解位置误差的表达式为:
利用位置误差信息设计位置滑模动态面的表达式为:
基于滑模动态面设计位置控制输入量的过程为:
为方便设计位置控制输入量,令期望位置控制输入量Ui为:
其中,υi为设计的位置控制输入量,基于滑模动态面,设计对应的期望位置控制输入为:
υi=mi[Uix(sinθicosφicosψi+sinψisinθi)+Uiy(sinψisinθicosφi-cosψisinθi)+(Uiz+g)cosθicosφi]。在实际实施时,若控制性能足够好,也可以设为0。
S4.根据位置控制输入量,通过逆解求出期望姿态。期望姿态Θdi=[φdi,θdi,ψdi]T的表达式为:
其中,ψdi表示期望姿态Θdi中自定的期望偏航角。
S5.求解消防无人机的姿态误差,并利用姿态误差信息设计姿态滑模动态面,基于滑模动态面设计姿态控制输入量;基于滑模动态面设计姿态控制输入量的过程为:
第i台消防无人机的姿态误差表达式为:
其中,ci,2为设计需要的大于零的参数;
基于滑模动态面设计姿态控制输入量的表达式为:
S6.设计位置控制器和姿态控制器的事件触发机制;
S7.根据事件触发机制,判断是否符合位置控制器和/或姿态控制器的更新标准,若是,更新位置控制器和/或姿态控制器;否则,不更新。步骤S7所述的位置控制器和/或姿态控制器的更新标准为:
位置控制器更新后的表达式为:
姿态控制器更新后的表达式为:
其中,ui、τi分别为位置控制器和姿态控制器的输入。
总体上本发明实施例中提出的整个方法基于的控制框图如图2所示,参见图2,以消防无人机j在惯性坐标系下的坐标Pj以及速度Vj作为位置控制器的输入,得到对应的期望位置控制输入Ui,实际中可能经过姿态解算和滤波,然后基于事件触发机制,触发位置控制(执行)器和姿态(执行)器,直接作用于四旋翼无人机模型,然后反馈给位置控制器和姿态更新器,进行更新,实现兼顾姿态更新和位置更新的滑膜控制,保证消防无人及的优良编队效果。
为了更好说明本发明所提方法对消防无人机的编队控制的有效性,接下来对本发明所提的方法进行了应用仿真,现进行说明:
首先说明的是,仿真中,设置主要的参数如下:
g为重力加速度9.8m/s2,第i台消防无人机的质量:mi=1.1Kg,Ji=diag[15.6×10-3kg·m2,15.5×10-3kg·m2,28.3×10-3kg·m2],i=1,2,3。
消防无人机位置坐标初始状态为:
P1=[1,-1,0]T,P2=[2,1,1]T,P3=[-2,-1,-1]T,Ω1=Ω2=Ω3=[0,0,0]T。
设定消防无人机期望的队形为:P1-P2=[1,0,0]T,P1-P3=[-1,0,0]T。
图3展示了3台消防无人机编队队形的形成过程中的运动曲线图,其中,UAV1表示第一台消防无人机,UAV2表示第二台消防无人机,UAV3表示第三台消防无人机,由图2可以看出,3台消防无人机刚开始的运动曲线是杂乱的,但在本发明提出的控制方法的作用下,后续逐渐恢复一致。
图4为3台消防无人机队形形成过程位置误差变化的曲线,共六条,以第一台消防无人机UAV1的位置为对照基准,在x,y,z三维空间的每一维空间上分别对比与第二台消防无人机UAV2、第三台消防无人机UAV3的位置误差,从图3中可以看出,三个维度上的3台消防无人机位置误差均在逐渐趋于稳定。
图5表示3台消防无人机队形形成过程位置误差变化的曲线,共六条,也是以第一台消防无人机UAV1的速度为对照基准,在x,y,z三维空间的每一维空间上分别对比与第二台消防无人机UAV2、第三台消防无人机UAV3的速度误差,从图5中可以看出,三个维度上的3台消防无人机速度误差均在逐渐趋于0。图2~图4可以表明,本发明提出的方法能保证消防无人机编队快速的形成,达到期望的队形,且具有良好的控制性能。
附图中描述位置关系的用于仅用于示例性说明,不能理解为对本专利的限制;
显然,本发明的上述实施例仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (10)
1.一种基于事件触发的消防无人机编队滑膜控制方法,其特征在于,至少包括以下步骤:
S1.建立四旋翼消防无人机的模型,得到消防无人机连续的位置动态方程以及姿态动态方程;
S2.基于图论确认消防无人机间的通信拓扑关系图,设定消防无人机期望的编队队形;
S3.根据设定消防无人机期望的编队队形,求解消防无人机的位置误差,并利用位置误差信息设计位置滑模动态面,基于滑模动态面设计位置控制输入量;
S4.根据位置控制输入量,通过逆解求出期望姿态;
S5.求解消防无人机的姿态误差,并利用姿态误差信息设计姿态滑模动态面,基于滑模动态面设计姿态控制输入量;
S6.设计位置控制器和姿态控制器的事件触发机制;
S7.根据事件触发机制,判断是否符合位置控制器和/或姿态控制器的更新标准,若是,更新位置控制器和/或姿态控制器;否则,不更新。
2.根据权利要求1所述的基于事件触发的消防无人机编队滑膜控制方法,其特征在于,步骤S1所述建立四旋翼消防无人机的模型,得到消防无人机连续的位置动态方程以及姿态动态方程的综合表达式为:
其中,i表示第i台消防无人机,i=1,…,N,N表示消防无人机台数;Pi=[xi,yi,zi]T及Vi=[vix,viy,viz]T分别表示消防无人机i在惯性坐标系下的坐标以及速度,表示相量形式;g为重力加速度,e3=[0,0,1]T,mi为第i台消防无人机的质量;Θi=[φi,θi,ψi]T、Ωi=[Ωφi,Ωθi,Ωψi]T分别为姿态角和角速率,φi,θi,ψi分别为滚转角、俯仰角、偏航角;R(Θi)表示消防无人机从机体坐标转化为惯性坐标的旋转矩阵;T(Θi)为姿态角速率与姿态角速度的转化矩阵;
消防无人机从机体坐标转化为惯性坐标的旋转矩阵R(Θi)表达式为:
姿态角速率与姿态角速度的转化矩阵T(Θi)的表达式为:
其中,Ji为惯性矩阵;Gi为回转力矩;ui、τi分别为位置控制器和姿态控制器的输入。
4.根据权利要求3所述的基于事件触发的消防无人机编队滑膜控制方法,其特征在于,基于无向图论确认的消防无人机间的通信拓扑关系图的节点间是双向且连通的,不存在自身与自身通信,即满足:aij=aji,aii=0。
5.根据权利要求4所述的基于事件触发的消防无人机编队滑膜控制方法,其特征在于,权重矩阵A中的任意一行或任意一列的元素不全为零。
6.根据权利要求5所述的基于事件触发的消防无人机编队滑膜控制方法,其特征在于,若aij=1,所述消防无人机期望的编队队形表达式为:
Pi-Pj=pij,Vi-Vj=0
其中,Pi表示消防无人机i在惯性坐标系下的坐标;Pj表示消防无人机j在惯性坐标系下的坐标;Vi表示消防无人机i在惯性坐标系下的速度;Vj表示消防无人机j在惯性坐标系下的速度;pij能表示时变的函数,也能表示常数向量,且pij=-pji,pij为消防无人机i与消防无人机j期望的位置向量。
7.根据权利要求6所述的基于事件触发的消防无人机编队滑膜控制方法,其特征在于,步骤S3所述根据设定消防无人机期望的编队队形,求解位置误差的表达式为:
利用位置误差信息设计位置滑模动态面的表达式为:
基于滑模动态面设计位置控制输入量的过程为:
令期望位置控制输入量Ui为:
其中,υi为设计的位置控制输入量,基于滑模动态面,设计对应的期望位置控制输入为:
υi=mi[Uix(sinθicosφicosψi+sinψisinθi)+Uiy(sinψisinθicosφi-cosψisinθi)+(Uiz+g)cosθicosφi]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011403190.3A CN112527015B (zh) | 2020-12-04 | 2020-12-04 | 一种基于事件触发的消防无人机编队滑模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011403190.3A CN112527015B (zh) | 2020-12-04 | 2020-12-04 | 一种基于事件触发的消防无人机编队滑模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112527015A true CN112527015A (zh) | 2021-03-19 |
CN112527015B CN112527015B (zh) | 2023-05-05 |
Family
ID=74998335
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011403190.3A Active CN112527015B (zh) | 2020-12-04 | 2020-12-04 | 一种基于事件触发的消防无人机编队滑模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112527015B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102315498B1 (ko) * | 2021-05-21 | 2021-10-21 | 세종대학교산학협력단 | 다중 비행체의 편대 추종 제어 장치 및 그 방법 |
CN114489142A (zh) * | 2022-03-28 | 2022-05-13 | 中山大学 | 一种基于自适应滑模的无人机编队控制方法及相关装置 |
CN115662165A (zh) * | 2022-10-22 | 2023-01-31 | 浙江大虫科技股份有限公司 | 一种消防安全驾驶舱***及消防车路线***指引方法 |
CN115981375A (zh) * | 2023-03-17 | 2023-04-18 | 南京信息工程大学 | 基于事件触发机制的多无人机时变编队控制器设计方法 |
CN116431005A (zh) * | 2023-06-07 | 2023-07-14 | 安徽大学 | 一种基于改进移动端唇语识别的无人机控制方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109002058A (zh) * | 2018-09-10 | 2018-12-14 | 北京航空航天大学 | 基于事件触发的航天器编队飞行相对位置协同控制方法 |
CN109976361A (zh) * | 2019-03-14 | 2019-07-05 | 天津大学 | 面向事件触发的四旋翼无人机姿态控制方法 |
CN110456816A (zh) * | 2019-07-05 | 2019-11-15 | 哈尔滨工程大学 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
CN111273688A (zh) * | 2020-02-17 | 2020-06-12 | 南京邮电大学 | 基于事件触发的四旋翼无人机一致性编队控制方法 |
CN111813140A (zh) * | 2020-07-31 | 2020-10-23 | 中国人民解放军空军工程大学 | 一种具有高精度的四旋翼无人机轨迹跟踪控制方法 |
-
2020
- 2020-12-04 CN CN202011403190.3A patent/CN112527015B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109002058A (zh) * | 2018-09-10 | 2018-12-14 | 北京航空航天大学 | 基于事件触发的航天器编队飞行相对位置协同控制方法 |
CN109976361A (zh) * | 2019-03-14 | 2019-07-05 | 天津大学 | 面向事件触发的四旋翼无人机姿态控制方法 |
CN110456816A (zh) * | 2019-07-05 | 2019-11-15 | 哈尔滨工程大学 | 一种基于连续终端滑模的四旋翼轨迹跟踪控制方法 |
CN111273688A (zh) * | 2020-02-17 | 2020-06-12 | 南京邮电大学 | 基于事件触发的四旋翼无人机一致性编队控制方法 |
CN111813140A (zh) * | 2020-07-31 | 2020-10-23 | 中国人民解放军空军工程大学 | 一种具有高精度的四旋翼无人机轨迹跟踪控制方法 |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102315498B1 (ko) * | 2021-05-21 | 2021-10-21 | 세종대학교산학협력단 | 다중 비행체의 편대 추종 제어 장치 및 그 방법 |
CN114489142A (zh) * | 2022-03-28 | 2022-05-13 | 中山大学 | 一种基于自适应滑模的无人机编队控制方法及相关装置 |
CN115662165A (zh) * | 2022-10-22 | 2023-01-31 | 浙江大虫科技股份有限公司 | 一种消防安全驾驶舱***及消防车路线***指引方法 |
CN115981375A (zh) * | 2023-03-17 | 2023-04-18 | 南京信息工程大学 | 基于事件触发机制的多无人机时变编队控制器设计方法 |
CN116431005A (zh) * | 2023-06-07 | 2023-07-14 | 安徽大学 | 一种基于改进移动端唇语识别的无人机控制方法及*** |
CN116431005B (zh) * | 2023-06-07 | 2023-09-12 | 安徽大学 | 一种基于改进移动端唇语识别的无人机控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN112527015B (zh) | 2023-05-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112527015A (zh) | 一种基于事件触发的消防无人机编队滑膜控制方法 | |
CN110413006B (zh) | 一种基于5g通信的无人机编队组网***及方法 | |
CN110502027B (zh) | 一种基于自适应终端滑模的四旋翼无人机姿态容错控制方法 | |
CN109884895B (zh) | 基于饱和受限情况下的无人机自适应跟踪控制算法 | |
CN113296507B (zh) | 一种基于时空解耦的多动力定位船舶协同编队控制方法 | |
CN112578804B (zh) | 一种基于事件触发机制的四旋翼飞行器编队滑模控制方法 | |
CN109991991B (zh) | 一种无人直升机鲁棒容错跟踪方法 | |
CN112684805B (zh) | 一种考虑姿态约束的高机动微型无人机控制方法 | |
CN110673648A (zh) | 一种防止机间碰撞的固定翼无人机编队的控制方法 | |
CN111273688B (zh) | 基于事件触发的四旋翼无人机一致性编队控制方法 | |
CN112631335B (zh) | 一种基于事件触发的多四旋翼无人机固定时间编队方法 | |
CN108638068B (zh) | 一种携带冗余度机械臂的飞行机器人控制***设计方法 | |
CN111103881B (zh) | 一种多智能体编队防碰撞控制方法及*** | |
CN110333733A (zh) | 一种四旋翼飞行器的串级变论域模糊pid姿态控制***及方法 | |
CN112684705A (zh) | 一种四旋翼飞行器编队追踪控制方法 | |
CN115657730A (zh) | 一种大规模多旋翼无人机鲁棒分簇编队控制方法 | |
CN115639830A (zh) | 一种空地智能体协同编队控制***及其编队控制方法 | |
CN112859915A (zh) | 基于饱和阈值事件触发的高层消防无人机编队控制方法及*** | |
CN114089780B (zh) | 一种面向城市空间的多旋翼无人机路径规划方法 | |
CN113110593B (zh) | 基于虚拟结构和估计信息传输的飞行编队协同自适应控制方法 | |
CN111435253A (zh) | 四旋翼飞行器有界输出控制 | |
CN113919081A (zh) | 一种考虑惯性耦合的柔性飞行动力学建模与分析方法 | |
CN116301009A (zh) | 一种变构型无人机的抗干扰安全控制方法 | |
CN112327932B (zh) | 一种针对消防无人机编队的增量式pid控制方法 | |
CN116237938A (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 |