CN109324636A - 基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法 - Google Patents
基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法 Download PDFInfo
- Publication number
- CN109324636A CN109324636A CN201811244037.3A CN201811244037A CN109324636A CN 109324636 A CN109324636 A CN 109324636A CN 201811244037 A CN201811244037 A CN 201811244037A CN 109324636 A CN109324636 A CN 109324636A
- Authority
- CN
- China
- Prior art keywords
- quadrotor
- formation
- frame
- slave
- controller
- 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 71
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000004891 communication Methods 0.000 claims abstract description 20
- 238000010276 construction Methods 0.000 claims abstract description 14
- 238000005755 formation reaction Methods 0.000 claims description 62
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000033001 locomotion Effects 0.000 claims description 9
- 238000013016 damping Methods 0.000 claims description 8
- 239000003795 chemical substances by application Substances 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 4
- 230000010006 flight Effects 0.000 abstract description 2
- 230000004044 response Effects 0.000 description 6
- 230000008859 change Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 239000000178 monomer Substances 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000002776 aggregation Effects 0.000 description 1
- 238000004220 aggregation Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 231100001261 hazardous Toxicity 0.000 description 1
- 229910052500 inorganic mineral Inorganic materials 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 239000011707 mineral Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000012360 testing method 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)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法。针对多四旋翼编队飞行过程中几何队形生成、稳固保持和协同抗干扰问题,提出了一种可应对外部环境干扰和气动参数不确定性的多四旋翼主从式协同编队控制方法:首先,建立存在外部干扰的四旋翼运动学/动力学模型;其次,设计多四旋翼主从式通讯拓扑和编队样式以及领航者的位置和速度信息;然后,构造多四旋翼分布式位置保持控制器,为后续姿态控制器构造提供必要的期望指令;最后,构造基于自抗扰控制的多四旋翼姿态跟踪控制器。所提编队控制方法可以在局部智能体通信的前提下显著改善四旋翼编队***的抗干扰能力,提升干扰环境下多四旋翼编队几何构型的稳固性。
Description
技术领域
本发明涉及导航制导方向,多四旋翼编队领域,具体为一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,主要应用于存在外部干扰以及参数不确定性的多四旋翼编队任务。
背景技术
多四旋翼协同编队指的是多四旋翼通过保持预定的空间几何拓扑形态,借助全局或局部信息交互与共享,实现多旋翼***的群体集聚行为,形成多智能体***的协同超越能力,为执行单体所无法胜任的复杂性任务提供有效的解决方案。例如,多四旋翼可采用合理的编队飞行替代士兵执行恶劣、危险环境下诸如目标侦查、敌情搜集等军事任务,也可用于复杂山区地形环境人员搜救、矿产勘测等民用场合,可极大地弥补单体获取环境信息不完整、时效性不足的弊端,具有重要的军/民两用研究价值与迫切的现实意义。
多四旋翼协同编队控制作为多智能体***协同控制理论的应用实例之一,与无人车、无人船等二自由度运动体编队相比,在控制器构造与综合方面更具挑战性,表现在:(1)四旋翼本身为欠驱动、强非线性的多输入多输出六自由度***,为保证编队几何队形的稳固性,必须使得编队飞行过程中各四旋翼的位置、速度等协调变量趋于一致。然而,目前多智能体一致性理论大多针对低阶、线性等理想质点运动学模型展开,无法直接适用于多四旋翼编队***模型;(2)四旋翼的空气动力学参数受限于缺乏相应测量仪器无法精确获得,给模型带来了较大参数不确定性。此外,四旋翼空间飞行过程中不可避免遭受外部未知风扰的影响,上述因素给四旋翼的编队保持抗干扰控制器构造带来了困难。因而,迫切需要在考虑编队几何构型约束和参数不确定性以及外部干扰的情况下,构造适用于四旋翼典型动力学特征并具有强鲁棒性的多四旋翼协同编队控制方法。
发明内容
本发明为了解决多四旋翼编队飞行过程中几何队形生成、稳固保持和协同抗干扰的问题,基于领航者—跟随者的协同控制策略,提供了一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法。
本发明是通过如下技术方案来实现的:一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,包括如下步骤:
(1)建立存在外部干扰的四旋翼运动学/动力学模型;
(2)利用代数图论知识,设计多四旋翼主从式通讯拓扑和编队样式以及领航者的位置和速度信息;
(3)针对步骤(1)中建立的四旋翼运动学模型和步骤(2)中的多四旋翼通讯拓扑和编队样式以及领航者的位置和速度信息,构造适用于主从式编队任务且具有渐近收敛能力的多四旋翼分布式位置保持控制器,为后续姿态控制器构造提供期望指令;
(4)针对步骤(1)中建立的四旋翼动力学模型和步骤(3)生成的姿态期望指令,构造基于自抗扰控制的多四旋翼姿态跟踪控制器。
本发明所提供的基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,具体为在四旋翼轨迹回路中引入二阶一致性理论,结合代数图论和通信拓扑,以领航者位置作为动态编队的几何中心,将多四旋翼期望几何队形生成和保持问题转化为从机位置一致性跟踪与领航者的相对位置偏差控制问题,从而构造具有渐近收敛能力的多四旋翼分布式位置保持控制器;对于姿态回路的参数不确定性和外部干扰,借鉴自抗扰控制思想,将参数不确定性和外部干扰视为集总扰动,采用扩张状态观测器对其进行在线观测与补偿,实现对于给定姿态的高精度跟踪控制。
上述步骤中:步骤(1)中的四旋翼运动学/动力学模型具体如下:
定义四旋翼编队数量集合Γ=(1,2,...,n),i∈Γ,给出n架四旋翼组成编队中的第i架四旋翼运动学/动力学模型:
其中:mi为第i架四旋翼的质量,t为时间,Gi=[0,0,mig]T,g为重力加速度,Ji=diag(Ji,1,Ji,2,Ji,3)∈R3×3表示一个正定的对角惯性矩阵,Ji,1、Ji,2、Ji,3分别是第i架四旋翼在机体坐标系下沿x,y,z轴的转动惯量;g1,i=[c(ψi)s(θi)c(φi)+s(ψi)s(φi),s(ψi)s(θi)c(φi)-c(ψi)s(φi),c(θi)c(φi)]T表示与姿态相关的位置回路输入矩阵,s(·)与c(·)分别表示正弦函数和余弦函数;
pi=[xi,yi,zi]T,Θi=[φi,θi,ψi]T分别表示第i个四旋翼在惯性坐标系下的位置矢量和在机体坐标系下的姿态角;Π1,i=diag(kx,i,ky,i,kz,i),Π2,i=diag(kφ,i,kθ,i,kψ,i)分别是第i个四旋翼位置和姿态回路的空气阻尼矩阵,kr,i∈R,是第i架四旋翼的空气阻尼系数;τi=[τx,iτy,iτz,i]T为绕机体x,y,z轴的三个控制力矩,控制输入ui∈R为第i架四旋翼的拉力;g2,i=diag(li,li,ci)∈R3×3,其中li是螺旋桨到四旋翼质心的几何距离,ci是力矩系数,dΘ,i(t)=[dφ,i,dθ,i,dψ,i]T表示姿态回路中的有界外部干扰;
为便于后续位置控制器和姿态控制器的构造,引入如下符号定义:
其中,Fi=[Fi,x,Fi,y,Fi,z]T∈R3×1表示虚拟控制输入量,d4,i为姿态回路的集总扰动,包含外部扰动和参数不确定性的综合影响,δ1,i、δ2,i是第i架四旋翼的参数化不确定性矩阵,分别是Π2,i、g2,i的标称值;
借助上述中间变量,将四旋翼运动/动力学模型(1)改写为如下严格反馈形式:
步骤(2)中,多四旋翼通讯拓扑和编队样式以及领航者的位置和速度信息具体如下:四旋翼编队采用主从式结构,定义领航者是一个编号为0的节点,每一个从机依次被编号为1,…,n;四旋翼之间的通信拓扑可用无向图G={V,E,A}表示;V为节点集,E为边集,A=[aij]∈Rn×n是邻接权重矩阵;如果四旋翼i和四旋翼j相连,则aij=aji>0,否则aij=aji=0,此外,定义aii=0;领航者和从机i之间的连通权重用bi表示,如果第i架从机可以直接获取领航者信息,则bi>0,否则bi=0;
定义领航者为多四旋翼编队样式的几何中心,即编队样式坐标原点,根据期望的编队几何形状,设计第i架和第j架从机相对于领航者的位置矢量Δi=[Δi,x,Δi,y,Δi,z]T和Δj=[Δj,x,Δj,y,Δj,z]T,第i架和第j架从机间的相对位置偏差可由Δij=Δi-Δj=[Δi,x,Δi,y,Δi,z]T-[Δj,x,Δj,y,Δj,z]T=[Δij,x,Δij,y,Δij,z]T描述;
领航者轨迹运动信息可由下式产生:
其中,xd、yd、zd分别为领航者在惯性坐标系下沿x,y,z轴的位置分量,分别为领航者在惯性坐标系下沿x,y,z轴的速度分量。
步骤(3)的多四旋翼分布式位置保持控制器具体如下:
根据多四旋翼主从式编队通讯拓扑和期望领航者轨迹信息,结合多智能体二阶一致性原理,构造如下虚拟控制输入(Fi,x,Fi,y,Fi,z)T:
其中,k1、k2表示待设计的控制器参数,且Ni表示与第i架四旋翼具有直接通信连接的四旋翼集合,xi为第i架四旋翼在惯性坐标系下沿x轴的位置分量,xj为第j架四旋翼沿x轴的位置分量,vi,x为第i架四旋翼在惯性坐标系下沿x轴的速度分量,vj,x为第j架四旋翼惯性坐标系下沿x轴的速度分量;
在获得上述虚拟控制输入(Fi,x,Fi,y,Fi,z)T的基础上,结合公式(2)进行逆动力学解算,可得到如下的期望姿态角指令
其中,ui为四旋翼无人机的期望拉力,分别为机体坐标系下的期望滚转角、俯仰角以及偏航角。
步骤(4)多四旋翼姿态跟踪控制器具体如下:
其中,为正的控制器比例增益,kd=2wc为正的控制器微分增益,wc为姿态回路的控制器带宽;为姿态回路集总干扰的估计值,可由如下仅依赖于控制输入力矩和姿态角量测输出的模型辅助扩张状态观测器给出:
其中,z1,i是对x3,i的估计,z2,i是对x4,i的估计,z3,i是对的估计,wo为姿态回路观测器带宽。
本发明与现有技术相比本发明具有以下有益效果:与目前大多数的多智能体一致性理论仅考虑低阶线性的模型不同,本发明充分考虑四旋翼的六自由度非线性、强耦合运动学/动力学模型;针对编队几何构型约束和参数不确定性以及外部干扰,构造了用于四旋翼姿态回路的抗干扰控制器,解决了多四旋翼编队的位置保持控制以及姿态跟踪控制问题,可以极大改善四旋翼编队***的抗干扰能力,提升干扰环境下多四旋翼编队几何构型的稳固性,对于丰富和发展多智能体协同控制理论具有重要意义。
附图说明
图1是本发明一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法的控制框图。
图2是以领航者为坐标原点的多四旋翼编队通信拓扑和编队样式。
图3是惯性坐标系下多四旋翼编队运动轨迹在x-y平面的投影。
图4是每架四旋翼的位置响应及相邻距离变化曲线。
图5是每架四旋翼的姿态角响应曲线。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细说明。
一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,如图1所示,包括如下步骤:
(1)建立存在外部干扰的四旋翼运动学/动力学模型:具体如下:
定义四旋翼编队数量集合Γ=(1,2,...,n),i∈Γ,给出n架四旋翼组成编队中的第i架四旋翼运动学/动力学模型:
其中:mi为第i架四旋翼的质量,t为时间,Gi=[0,0,mig]T,g为重力加速度,Ji=diag(Ji,1,Ji,2,Ji,3)∈R3×3表示一个正定的对角惯性矩阵,Ji,1、Ji,2、Ji,3分别是第i架四旋翼在机体坐标系下沿x,y,z轴的转动惯量;g1,i=[c(ψi)s(θi)c(φi)+s(ψi)s(φi),s(ψi)s(θi)c(φi)-c(ψi)s(φi),c(θi)c(φi)]T表示与姿态相关的位置回路输入矩阵,s(·)与c(·)分别表示正弦函数和余弦函数;
pi=[xi,yi,zi]T,Θi=[φi,θi,ψi]T分别表示第i个四旋翼在惯性坐标系下的位置矢量和在机体坐标系下的姿态角;Π1,i=diag(kx,i,ky,i,kz,i),Π2,i=diag(kφ,i,kθ,i,kψ,i)分别是第i个四旋翼位置和姿态回路的空气阻尼矩阵,kr,i∈R,是第i架四旋翼的空气阻尼系数;τi=[τx,iτy,iτz,i]T为绕机体x,y,z轴的三个控制力矩,控制输入ui∈R为第i架四旋翼的拉力;g2,i=diag(li,li,ci)∈R3×3,其中li是螺旋桨到四旋翼质心的几何距离,ci是力矩系数,dΘ,i(t)=[dφ,i,dθ,i,dψ,i]T表示姿态回路中的有界外部干扰;
为便于后续位置控制器和姿态控制器的构造,引入如下符号定义:
其中,Fi=[Fi,x,Fi,y,Fi,z]T∈R3×1表示虚拟控制输入量,d4,i为姿态回路的集总扰动,包含外部扰动和参数不确定性的综合影响,δ1,i、δ2,i是第i架四旋翼的参数化不确定性矩阵,分别是Π2,i、g2,i的标称值;
借助上述中间变量,将四旋翼运动/动力学模型(1)改写为如下严格反馈形式:
(2)利用代数图论知识,设计多四旋翼主从式通讯拓扑和编队样式以及领航者的位置和速度信息,具体如下:
四旋翼编队采用主从式结构,定义领航者是一个编号为0的节点,每一个从机依次被编号为1,…,n;四旋翼之间的通信拓扑可用无向图G={V,E,A}表示;V为节点集,E为边集,A=[aij]∈Rn×n是邻接权重矩阵;如果四旋翼i和四旋翼j相连,则aij=aji>0,否则aij=aji=0,此外,定义aii=0;领航者和从机i之间的连通权重用bi表示,如果第i架从机可以直接获取领航者信息,则bi>0,否则bi=0;
定义领航者为多四旋翼编队样式的几何中心,即编队样式坐标原点,根据期望的编队几何形状,设计第i架和第j架从机相对于领航者的位置矢量Δi=[Δi,x,Δi,y,Δi,z]T和Δj=[Δj,x,Δj,y,Δj,z]T,第i架和第j架从机间的相对位置偏差可由Δij=Δi-Δj=[Δi,x,Δi,y,Δi,z]T-[Δj,x,Δj,y,Δj,z]T=[Δij,x,Δij,y,Δij,z]T描述;
领航者轨迹运动信息可由下式产生:
其中,xd、yd、zd分别为领航者在惯性坐标系下沿x,y,z轴的位置分量,分别为领航者在惯性坐标系下沿x,y,z轴的速度分量。
(3)针对步骤(1)中建立的四旋翼运动学模型和步骤(2)中的多四旋翼通讯拓扑和编队样式以及领航者的位置和速度信息,构造适用于主从式编队任务且具有渐近收敛能力的多四旋翼分布式位置保持控制器,为后续姿态控制器构造提供期望指令:多四旋翼分布式位置保持控制器具体如下:
根据多四旋翼主从式编队通讯拓扑和期望领航者轨迹信息,结合多智能体二阶一致性原理,构造如下虚拟控制输入(Fi,x,Fi,y,Fi,z)T:
其中,k1、k2表示待设计的控制器参数,且Ni表示与第i架四旋翼具有直接通信连接的四旋翼集合,xi为第i架四旋翼在惯性坐标系下沿x轴的位置分量,xj为第j架四旋翼沿x轴的位置分量,vi,x为第i架四旋翼在惯性坐标系下沿x轴的速度分量,vj,x为第j架四旋翼惯性坐标系下沿x轴的速度分量;
在获得上述虚拟控制输入(Fi,x,Fi,y,Fi,z)T的基础上,结合公式(2)进行逆动力学解算,可得到如下的期望姿态角指令
其中,ui为四旋翼无人机的期望拉力,分别为机体坐标系下的期望滚转角、俯仰角以及偏航角。
(4)针对步骤(1)中建立的四旋翼动力学模型和步骤(3)生成的姿态期望指令,构造基于自抗扰控制的多四旋翼姿态跟踪控制器:步骤(4)多四旋翼姿态跟踪控制器具体如下:
其中,为正的控制器比例增益,kd=2wc为正的控制器微分增益,wc为姿态回路的控制器带宽;为姿态回路集总干扰的估计值,可由如下仅依赖于控制输入力矩和姿态角量测输出的模型辅助扩张状态观测器给出:
其中,z1,i是对x3,i的估计,z2,i是对x4,i的估计,z3,i是对的估计,wo为姿态回路观测器带宽。
实施例:
为考核所构造的控制器性能,采用式(1)描述的四旋翼运动学/动力学模型进行仿真。四旋翼运动学/动力学模型参数如表1所示。
用于控制器构造的模型参数选择如下:四旋翼质量mi为2kg,重力加速度g为9.8m/s2,惯性矩阵Ji=diag(Ji,1,Ji,2,Ji,3)=diag(0.16,0.16,0.32)kgm2,空气阻尼矩阵Π1,i=diag(kx,i,ky,i,kz,i)=diag(0.01,0.01,0.01)Nms2,空气阻尼矩阵Π2,i=diag(kφ,i,kθ,i,kψ,i)=diag(0.01,0.01,0.01)Nms2,螺旋桨到四旋翼质心的几何距离li为0.4米,力矩系数ci为0.05,参数不确定性δ1,i、δ2,i分别为和
表1四旋翼运动学/动力学模型参数
本发明所考虑的多四旋翼编队的通讯拓扑和编队样式如图2所示,显然,参与编队的四旋翼数量为5,即n=5。无向图的邻接权重系数如下:a12=a21=1,a23=a32=1,a34=a43=1,b1=1。为了便于分析,选择在惯性坐标系x-y平面中确定的正方形作为编队样式,且边长为2米,以领航者为编队样式几何中心,故从机相对于领航者的位置矢量为:Δ1=[1,1,0]T,Δ2=[-1,1,0]T,Δ3=[-1,-1,0]T,Δ4=[1,-1,0]T。领航者的轨迹设置为:(xd,yd,zd)T=(0.5t,5cos(0.2t),0.5t)T。各从机的姿态角及角速度初始状态为零,位置和速度初始状态如下设计:
[x1(0),y1(0),z1(0),v1,x(0),v1,y(0),v1,z(0),]=[0.8,0,2,0,0,0]
[x2(0),y2(0),z2(0),v2,x(0),v2,y(0),v2,z(0),]=[0,0.8,5,0,0,0]
[x3(0),y3(0),z3(0),v3,x(0),v3,y(0),v3,z(0),]=[-0.5,0.8,0,0,0,0]
[x4(0),y4(0),z4(0),v4,x(0),v4,y(0),v4,z(0),]=[-0.5,0,0.8,0,0,0]
为调整控制器的性能,对控制器参数进行选取。控制器参数如表2所示。
控制器参数选择如下:位置保持控制器参数k1为1.7,位置保持控制器参数k2为1.7,姿态控制器比例增益kp为25,姿态控制器微分增益kd为10。
表2控制器参数
为了考验控制器的抗干扰性,在四旋翼姿态回路中设置了如下外部扰动:
惯性坐标系下多四旋翼编队运动轨迹在x-y平面的投影如图3所示,可以看出,在所提供控制方法的作用下,即使存在未知的外部干扰和参数不确定性,多四旋翼依然可以保持期望的正方形编队构型。
每架四旋翼的位置响应曲线如图4所示,由图中可以看出,各个四旋翼轨迹状态在有限时间内保持较好的一致性;此外,从机之间的相邻距离可以快速、稳定收敛,最终与期望的几何构型边长2米保持一致。
每架四旋翼的姿态角响应曲线如图5所示,由图中可以看出,尽管存在外部干扰以及参数不确定性,四条响应曲线较快的趋于平稳一致,表示各四旋翼姿态角响应平稳光滑、最终趋于一致,控制效果达到预期。
综上所述,从本实施例中可以得出如下结论:本发明涉及的一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,在外部干扰以及参数不确定性的影响下,可以提升多四旋翼编队队形的稳固性,提高多四旋翼编队***的抗干扰能力。
本发明要求保护的范围不限于以上具体实施方式,而且对于本领域技术人员而言,本发明可以有多种变形和更改,凡在本发明的构思与原则之内所作的任何修改、改进和等同替换都应包含在本发明的保护范围之内。
Claims (5)
1.一种基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,其特征在于:包括如下步骤:
(1)建立存在外部干扰的四旋翼运动学/动力学模型;
(2)利用代数图论知识,设计多四旋翼主从式通讯拓扑和编队样式以及领航者的位置和速度信息;
(3)针对步骤(1)中建立的四旋翼运动学模型和步骤(2)中的多四旋翼通讯拓扑和编队样式以及领航者的位置和速度信息,构造适用于主从式编队任务且具有渐近收敛能力的多四旋翼分布式位置保持控制器,为后续姿态控制器构造提供期望指令;
(4)针对步骤(1)中建立的四旋翼动力学模型和步骤(3)生成的姿态期望指令,构造基于自抗扰控制的多四旋翼姿态跟踪控制器。
2.根据权利要求1所述的基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,其特征在于:所述步骤(1)中四旋翼运动学/动力学模型具体如下:
定义四旋翼编队数量集合Γ=(1,2,...,n),i∈Γ,给出n架四旋翼组成编队中的第i架四旋翼运动学/动力学模型:
其中:mi为第i架四旋翼的质量,t为时间,Gi=[0,0,mig]T,g为重力加速度,Ji=diag(Ji,1,Ji,2,Ji,3)∈R3×3表示一个正定的对角惯性矩阵,Ji,1、Ji,2、Ji,3分别是第i架四旋翼在机体坐标系下沿x,y,z轴的转动惯量;表示与姿态相关的位置回路输入矩阵,s(·)与c(·)分别表示正弦函数和余弦函数;
pi=[xi,yi,zi]T,Θi=[φi,θi,ψi]T分别表示第i个四旋翼在惯性坐标系下的位置矢量和在机体坐标系下的姿态角;Π1,i=diag(kx,i,ky,i,kz,i),Π2,i=diag(kφ,i,kθ,i,kψ,i)分别是第i个四旋翼位置和姿态回路的空气阻尼矩阵,是第i架四旋翼的空气阻尼系数;τi=[τx,iτy,iτz,i]T为绕机体x,y,z轴的三个控制力矩,控制输入ui∈R为第i架四旋翼的拉力;g2,i=diag(li,li,ci)∈R3×3,其中li是螺旋桨到四旋翼质心的几何距离,ci是力矩系数,dΘ,i(t)=[dφ,i,dθ,i,dψ,i]T表示姿态回路中的有界外部干扰;
为便于后续位置控制器和姿态控制器的构造,引入如下符号定义:
其中,Fi=[Fi,x,Fi,y,Fi,z]T∈R3×1表示虚拟控制输入量,d4,i为姿态回路的集总扰动,包含外部扰动和参数不确定性的综合影响,δ1,i、δ2,i是第i架四旋翼的参数化不确定性矩阵,分别是Π2,i、g2,i的标称值;
借助上述中间变量,将四旋翼运动/动力学模型(1)改写为如下严格反馈形式:
3.根据权利要求1所述的基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,其特征在于:所述步骤(2)多四旋翼通讯拓扑和编队样式以及领航者的位置和速度信息具体如下:
四旋翼编队采用主从式结构,定义领航者是一个编号为0的节点,每一个从机依次被编号为1,…,n;四旋翼之间的通信拓扑可用无向图G={V,E,A}表示;V为节点集,E为边集,A=[aij]∈Rn×n是邻接权重矩阵;如果四旋翼i和四旋翼j相连,则aij=aji>0,否则aij=aji=0,此外,定义aii=0;领航者和从机i之间的连通权重用bi表示,如果第i架从机可以直接获取领航者信息,则bi>0,否则bi=0;
定义领航者为多四旋翼编队样式的几何中心,即编队样式坐标原点,根据期望的编队几何形状,设计第i架和第j架从机相对于领航者的位置矢量Δi=[Δi,x,Δi,y,Δi,z]T和Δj=[Δj,x,Δj,y,Δj,z]T,第i架和第j架从机间的相对位置偏差可由Δij=Δi-Δj=[Δi,x,Δi,y,Δi,z]T-[Δj,x,Δj,y,Δj,z]T=[Δij,x,Δij,y,Δij,z]T描述;
领航者轨迹运动信息可由下式产生:
其中,xd、yd、zd分别为领航者在惯性坐标系下沿x,y,z轴的位置分量,分别为领航者在惯性坐标系下沿x,y,z轴的速度分量。
4.根据权利要求1所述的基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,其特征在于:所述步骤(3)的多四旋翼分布式位置保持控制器具体如下:
根据多四旋翼主从式编队通讯拓扑和期望领航者轨迹信息,结合多智能体二阶一致性原理,构造如下虚拟控制输入(Fi,x,Fi,y,Fi,z)T:
其中,k1、k2表示待设计的控制器参数,且Ni表示与第i架四旋翼具有直接通信连接的四旋翼集合,xi为第i架四旋翼在惯性坐标系下沿x轴的位置分量,xj为第j架四旋翼沿x轴的位置分量,vi,x为第i架四旋翼在惯性坐标系下沿x轴的速度分量,vj,x为第j架四旋翼惯性坐标系下沿x轴的速度分量;
在获得上述虚拟控制输入(Fi,x,Fi,y,Fi,z)T的基础上,结合公式(2)进行逆动力学解算,可得到如下的期望姿态角指令
其中,ui为四旋翼无人机的期望拉力,分别为机体坐标系下的期望滚转角、俯仰角以及偏航角。
5.根据权利要求1所述的基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法,其特征在于:所述步骤(4)多四旋翼姿态跟踪控制器具体如下:
其中,为正的控制器比例增益,kd=2wc为正的控制器微分增益,wc为姿态回路的控制器带宽;为姿态回路集总干扰的估计值,可由如下仅依赖于控制输入力矩和姿态角量测输出的模型辅助扩张状态观测器给出:
其中,z1,i是对x3,i的估计,z2,i是对x4,i的估计,z3,i是对的估计,wo为姿态回路观测器带宽。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811244037.3A CN109324636B (zh) | 2018-10-24 | 2018-10-24 | 基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811244037.3A CN109324636B (zh) | 2018-10-24 | 2018-10-24 | 基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109324636A true CN109324636A (zh) | 2019-02-12 |
CN109324636B CN109324636B (zh) | 2021-08-20 |
Family
ID=65262912
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811244037.3A Expired - Fee Related CN109324636B (zh) | 2018-10-24 | 2018-10-24 | 基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109324636B (zh) |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110058611A (zh) * | 2019-05-13 | 2019-07-26 | 电子科技大学 | 一种基于分布式体系结构的四旋翼编队飞行控制方法 |
CN110134142A (zh) * | 2019-05-29 | 2019-08-16 | 北京理工大学 | 一种基于旋转排斥场的旋翼无人机领航跟随编队控制方法 |
CN110488606A (zh) * | 2019-07-25 | 2019-11-22 | 中北大学 | 一种多四旋翼主从式保性能神经自适应协同编队控制方法 |
CN110597061A (zh) * | 2019-09-18 | 2019-12-20 | 中国人民解放***箭军工程大学 | 一种多智能体完全分布式自抗扰时变编队控制方法 |
CN110673648A (zh) * | 2019-11-11 | 2020-01-10 | 西北工业大学 | 一种防止机间碰撞的固定翼无人机编队的控制方法 |
CN110928310A (zh) * | 2019-12-12 | 2020-03-27 | 大连海事大学 | 一种无人船领航跟随固定时间编队控制方法 |
CN111273688A (zh) * | 2020-02-17 | 2020-06-12 | 南京邮电大学 | 基于事件触发的四旋翼无人机一致性编队控制方法 |
CN111338371A (zh) * | 2020-04-22 | 2020-06-26 | 中北大学 | 一种考虑机载陀螺故障的四旋翼姿态可靠控制方法 |
CN111487996A (zh) * | 2020-04-30 | 2020-08-04 | 华南理工大学 | 一种基于adrc控制的多无人机协同控制***及其方法 |
CN111506117A (zh) * | 2020-06-04 | 2020-08-07 | 南京理工大学 | 基于极限环的四旋翼空间圆形编队解耦控制方法 |
CN111766899A (zh) * | 2020-08-11 | 2020-10-13 | 北京航空航天大学 | 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法 |
CN111984027A (zh) * | 2019-05-23 | 2020-11-24 | 南京航空航天大学 | 异构多无人机一致性控制方法 |
CN112527011A (zh) * | 2020-11-20 | 2021-03-19 | 西北工业大学 | 一种编队协同中制导技术统一框架的构建方法 |
CN112596548A (zh) * | 2020-12-23 | 2021-04-02 | 南京航空航天大学 | 一种环形任务模式下的多无人机一致性编队控制方法 |
CN112631335A (zh) * | 2020-12-29 | 2021-04-09 | 南京邮电大学 | 一种基于事件触发的多四旋翼无人机固定事件编队方法 |
CN112684705A (zh) * | 2020-12-18 | 2021-04-20 | 杭州电子科技大学 | 一种四旋翼飞行器编队追踪控制方法 |
CN112947462A (zh) * | 2021-03-02 | 2021-06-11 | 广东省智能机器人研究院 | 考虑时变漂角与姿态调节的无人艇群编队协同控制方法 |
CN113721656A (zh) * | 2020-12-08 | 2021-11-30 | 北京航空航天大学 | 一种导弹时变编队三维协同飞行控制方法 |
CN116027809A (zh) * | 2023-02-07 | 2023-04-28 | 中国矿业大学 | 一种DoS攻击下的多四旋翼无人机编队控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004008266A1 (en) * | 2002-07-16 | 2004-01-22 | Honeywell International Inc. | Vehicle position keeping system |
CN103439975A (zh) * | 2013-09-09 | 2013-12-11 | 北京理工大学 | 一种分布式指数时变滑模姿态协同跟踪控制方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
CN108427401A (zh) * | 2018-03-29 | 2018-08-21 | 南京航空航天大学 | 一种具有联合连通拓扑的飞行控制***协同故障诊断方法 |
CN108628172A (zh) * | 2018-06-25 | 2018-10-09 | 南京理工大学 | 一种基于扩张状态观测器的机械臂高精度运动控制方法 |
-
2018
- 2018-10-24 CN CN201811244037.3A patent/CN109324636B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004008266A1 (en) * | 2002-07-16 | 2004-01-22 | Honeywell International Inc. | Vehicle position keeping system |
CN103439975A (zh) * | 2013-09-09 | 2013-12-11 | 北京理工大学 | 一种分布式指数时变滑模姿态协同跟踪控制方法 |
CN107608367A (zh) * | 2017-09-06 | 2018-01-19 | 天津大学 | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 |
CN108427401A (zh) * | 2018-03-29 | 2018-08-21 | 南京航空航天大学 | 一种具有联合连通拓扑的飞行控制***协同故障诊断方法 |
CN108628172A (zh) * | 2018-06-25 | 2018-10-09 | 南京理工大学 | 一种基于扩张状态观测器的机械臂高精度运动控制方法 |
Non-Patent Citations (4)
Title |
---|
WEIJUNCAO,JINHUIZHANG,WEIREN: "Leader–follower consensus of linear multi-agent systems with unknown external disturbances", 《SYSTEMS & CONTROL LETTERS》 * |
XINGLING SHAO,NING LIU1,JUN LIU1,HONGLUN WANG: "Model-assisted extended state observer and dynamic surface control–based trajectory tracking for quadrotors via output-feedback mechanism", 《INTERNATIONAL JOURNAL OF ROBUST AND NONLINEAR CONTROL》 * |
邵星灵: "面向目标对峙跟踪的四旋翼协同编队控制方法", 《无人***技术》 * |
陈杰敏,吴发林,耿澄浩,徐珊: "四旋翼无人机一致性编队飞行控制方法", 《航空兵器》 * |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110058611A (zh) * | 2019-05-13 | 2019-07-26 | 电子科技大学 | 一种基于分布式体系结构的四旋翼编队飞行控制方法 |
CN111984027A (zh) * | 2019-05-23 | 2020-11-24 | 南京航空航天大学 | 异构多无人机一致性控制方法 |
CN111984027B (zh) * | 2019-05-23 | 2022-07-15 | 南京航空航天大学 | 异构多无人机一致性控制方法 |
CN110134142A (zh) * | 2019-05-29 | 2019-08-16 | 北京理工大学 | 一种基于旋转排斥场的旋翼无人机领航跟随编队控制方法 |
CN110134142B (zh) * | 2019-05-29 | 2020-07-07 | 北京理工大学 | 一种基于旋转排斥场的旋翼无人机领航跟随编队控制方法 |
CN110488606A (zh) * | 2019-07-25 | 2019-11-22 | 中北大学 | 一种多四旋翼主从式保性能神经自适应协同编队控制方法 |
CN110488606B (zh) * | 2019-07-25 | 2022-04-19 | 中北大学 | 一种多四旋翼主从式保性能神经自适应协同编队控制方法 |
CN110597061A (zh) * | 2019-09-18 | 2019-12-20 | 中国人民解放***箭军工程大学 | 一种多智能体完全分布式自抗扰时变编队控制方法 |
CN110597061B (zh) * | 2019-09-18 | 2022-04-26 | 中国人民解放***箭军工程大学 | 一种多智能体完全分布式自抗扰时变编队控制方法 |
CN110673648A (zh) * | 2019-11-11 | 2020-01-10 | 西北工业大学 | 一种防止机间碰撞的固定翼无人机编队的控制方法 |
CN110928310A (zh) * | 2019-12-12 | 2020-03-27 | 大连海事大学 | 一种无人船领航跟随固定时间编队控制方法 |
CN110928310B (zh) * | 2019-12-12 | 2022-05-13 | 大连海事大学 | 一种无人船领航跟随固定时间编队控制方法 |
CN111273688A (zh) * | 2020-02-17 | 2020-06-12 | 南京邮电大学 | 基于事件触发的四旋翼无人机一致性编队控制方法 |
CN111338371A (zh) * | 2020-04-22 | 2020-06-26 | 中北大学 | 一种考虑机载陀螺故障的四旋翼姿态可靠控制方法 |
CN111338371B (zh) * | 2020-04-22 | 2022-08-23 | 中北大学 | 一种考虑机载陀螺故障的四旋翼姿态可靠控制方法 |
CN111487996B (zh) * | 2020-04-30 | 2021-09-21 | 华南理工大学 | 一种基于adrc控制的多无人机协同控制***及其方法 |
CN111487996A (zh) * | 2020-04-30 | 2020-08-04 | 华南理工大学 | 一种基于adrc控制的多无人机协同控制***及其方法 |
CN111506117A (zh) * | 2020-06-04 | 2020-08-07 | 南京理工大学 | 基于极限环的四旋翼空间圆形编队解耦控制方法 |
CN111766899B (zh) * | 2020-08-11 | 2021-09-03 | 北京航空航天大学 | 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法 |
CN111766899A (zh) * | 2020-08-11 | 2020-10-13 | 北京航空航天大学 | 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法 |
CN112527011A (zh) * | 2020-11-20 | 2021-03-19 | 西北工业大学 | 一种编队协同中制导技术统一框架的构建方法 |
CN112527011B (zh) * | 2020-11-20 | 2022-07-15 | 西北工业大学 | 一种编队协同中制导技术统一框架的构建方法 |
CN113721656A (zh) * | 2020-12-08 | 2021-11-30 | 北京航空航天大学 | 一种导弹时变编队三维协同飞行控制方法 |
CN113721656B (zh) * | 2020-12-08 | 2024-03-15 | 北京航空航天大学 | 一种导弹时变编队三维协同飞行控制方法 |
CN112684705A (zh) * | 2020-12-18 | 2021-04-20 | 杭州电子科技大学 | 一种四旋翼飞行器编队追踪控制方法 |
CN112596548A (zh) * | 2020-12-23 | 2021-04-02 | 南京航空航天大学 | 一种环形任务模式下的多无人机一致性编队控制方法 |
CN112631335A (zh) * | 2020-12-29 | 2021-04-09 | 南京邮电大学 | 一种基于事件触发的多四旋翼无人机固定事件编队方法 |
CN112631335B (zh) * | 2020-12-29 | 2023-10-03 | 南京邮电大学 | 一种基于事件触发的多四旋翼无人机固定时间编队方法 |
CN112947462A (zh) * | 2021-03-02 | 2021-06-11 | 广东省智能机器人研究院 | 考虑时变漂角与姿态调节的无人艇群编队协同控制方法 |
CN116027809A (zh) * | 2023-02-07 | 2023-04-28 | 中国矿业大学 | 一种DoS攻击下的多四旋翼无人机编队控制方法 |
CN116027809B (zh) * | 2023-02-07 | 2023-07-18 | 中国矿业大学 | 一种DoS攻击下的多四旋翼无人机编队控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109324636B (zh) | 2021-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109324636A (zh) | 基于二阶一致性和自抗扰的多四旋翼主从式协同编队控制方法 | |
Zhou et al. | Adaptive fuzzy backstepping-based formation control of unmanned surface vehicles with unknown model nonlinearity and actuator saturation | |
CN110488606B (zh) | 一种多四旋翼主从式保性能神经自适应协同编队控制方法 | |
Dong et al. | Time-varying formation control for unmanned aerial vehicles with switching interaction topologies | |
Zhang et al. | Constrained coordinated path-following control for underactuated surface vessels with the disturbance rejection mechanism | |
CN109634307A (zh) | 一种无人水下航行器复合航迹跟踪控制方法 | |
CN104898683B (zh) | 一种挠性卫星神经网络反步滑模姿态控制方法 | |
CN106444799A (zh) | 基于模糊扩张状态观测器和自适应滑模的四旋翼无人机控制方法 | |
Ghommam et al. | Three-dimensional distributed tracking control for multiple quadrotor helicopters | |
CN106218922A (zh) | 挠性敏捷卫星的联合执行机构控制方法 | |
Imanberdiyev et al. | A fast learning control strategy for unmanned aerial manipulators | |
CN115639830B (zh) | 一种空地智能体协同编队控制***及其编队控制方法 | |
Woo et al. | Integration of path planning, trajectory generation and trajectory tracking control for aircraft mission autonomy | |
CN109597426A (zh) | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 | |
Guibin et al. | Cooperative formation control of multiple aerial vehicles based on guidance route in a complex task environment | |
CN106406097A (zh) | 多机械臂***的分布式自适应协调控制方法 | |
CN108445768A (zh) | 空间机器人操作空间轨迹跟踪的增广自适应模糊控制方法 | |
Yamasaki et al. | Integrated guidance and autopilot for a path-following UAV via high-order sliding modes | |
Enjiao et al. | Finite-time control of formation system for multiple flight vehicles subject to actuator saturation | |
Ghommam et al. | Distance‐Based Formation Control for Quadrotors with Collision Avoidance via Lyapunov Barrier Functions | |
Li et al. | Maritime buoyage inspection system based on an unmanned aerial vehicle and active disturbance rejection control | |
Stepanyan et al. | Adaptive disturbance rejection controller for visual tracking of a maneuvering target | |
Liu et al. | Pairwise control in swarm flocking with application to UAVs | |
Shen et al. | Hierarchical formation control with applications to multi-quadrotor systems | |
Gao et al. | Attitude tracking control of a quadrotor based on linear active disturbance rejective 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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210820 |