CN110377044A - 一种无人直升机的有限时间高度和姿态跟踪控制方法 - Google Patents
一种无人直升机的有限时间高度和姿态跟踪控制方法 Download PDFInfo
- Publication number
- CN110377044A CN110377044A CN201910670427.5A CN201910670427A CN110377044A CN 110377044 A CN110377044 A CN 110377044A CN 201910670427 A CN201910670427 A CN 201910670427A CN 110377044 A CN110377044 A CN 110377044A
- Authority
- CN
- China
- Prior art keywords
- height
- interference
- ref
- angle
- posture
- 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
- 238000000034 method Methods 0.000 title claims abstract description 22
- 150000001875 compounds Chemical class 0.000 claims abstract description 12
- 230000005484 gravity Effects 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 239000013598 vector Substances 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 241001442234 Cosa Species 0.000 description 1
- 244000089409 Erythrina poeppigiana Species 0.000 description 1
- 101000577696 Homo sapiens Proline-rich transmembrane protein 2 Proteins 0.000 description 1
- 102100028840 Proline-rich transmembrane protein 2 Human genes 0.000 description 1
- 235000009776 Rathbunia alamosensis Nutrition 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011982 device technology Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 238000009415 formwork Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002452 interceptive effect Effects 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/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
-
- 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
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
技术领域
本发明涉及一种无人直升机的有限时间高度和姿态跟踪控制方法,属于无人直升机的飞行控制技术领域。
背景技术
近年来,无人直升机以其独特的优势引起了人们的广泛关注,如垂直起降、低空飞行、在山区、楼宇等狭小复杂的环境中飞行等。基于这些优势,无人直升机被广泛应用于航拍、救援、探测和其他任务。然而,无人直升机是一个高度非线性、欠驱动、强耦合的***。此外,它的飞行性能很容易受到干扰的影响,如阵风。因此,设计一种高性能的飞行控制器成为一项具有挑战性的研究课题。
目前,无人直升机***的控制方法主要有线性控制和非线性控制两种。传统的控制方法主要基于线性化数学模型。但模型的线性化发生在平衡点处,当***状态偏离平衡点时,控制器性能将大幅降低。为了克服线性控制方法的不足,越来越多的非线性控制方法被用于无人直升机控制,如滑模控制、反步控制、模型预测控制等。然而这些方法只能保证闭环***的渐近稳定。
文献(I.A.Raptis,K.P.Valavanis,W.A.Moreno,A novel nonlinearbackstepping controller design for helicopters using the rotation matrix,IEEETransactions on Control Systems Technology,vol.19,no.2,2011,465–473.)提出在反步设计中引入嵌套饱和反馈函数,利用旋转矩阵的结构特性对姿态进行控制,使直升机跟踪预定的位置和偏航参考轨迹。文献(K.Yan,Q.Wu,M.Chen,Robust adaptivebackstepping control for unmanned autonomous helicopter with flappingdynamics,2017 13th IEEE International Conference on Control&Automation(ICCA),2017,pp.1027–1032.)提出了一种具有挥舞动力学的无人驾驶自主直升机的鲁棒自适应反步控制器,设计了非线性干扰观测器估测外界未知干扰。该文设计的控制器处理了外界未知干扰的影响。但是只证明了闭环***的所有信号是一致有界稳定的。
发明内容
考虑到无人直升机***的高度非线性、欠驱动、强耦合特征,本发明提供一种无人直升机的有限时间高度和姿态跟踪控制方法,是一种将有限时间干扰观测器技术和加幂积分方法结合起来的复合抗干扰高度和姿态有限时间跟踪控制方法,使无人直升机***具有有限时间的跟踪性能和强抗干扰性能。
本发明为解决上述技术问题采用以下技术方案:
本发明提供一种无人直升机的有限时间高度和姿态跟踪控制方法,包括以下步骤:
步骤一:考虑挥舞模型和时变干扰,建立高度和姿态综合模型;
所述高度和姿态综合模型为:
其中:Θ=[ηT z]T, Uz=-CθCφTm,m为无人直升机的质量,g、η=[φ θ ψ]T∈R3、z及Vz分别表示无人直升机在惯性坐标系下的重力加速度、姿态、高度及高度对应的线速度,ωb=[p q r]T∈R3表示无人直升机在机体坐标系下的姿态角速度,p、q、r分别为滚转角速度、俯仰角速度、偏航角速度;为姿态向量变换矩阵,φ、θ和ψ分别无人直升机的滚转角、俯仰角和偏航角,Sφ、Cφ、Cθ、Sθ和Tθ分别表示sinφ、cosφ、cosθ、sinθ和tanθ,J=diag{Ixx Iyy Izz}为惯性矩阵,Ixx,Iyy,Izz分别为无人直升机绕x,y,z轴的转动惯量;a和b分别为主旋翼的纵向和横向挥舞角,分别由纵向输入信号δlon和横向输入信号δlat控制;Alon和Blat分别为控制输入信号到主旋翼纵向挥舞角和横向挥舞角的有效增益,Ac和Bd分别为主旋翼和副翼的耦合系数,c和d分别为副翼的纵向和横向挥舞角,Clon和Dlat分别为控制输入信号到副翼纵向和横向挥舞角的有效增益;τf和τs均为时间常数;τb为主旋翼和尾翼生成的力矩,Tm和Tt分别为主旋翼产生的合力和尾翼产生的合力;Cma,Cmb均为与主转子刚度有关的物理参数;zm和zt分别为主旋翼和尾翼旋转轴到直升机重心的z轴轴向距离,xt为尾翼旋转轴到直升机重心的x轴轴向距离;为主旋翼旋转产生的总力矩,和均是与主旋翼的反扭矩的产生相关的正常数;D=[(Jdω)T mdvz]T,dω=[dp dq dr]T代表作用于无人直升机***姿态通道的时变干扰,dvz代表作用于无人直升机***竖直方向速度通道的时变干扰,dp、dq、dr分别为作用于滚转角、俯仰角、偏航角速度通道的干扰;
步骤二:构建有限时间干扰观测器估计未知的时变干扰,获取干扰估计值;
令p=χ1,q=χ2,r=χ3,Vz=χ4,dp=d1,dq=d2,dr=d3,dvz=d4,对n阶可微的干扰di有一个已知的Lipschitz常数Li>0,所述有限时间干扰观测器为:
其中,当i=1,2,3,4时,λi,j为正的观测器增益,j=0,1,2,分别是χi、di、的估计值,sgn(·)为符号函数,y1=[Tmbzm-Ttzt+Cmbb-qr(Izz-Iyy)]/Ixx+d1,y2=[Tmazm+Cmaa-pr(Ixx-Izz)]/Iyy+d2,y3=[Ttxt-Qm-pq(Iyy-Ixx)]/Izz+d3,y4=(mg-CθCφTm)/m+d4;
步骤三:基于步骤二所得的干扰估计值,设计高度和姿态复合抗干扰有限时间跟踪控制器,进行干扰补偿和高度、姿态的跟踪;
所述高度和姿态复合抗干扰有限时间跟踪控制器为:
其中,α=α1/α2∈(1,2),α1、α2均为正奇数,Θref=[φref θref ψref zref]T,φref、θref和ψref分别为期望的滚转角、俯仰角和偏航角,zref为期望的高度;e1=Θ-Θref=[eφ eθ eψez]T,eφ为滚转角跟踪误差,eθ为俯仰角跟踪误差,eψ为偏航角跟踪误差,ez为高度跟踪误差;ea=a-aref和eb=b-bref分别为纵向挥舞角和横向挥舞角误差,aref和bref分别为期望的主旋翼的纵向和横向挥舞角,k1,1,k1,2,k1,3,k1,4,k2,1,k2,2,k2,3,k2,4,k3,k4为控制器增益;
步骤四:选取观测器增益和控制器增益,通过高度和姿态复合抗干扰有限时间跟踪控制器实现无人直升机高度和姿态闭环跟踪***的有限时间稳定。
作为本发明的进一步技术方案,步骤四中选取的观测器增益和控制器增益为:
k1,1>0,k1,2>0,k1,3>0,k1,4>0;
令
h1,3=(2-1/α)2(1-1/α)k1,3 1+α,h1,4=(2-1/α)2(1-1/α)k1,4 1+α,
则k2,1,k2,2,k2,3,k2,4满足k2,1/h1,1-ρ1,1>0,k2,2/h1,2-ρ1,2>0,k2,3/h1,3-ρ1,3>0,k2,4/h1,4-ρ1,4>0,k3,k4满足k3>0,k4>0,i=1,2,3,4,j=0,1,2,λi,j>0。
作为本发明的进一步技术方案,步骤三中aref和bref的表达式分别为:
作为本发明的进一步技术方案,步骤二中观测器相应的观测误差***为:
其中,
技术效果
本发明提出的技术方案相比于已有的技术,产生下述技术效果:
(一)设计的高阶微分有限时间干扰观测器可用于观测常值干扰、斜坡干扰、高阶干扰、正弦干扰等多种形式的干扰及其各阶导数,并使观测误差在有限时间内收敛到0,具有通用性。
(二)将有限时间观测器技术和加幂积分方法结合,设计的复合抗干扰有限时间控制器可有效处理干扰对***造成的负面影响,使高度和姿态跟踪误差在有限时间内收敛到0。
(三)本发明所提出的复合抗干扰有限时间控制技术思想适用于其他技术领域的***控制设计,应用前景广阔。
附图说明
图1为无人直升机高度和姿态闭环***控制框图;
图2为技术方案的步骤流程图;
图3为无人直升机的坐标系结构图;
图4为姿态和高度跟踪误差响应图,其中,(a)为滚转角,(b)为俯仰角,(c)为偏航角,(d)为高度;
图5为姿态和高度实际位置与期望位置的对比曲线,其中,(a)为滚转角,(b)为俯仰角,(c)为偏航角,(d)为高度;
图6为观测误差响应图,其中,(a)为滚转角速度通道的干扰,(b)为俯仰角速度通道的干扰,(c)为偏航角速度通道的干扰,(d)为高度速度通道的干扰;
图7为干扰实际值与观测值的对比图,其中,(a)为滚转角速度通道的干扰,(b)为俯仰角速度通道的干扰,(c)为偏航角速度通道的干扰,(d)为高度速度通道的干扰;
图8为控制信号变化图,其中,(a)为Tm,(b)为Tt,(c)为δlon,(d)为δlat。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
步骤一:依次给出无人直升机的6自由度模型、挥舞模型、力与力矩的计算,再综合得到考虑干扰的高度与姿态模型。
(a)6自由度的无人直升机模型为:
其中,m表示无人直升机的质量,g、P=[x y z]T∈R3、η=[φ θ ψ]T∈R3和V=[VxVy Vz]T∈R3分别表示其在惯性坐标系下的重力加速度、位置、姿态和线速度;ωb=[p q r]T∈R3和fb=[fx fy fz]T∈R3、τb=[τx τy τz]T∈R3分别表示其在机体坐标系下的姿态角速度和所受的力、力矩;p、q、r分别为滚转角速度、俯仰角速度、偏航角速度。而由机体坐标系到惯性坐标系的变换矩阵定义为φ、θ和ψ分别无人直升机的滚转角、俯仰角和偏航角,Sφ、Cφ、Cθ、Sθ和Tθ分别表示sinφ、cosφ、cosθ、sinθ和tanθ。姿态向量变换矩阵一般飞行时俯仰角保持在因此H非奇异。J=diag{Ix Iy Iz}为惯性矩阵,Ixx,Iyy,Izz为无人直升机绕x,y,z轴的转动惯量。
(b)挥舞模型
主旋翼挥舞模型为:
副翼挥舞模型为:
其中,τf,τs均为时间常数,a,b为主旋翼的纵向和横向挥舞角,分别由纵向输入信号δlon和横向输入信号δlat控制。Alon,Blat为控制输入信号到主旋翼纵向和横向挥舞角的有效增益,Ac,Bd为主旋翼和副翼的耦合系数,c,d为副翼的纵向和横向挥舞角,Clon,Dlat为控制输入信号到副翼纵向和横向挥舞角的有效增益。
(c)力与力矩的计算
因a,b很小,满足sina≈a,sinb≈,cosa≈1,cosb≈1,高度控制时无人直升机在x,y方向所受的力远小于z方向的力,因此fb=[0 0 -Tm]T,主旋翼和尾翼生成的力矩为Tm,Tt分别为主旋翼产生的合力和尾翼产生的合力。Cma,Cmb是与主转子刚度有关的物理参数。zm,zt分别为主旋翼和尾翼旋转轴到直升机重心的z轴轴向距离;xt为尾翼旋转轴到直升机重心的x轴轴向距离。Qm=CMQ·Tm 3/2+DMQ为主旋翼旋转产生的总力矩,CMQ,DMQ是与主旋翼的反扭矩的产生相关的正常数。
(d)高度和姿态综合模型
令Θ=[ηT z]T, Uz=-CθCφTm。
考虑主旋翼和副翼的挥舞动态特性,建立无人直升机的高度和姿态综合模型为:
其中,D=[(Jdω)T mdvz]T,dω=[dp dq dr]T代表作用于无人直升机***姿态通道的时变干扰,dvz代表作用于无人直升机***竖直方向速度通道的时变干扰,dp、dq、dr分别为作用于滚转角、俯仰角、偏航角速度通道的干扰。
步骤二:设计有限时间干扰观测器,得到干扰估计值及其导数估计值。
为便于表示,令p=χ1,q=χ2,r=χ3,Vz=χ4,dp=d1,dq=d2,dr=d3,dvz=d4。对n阶可微的di(i=1,2,3,4)有一个已知的Lipschitz常数Li>0,设计如下的有限时间干扰观测器:
说明:i=1,2,3,4时,分别是的估计值,函数而sgn(·)为标准的符号函数。y1=[Tmbzm-Ttzt+Cmbb-qr(Izz-Iyy)]/Ixx+d1,y2=[Tmazm+Cmaa-pr(Ixx-Izz)]/Iyy+d2,y3=[Ttxt-Qm-pq(Iyy-Ixx)]/Izz+d3,y4=(mg-CθCφTm)/m+d4。λi,j(j=0,1,2)为待设计的正观测器增益。
相应的观测误差***为:
其中,为观测误差,选取合适的观测器增益λi,j(j=0,1,2),可使观测误差在有限时间T1收敛到零。式(5)形式的有限时间观测器适用于常值、斜坡、高阶、正弦等形式的干扰。
步骤三:将步骤二中得到的干扰及其导数估计值用于前馈补偿,结合有限时间观测器技术和加幂积分方法,设计复合抗干扰高度和姿态有限时间跟踪控制器,使高度和姿态跟踪误差有限时间收敛到0。
控制信号Tm,Tt,δlon,δlat的具体形式如下:
其中α=α1/α2∈(1,2),α1、α2为正奇数,Θref=[φref θref ψref zref]T为期望姿态和高度,φref、θref和ψref分别为期望的滚转角、俯仰角和偏航角,zref为期望的高度;e1=Θ-Θref=[eφ eθ eψ ez]T为跟踪误差,eφ为滚转角跟踪误差,eθ为俯仰角跟踪误差,eψ为偏航角跟踪误差,ez为高度跟踪误差;ea=a-aref,eb=b-bref分别为纵向挥舞角和横向挥舞角误差。aref,bref分别设计为:
k1,1,k1,2,k1,3,k1,4,k2,1,k2,2,k2,3,k2,4,k3,k4为待设计的增益。
步骤四:按设计规则选取适当的控制器增益和观测器增益,实现无人直升机高度和姿态闭环跟踪***的有限时间稳定。
步骤四中选取的观测器增益和控制器增益为:
k1,1>0,k1,2>0,k1,3>0,k1,4>0;
令
h1,3=(2-1/α)2(1-1/α)k1,3 1+α,h1,4=(2-1/α)2(1-1/α)k1,4 1+α,
则k2,1,k2,2,k2,3,k2,4满足k2,1/h1,1-ρ1,1>0,k2,2/h1,2-ρ1,2>0,k2,3/h1,3-ρ1,3>0,k2,4/h1,4-ρ1,4>0,k3,k4满足k3>0,k4>0,i=1,2,3,4,j=0,1,2,λi,j>0。
针对带有未知干扰的高度和姿态模型,如果设计的控制器如公式(7)至(10),则可实现有限时间稳定,即高度跟踪误差和姿态跟踪误差在有限时间T2收敛到零。
为了验证本发明所提出的高度和姿态有限时间跟踪控制方法的有效性,用MATLAB进行了数值仿真。
无人直升机的初始状态为η0=[0.5 0.5 0.5]Trad,z0=2m,期望的姿态角和高度为ηref=[0.5sint 0.5sint 0.5sint]Trad,zref=5m,干扰表达式设为d1=2.5sin(0.3t+30),d2=1.2sin(0.5t+15),d3=1.8sin(0.2t+30),d4=1.8sin(0.9t+15)。图4中(a)至(d)显示了在干扰存在的情况下,姿态和高度跟踪误差都能较快地收敛到0,图5中(a)至(d)为姿态和高度实际位置与期望位置的对比曲线,图6中(a)至(d)显示了观测误差***的跟踪性能,各干扰观测误差都能快速精确地收敛到0,图7中(a)至(d)显示了干扰实际值与观测值的对比,图8中(a)至(d)显示了各控制输入信号的变化曲线。仿真结果表明,本发明设计的高度和姿态复合抗干扰有限时间跟踪控制器是有效的。
以上实施只为阐释本发明的技术思想,不可因此限定本发明的保护范围。值得注意的是,在本发明的技术思想上对技术方案做出的任何改进,均属于本发明的保护范围。
Claims (4)
1.一种无人直升机的有限时间高度和姿态跟踪控制方法,其特征在于,包括以下步骤:
步骤一:考虑挥舞模型和时变干扰,建立高度和姿态综合模型;
所述高度和姿态综合模型为:
其中:Θ=[ηT z]T, Uz=-CθCφTm,m为无人直升机的质量,g、η=[φ θ ψ]T∈R3、z及Vz分别表示无人直升机在惯性坐标系下的重力加速度、姿态、高度及高度对应的线速度,ωb=[p q r]T∈R3表示无人直升机在机体坐标系下的姿态角速度,p、q、r分别为滚转角速度、俯仰角速度、偏航角速度;为姿态向量变换矩阵,φ、θ和ψ分别无人直升机的滚转角、俯仰角和偏航角,Sφ、Cφ、Cθ、Sθ和Tθ分别表示sinφ、cosφ、cosθ、sinθ和tanθ,J=diag{Ixx Iyy Izz}为惯性矩阵,Ixx,Iyy,Izz分别为无人直升机绕x,y,z轴的转动惯量;a和b分别为主旋翼的纵向和横向挥舞角,分别由纵向输入信号δlon和横向输入信号δlat控制;Alon和Blat分别为控制输入信号到主旋翼纵向挥舞角和横向挥舞角的有效增益,Ac和Bd分别为主旋翼和副翼的耦合系数,c和d分别为副翼的纵向和横向挥舞角,Clon和Dlat分别为控制输入信号到副翼纵向和横向挥舞角的有效增益;τf和τs均为时间常数;τb为主旋翼和尾翼生成的力矩,Tm和Tt分别为主旋翼产生的合力和尾翼产生的合力;Cma,Cmb均为与主转子刚度有关的物理参数;zm和zt分别为主旋翼和尾翼旋转轴到直升机重心的z轴轴向距离,xt为尾翼旋转轴到直升机重心的x轴轴向距离;Qm=CMQTm 3/2+DMQ为主旋翼旋转产生的总力矩,CMQ和DMQ是与主旋翼的反扭矩的产生相关的正常数;D=[(Jdω)T mdvz]T,dω=[dpdq dr]T代表作用于无人直升机***姿态通道的时变干扰,dp、dq、dr分别为作用于滚转角、俯仰角、偏航角速度通道的干扰,dvz代表作用于无人直升机***竖直方向速度通道的时变干扰;
步骤二:构建有限时间干扰观测器估计未知的时变干扰,获取干扰估计值;
令p=χ1,q=χ2,r=χ3,Vz=χ4,dp=d1,dq=d2,dr=d3,dvz=d4,对n阶可微的干扰di有一个已知的Lipschitz常数Li>0,所述有限时间干扰观测器为:
其中,当i=1,2,3,4时,λi,j为正的观测器增益,j=0,1,2,分别是χi、di、的估计值,sgn(·)为符号函数,y1=[Tmbzm-Ttzt+Cmbb-qr(Izz-Iyy)]/Ixx+d1,y2=[Tmazm+Cmaa-pr(Ixx-Izz)]/Iyy+d2,y3=[Ttxt-Qm-pq(Iyy-Ixx)]/Izz+d3,y4=(mg-CθCφTm)/m+d4;
步骤三:基于步骤二所得的干扰估计值,设计高度和姿态复合抗干扰有限时间跟踪控制器,进行干扰补偿和高度、姿态的跟踪;
所述高度和姿态复合抗干扰有限时间跟踪控制器为:
其中,α=α1/α2∈(1,2),α1、α2均为正奇数,Θref=[φref θref ψref zref]T,φref、θref和ψref分别为期望的滚转角、俯仰角和偏航角,zref为期望的高度;e1=Θ-Θref=[eφ eθ eψez]T,eφ为滚转角跟踪误差,eθ为俯仰角跟踪误差,eψ为偏航角跟踪误差,ez为高度跟踪误差;ea=a-aref和eb=b-bref分别为纵向挥舞角和横向挥舞角误差,aref和bref分别为期望的主旋翼的纵向和横向挥舞角,k1,1,k1,2,k1,3,k1,4,k2,1,k2,2,k2,3,k2,4,k3,k4为控制器增益;
步骤四:选取观测器增益和控制器增益,通过高度和姿态复合抗干扰有限时间跟踪控制器实现无人直升机高度和姿态闭环跟踪***的有限时间稳定。
2.如权利要求1所述的一种无人直升机的有限时间高度和姿态跟踪控制方法,其特征在于,步骤四中选取的观测器增益和控制器增益为:
k1,1>0,k1,2>0,k1,3>0,k1,4>0;
令
h1,3=(2-1/α)2(1-1/α)k1,3 1+α,h1,4=(2-1/α)2(1-1/α)k1,4 1+α,
则k2,1,k2,2,k2,3,k2,4满足k2,1/h1,1-ρ1,1>0,k2,2/h1,2-ρ1,2>0,k2,3/h1,3-ρ1,3>0,k2,4/h1,4-ρ1,4>0,k3,k4满足k3>0,k4>0,i=1,2,3,4,j=0,1,2,λi,j>0。
3.如权利要求1所述的一种无人直升机的有限时间高度和姿态跟踪控制方法,其特征在于,步骤三中aref和bref的表达式分别为:
4.如权利要求1所述的一种无人直升机的有限时间高度和姿态跟踪控制方法,其特征在于,步骤二中观测器相应的观测误差***为:
其中,ei,0=χ1-ξi,0,ei,1=di-ξi,1,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910670427.5A CN110377044B (zh) | 2019-07-24 | 2019-07-24 | 一种无人直升机的有限时间高度和姿态跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910670427.5A CN110377044B (zh) | 2019-07-24 | 2019-07-24 | 一种无人直升机的有限时间高度和姿态跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110377044A true CN110377044A (zh) | 2019-10-25 |
CN110377044B CN110377044B (zh) | 2022-03-25 |
Family
ID=68255467
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910670427.5A Active CN110377044B (zh) | 2019-07-24 | 2019-07-24 | 一种无人直升机的有限时间高度和姿态跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110377044B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111176306A (zh) * | 2020-01-24 | 2020-05-19 | 西北工业大学 | 一种水下航行器变增益自抗扰纵向控制方法 |
CN111258333A (zh) * | 2020-02-12 | 2020-06-09 | 上海大学 | 大长径比掠海飞行器复杂海况下的定高路径跟踪方法 |
CN114185357A (zh) * | 2021-11-19 | 2022-03-15 | 合肥中科融道智能科技有限公司 | 基于自适应有限时间模糊***的电力巡检无人机姿态跟踪控制方法 |
CN114879713A (zh) * | 2022-05-26 | 2022-08-09 | 南京航空航天大学 | 基于干扰观测器的小型无人直升机离散时间轨迹跟踪控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005289127A (ja) * | 2004-03-31 | 2005-10-20 | Nagasaki Prefecture | 飛行装置の姿勢位置制御システムおよび姿勢位置制御装置 |
CN105607473A (zh) * | 2015-11-20 | 2016-05-25 | 天津大学 | 小型无人直升机的姿态误差快速收敛自适应控制方法 |
CN107102544A (zh) * | 2017-04-28 | 2017-08-29 | 大连海事大学 | 基于扰动观测器的全局有限时间航迹跟踪控制方法 |
CN107247411A (zh) * | 2017-06-15 | 2017-10-13 | 大连海事大学 | 基于扰动观测器的非奇异终端滑模航迹跟踪控制方法 |
CN109062042A (zh) * | 2018-08-01 | 2018-12-21 | 吉林大学 | 一种旋翼飞行器的有限时间航迹跟踪控制方法 |
CN109991991A (zh) * | 2019-02-26 | 2019-07-09 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪方法 |
-
2019
- 2019-07-24 CN CN201910670427.5A patent/CN110377044B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005289127A (ja) * | 2004-03-31 | 2005-10-20 | Nagasaki Prefecture | 飛行装置の姿勢位置制御システムおよび姿勢位置制御装置 |
CN105607473A (zh) * | 2015-11-20 | 2016-05-25 | 天津大学 | 小型无人直升机的姿态误差快速收敛自适应控制方法 |
CN107102544A (zh) * | 2017-04-28 | 2017-08-29 | 大连海事大学 | 基于扰动观测器的全局有限时间航迹跟踪控制方法 |
CN107247411A (zh) * | 2017-06-15 | 2017-10-13 | 大连海事大学 | 基于扰动观测器的非奇异终端滑模航迹跟踪控制方法 |
CN109062042A (zh) * | 2018-08-01 | 2018-12-21 | 吉林大学 | 一种旋翼飞行器的有限时间航迹跟踪控制方法 |
CN109991991A (zh) * | 2019-02-26 | 2019-07-09 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪方法 |
Non-Patent Citations (3)
Title |
---|
CHAO REN,ET AL.: "Height and attitude control for small unmanned helicopter with uncertainties and disturbances", 《2017 36TH CHINESE CONTROL CONFERENCE》 * |
LING HAN,ET AL.: "Height and attitude tracking control of an unmanned helicopter via a HDOB-backstepping composite control method", 《THE JOURNAL OF ENGINEERING》 * |
何海军等: "四旋翼飞行器姿态轨迹跟踪控制仿真研究", 《计算机仿真》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111176306A (zh) * | 2020-01-24 | 2020-05-19 | 西北工业大学 | 一种水下航行器变增益自抗扰纵向控制方法 |
CN111176306B (zh) * | 2020-01-24 | 2022-10-14 | 西北工业大学 | 一种水下航行器变增益自抗扰纵向控制方法 |
CN111258333A (zh) * | 2020-02-12 | 2020-06-09 | 上海大学 | 大长径比掠海飞行器复杂海况下的定高路径跟踪方法 |
CN111258333B (zh) * | 2020-02-12 | 2021-03-23 | 上海大学 | 大长径比掠海飞行器复杂海况下的定高路径跟踪方法 |
CN114185357A (zh) * | 2021-11-19 | 2022-03-15 | 合肥中科融道智能科技有限公司 | 基于自适应有限时间模糊***的电力巡检无人机姿态跟踪控制方法 |
CN114185357B (zh) * | 2021-11-19 | 2022-06-10 | 合肥中科融道智能科技有限公司 | 基于自适应有限时间模糊***的电力巡检无人机姿态跟踪控制方法 |
CN114879713A (zh) * | 2022-05-26 | 2022-08-09 | 南京航空航天大学 | 基于干扰观测器的小型无人直升机离散时间轨迹跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110377044B (zh) | 2022-03-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhang et al. | A novel control scheme for quadrotor UAV based upon active disturbance rejection control | |
CN110377044A (zh) | 一种无人直升机的有限时间高度和姿态跟踪控制方法 | |
Zhu et al. | Airship horizontal trajectory tracking control based on active disturbance rejection control (ADRC) | |
Chang et al. | Obstacle avoidance and active disturbance rejection control for a quadrotor | |
Huang et al. | Adaptive tracking control of underactuated quadrotor unmanned aerial vehicles via backstepping | |
CN107479567A (zh) | 动态特性未知的四旋翼无人机姿态控制器及方法 | |
Rodic et al. | Control of a Quadrotor Flight | |
CN105607473B (zh) | 小型无人直升机的姿态误差快速收敛自适应控制方法 | |
CN109696830A (zh) | 小型无人直升机的强化学习自适应控制方法 | |
Oh et al. | Dynamics and control of a helicopter carrying a payload using a cable-suspended robot | |
CN103853157A (zh) | 一种基于自适应滑模的飞行器姿态控制方法 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN104950901A (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
Islam et al. | Adaptive sliding mode control design for quadrotor unmanned aerial vehicle | |
CN104932514A (zh) | 小型无人直升机的姿态非线性自适应控制方法 | |
CN106802570B (zh) | 一种无人直升机位置跟踪的方法与装置 | |
Islam et al. | Adaptive sliding mode control of unmanned four rotor flying vehicle | |
CN109885074A (zh) | 四旋翼无人机有限时间收敛姿态控制方法 | |
CN111459188A (zh) | 一种基于四元数的多旋翼非线性飞行控制方法 | |
Yu et al. | Robust backstepping tracking control of uncertain MIMO nonlinear systems with application to quadrotor UAVs | |
Zhang et al. | Quadrotor aircraft control without velocity measurements | |
Etemadi | Mathematical dynamics, kinematics modeling and PID equation controller of quadcopter | |
CN112764426A (zh) | 一种四旋翼无人机***的内模抗扰控制方法 | |
Amlashi et al. | Robust second order sliding mode control for a quadrotor considering motor dynamics | |
Ma et al. | Finite-time trajectory tracking control of quadrotor UAV via adaptive RBF neural network with lumped uncertainties |
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 |