CN113419565A - 四旋翼飞行器预设性能轨迹跟踪反演控制方法及*** - Google Patents
四旋翼飞行器预设性能轨迹跟踪反演控制方法及*** Download PDFInfo
- Publication number
- CN113419565A CN113419565A CN202110634707.8A CN202110634707A CN113419565A CN 113419565 A CN113419565 A CN 113419565A CN 202110634707 A CN202110634707 A CN 202110634707A CN 113419565 A CN113419565 A CN 113419565A
- Authority
- CN
- China
- Prior art keywords
- variable
- control
- performance
- error
- function
- 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 37
- 230000009466 transformation Effects 0.000 claims abstract description 11
- 230000006870 function Effects 0.000 claims description 58
- 230000003864 performance function Effects 0.000 claims description 38
- 238000006243 chemical reaction Methods 0.000 claims description 16
- 230000008569 process Effects 0.000 claims description 10
- 238000009795 derivation Methods 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 4
- 238000012546 transfer Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000012938 design process Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 11
- 230000008878 coupling Effects 0.000 abstract description 7
- 238000010168 coupling process Methods 0.000 abstract description 7
- 238000005859 coupling reaction Methods 0.000 abstract description 7
- 230000001052 transient effect Effects 0.000 abstract description 6
- 238000007796 conventional method Methods 0.000 description 12
- 238000004088 simulation Methods 0.000 description 8
- 238000013461 design Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 2
- 239000000126 substance Substances 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 241000764238 Isis Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 244000145845 chattering Species 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000036544 posture Effects 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 238000012795 verification 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/12—Target-seeking control
-
- 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
- Y02T90/00—Enabling 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)
- Feedback Control In General (AREA)
Abstract
本发明涉及四旋翼飞行器预设性能轨迹跟踪反演控制方法及***,该方法首先将欠驱动耦合特性的飞控***动力学模型进行解耦,构造出位置环和姿态环的双闭环控制结构;再依据有限时间性能函数对飞控***变量误差进行坐标变换,转换成具有稳态和动态性能要求的***变量;然后运用反演控制算法结合非线性指数观测器估计综合干扰,以此得出具备较强鲁棒性能的总控制律,从而实现出既定控制目标。与常规性能预设性能函数反演控制方法对比可知,此控制方法进一步增强了四旋翼飞行器轨迹跟踪的暂态和稳态性能,对干扰具有更强的鲁棒性。
Description
技术领域
本发明涉及飞行器控制技术领域,尤其是涉及四旋翼飞行器预设性能轨迹跟踪反演控制方法及***。
背景技术
近年来,四旋翼飞行器因其优越的低空飞行性能和特种应用背景,已经在军事、农业、工业等国民生活领域中发挥出重要作用。四旋翼飞行器本体一般由十字形支架终端的四个电机带动旋翼提供升力,通过四个电机转速实现空间[x,y,z]T三位置和三位置夹角[φ,θ,ψ]T的6自由度位姿控制。因此,其动力学模型是个典型的非线性、强耦合、欠驱动不确定性***。要求在复杂多变的飞行环境中,在预定性能范围内,稳定快速精准地跟踪目标轨迹并有较强鲁棒性是控制过程中的难点。
目前已公开的专利技术大多涉及的是四旋翼飞行器的控制稳态性能或者是动态性能方面的控制方法,让四旋翼飞行器的轨迹跟踪兼顾暂态性和稳态性是一种新型的控制方法,因此本发明涉及到四旋翼飞行器高精度轨迹跟踪方法,即通过有限时间预设性能反演控制算法使得飞行器的轨迹在优越动态性能同时较高精度的进入预定的稳态紧集域。
发明内容
本发明所要解决的技术问题是提供一种四旋翼飞行器预设性能轨迹跟踪反演控制方法,该方法能够在预定的暂态和稳态性能前提下使四旋翼飞行器高精度地跟踪期望轨迹,并运用一种指数型非线性观测器处理飞行器飞行过程中的综合干扰,再将综合干扰结合到预设性能反演控制律中提高控制过程的鲁棒性能。
本发明所采用的技术方案是,四旋翼飞行器预设性能轨迹跟踪反演控制方法,该方法包括下列步骤:
(1)、求取四旋翼飞行器理想情况下的原始位姿动力学模型:选取地表某固定位置为大地坐标系原点建立大地坐标系Θ={O-XYZ},以此建立空间飞行坐标系
Ω={Oa-XaYaZa},飞行器质心相对于大地坐标系原点的位置向量为[x,y,z],其姿态分别是滚转角、俯仰角以及偏航角,记为姿态向量[φ,θ,ψ],求得四旋翼飞行器控制***理想情况下的原始位姿动力学模型:其中,x为位置环中x轴对应的变量,y为位置环中y轴对应的变量,z为位置环中z轴对应的变量,θ为姿态环中俯仰角对应的变量,ψ为姿态环中偏航角对应的变量,σ为姿态环中滚转角对应的变量;ui(i=1,…,4)为实际输入控制器的控制律,其对应为前后左右四个旋翼电机的电压;Ki(i=1,2,…,6)为空气阻力系数;m是飞行器质量;l为飞行器机臂长度;Ix,Iy,Iz表示飞行器相对于机体坐标轴的转动惯量;g为重力加速度,取g=9.8m/s2;
(2)、定义虚拟控制变量项为:将步骤(1)中的原始位姿动力学模型进行解耦,解耦出的四旋翼飞行器控制***的模型为包括位置环和姿态环的双闭环控制结构模型,其中位置环为外环,姿态环为内环;所述双闭环控制结构模型为:其中,di(i=1,2,…,6)
(3)、根据步骤(2)中得到的双闭环控制结构模型,由四旋翼飞行器的期望偏航角ψd,求解出四旋翼飞行器的期望俯仰角θd和期望滚转角φd:
(4)、设计出步骤(2)中双闭环控制结构模型中干扰项的指数型非线性观测器;
(5)、令四旋翼飞行器期望的位姿向量为:pd=[xd,yd,zd,ψd]T,而实际的位姿向量为:p=[x,y,z,ψ]T,则四旋翼飞行器控制***的***误差函数为:e(t)=pd-p;根据有限时间预设性能函数对控制***的***误差函数进行坐标变换,转换成具有稳态性能和动态性能要求的***变量;
(6)、利用反演控制算法结合步骤(4)中的非线性指数观测器来估计出综合干扰变量,以此得出实际输入控制器的控制律。
本发明的有益效果是:本发明针对现有技术中四旋翼飞行器飞行中的综合干扰和控制模型的欠驱动难题,通过解耦出飞控***双闭环结构,并在此基础上设计出姿态环和位置环的新型预设性能反演控制算法,突出了具有预定性能的暂态和稳态跟踪性能,实现四旋翼飞行器高精度高性能轨迹跟踪控制目标。与常规预设性能函数反演控制方法对比,本发明控制方法进一步增强了四旋翼飞行器轨迹跟踪的暂态和稳态性能,并且对干扰具有更强的鲁棒性。
作为优选,步骤(5)中,有限时间性能函数表示为:
作为优选,步骤(5)中,根据有限时间预设性能函数对控制***的***误差函数进行坐标变换,转换成具有稳态性能和动态性能要求的***变量的具体过程包括下列步骤:
(5.1)、根据有限时间预设性能函数,***误差函数要求在预先设定的动态和稳态范围内收敛到零,并且收敛的动态时间与初始值无关且在有限时间内,则设定***误差函数的约束不等式为:-ρ(t)<e(t)<ρ(t);
(5.2)、利用误差转换函数对步骤(5.1)中的约束不等式进行处理,转换为误差函数等式:e(t)=ρ(t)ftran(ε(t)),其中,ε(t)是被转换后的误差,ftran(ε(t))为误差转换函数,ftran(ε(t))选取双曲正切函数,表示为:
(5.4)、对转换后的误差函数等式进行求导,得到:
作为优选,在步骤(6)中,运用反演控制算法结合步骤(4)中的非线性指数观测器来估计出综合干扰变量,以此得出控制器的控制律的具体方法包括下列步骤:
(6-1)、对位置环中变量x对应的控制律进行设计:
(6-1-3)、根据步骤(6-1-2)中的求导式来得到位置环中变量x对应的控制律为:
(6-2)、根据步骤(6-1)中对位置环中变量x对应的控制律进行设计的过程,同理可得出位置环中变量y对应的控制律为:
(6-3)、根据步骤(6-1)中对位置环中变量x对应的控制律进行设计的过程,同理可得出位置环中变量z对应的控制律为:
(6-4)、根据步骤(2)中定义的虚拟控制变量项以及步骤(6-1)~(6-3)中求取的位置环中x,y,z变量对应的控制律,可以解得实际输入控制器的控制律u1为:
u1=(u1z+g)·m/cosφcosθ;
(6-5)、对姿态环中变量θ对应的控制器的控制律进行设计:
(6-6)、根据步骤(6-5),同理得出实际输入控制器的控制律u3为:
αψ为姿态环中变量ψ对应的控制律;
(6-7)、根据步骤(6-5),同理得出实际输入控制器的控制律u4:
一种四旋翼飞行器预设性能轨迹跟踪反演控制***,包括四旋翼飞行器模型以及由四旋翼飞行器模型解耦得到的双闭环控制结构模型,所述双闭环控制结构模型包括位置环以及姿态环,所述位置环包括有限时间预设性能反演位置控制器以及模型反解模块,所述姿态环包括有限时间预设性能反演姿态控制器,采用上述四旋翼飞行器预设性能轨迹跟踪反演控制***,能够具有预定性能的暂态和稳态跟踪性能,实现其高精度高性能轨迹跟踪控制目标。
附图说明
图1为本发明中四旋翼飞行器的结构示意图;
图2为本发明一种四旋翼飞行器预设性能轨迹跟踪反演控制***的结构示意图;
图3为本发明中有限时间预设性能函数与常规有限时间性能函数的收敛对比图;
图4为本发明中的飞行轨迹跟踪效果对比图;
图5为本发明中变量x的轨迹跟踪曲线与传统方法中变量x的轨迹跟踪曲线对比图;
图6为本发明中变量y的轨迹跟踪曲线与传统方法中变量y的轨迹跟踪曲线对比图;
图7为本发明中变量z的轨迹跟踪曲线与传统方法中变量z的轨迹跟踪曲线对比图;
图8为本发明中偏航角变量的轨迹跟踪曲线与传统方法中偏航角变量的轨迹跟踪曲线对比图;
图9为本发明中俯仰角变量的轨迹跟踪曲线与传统方法中俯仰角变量的轨迹跟踪曲线对比图;
图10为本发明中滚转角变量的轨迹跟踪曲线与传统方法中滚转角变量的轨迹跟踪曲线对比图;
图11为本发明中变量x的轨迹跟踪误差与传统方法中变量x的轨迹跟踪误差对比图;
图12为本发明中变量y的轨迹跟踪误差与传统方法中变量y的轨迹跟踪误差对比图;
图13为本发明中变量z的轨迹跟踪误差与传统方法中变量z的轨迹跟踪误差对比图;
图14为本发明中偏航角变量的轨迹跟踪误差与传统方法中偏航角变量的轨迹跟踪误差对比图;
图15为本发明中俯仰角变量的轨迹跟踪误差与传统方法中俯仰角变量的轨迹跟踪误差对比图;
图16为本发明中滚转角变量的轨迹跟踪误差与传统方法中滚转角变量的轨迹跟踪误差对比图。
具体实施方式
以下参照附图并结合具体实施方式来进一步描述发明,以令本领域技术人员参照说明书文字能够据以实施,本发明保护范围并不受限于该具体实施方式。
本发明从如下三个方面进行描述:
1.建立四翼飞控***的动力学模型,将此模型进行解耦,形成位置环为外环,姿态环为内环的控制结构,从而建立带综合干扰解耦后的控制动力学模型;
2.依据控制结构建立每个被控变量的轨迹跟踪误差,并建立误差的预设性能,运用一种全新的有限时间预设性能函数,给出新的误差坐标变换以此具有预设性能;
3.分别设计内外环控制器,根据反演控制基本原理,给出每个控制器的虚拟控制量,为处理综合干扰和耦合干扰,运用非线性指数观测器观测出综合干扰项,以此来设计出控制器,使其具有既定预设性能和较强的鲁棒性。
本发明涉及一种四旋翼飞行器预设性能轨迹跟踪反演控制方法,该方法包括下列步骤:
一、四旋翼飞行器如图1所示,选取地表某固定位置为大地坐标系原点,建立空间飞行坐标系,飞行器质心相对于原点的位置向量为[x,y,z]T,其姿态分别是滚转角、俯仰角及偏航角,记为姿态向量[φ,θ,ψ]T;
二、科学合理忽略飞行器的陀螺效应项与摩擦阻力项,得出四旋翼飞行器理想化的原始位姿动力学模型:
式中:x为位置环中x轴对应的变量,y为位置环中y轴对应的变量,z为位置环中z轴对应的变量,θ为姿态环中俯仰角对应的变量,ψ为姿态环中偏航角对应的变量,σ为姿态环中滚转角对应的变量;ui(i=1,…,4)为实际输入控制器的控制律,对应前后左右四个旋翼电机的电压;Ki(i=1,2,…,6)为空气阻力系数;m是飞行器质量;l为飞行器机臂长度;Ix,Iy,Iz表示飞行器相对于机体坐标轴的转动惯量;g为重力加速度,取g=9.8m/s2;图1中,四旋翼飞行器包括前旋翼、左旋翼、后旋翼以及右旋翼,u1对应前旋翼的电机电压,u2对应左旋翼的电机电压,u3对应后旋翼的电机电压,u4对应右旋翼的电机电压;
三、由式(1)可知:四旋翼飞行器有4个独立控制变量,6个被控变量,且位置和姿态呈现出较强的耦合特性,故此***是个经典的欠驱动强耦合复杂非线性***;针对其控制,将该***解耦成位置变量回路和姿态变量回路,姿态变量的控制是独立的回路,与位置变量无关,而位置变量却依赖姿态变量,故将整个***解耦成位置变量为外环,姿态变量为内环的双闭环控制结构,双闭环控制结构如图2所示;依据内外环结构,将式(1)动力学方程重新分解,定义式(1)中的虚拟控制变量项为:
解耦后的飞控子***模型为:
式中:di(i=1,2,…,6)为飞行器所受综合扰动,包括大气气流扰动、***未建模动态扰动和不确定性干扰;
值得注意的是,由于飞行器强耦合欠驱动特性,模型(3)仍然是在稳定位姿处较小位置和角度范围内线性化解耦后的结果;由模型(3)可知:控制量无法确保飞行器六自由度全变量跟踪控制,但此模型能确保***位置变量[x,y,z]T和偏航角ψ变量的轨迹独立跟踪控制;由此得出本文的控制目标为:设计快速轨迹跟踪预设性能反演控制器,实现四翼飞行器对期望输入[xd,yd,zd,ψd]T高精度地快速跟踪,同时确保俯仰角θ和滚转角φ稳定;
四、依据式(2)及图2的控制双闭环控制结构可知:由飞行器的期望偏航角ψd,可求解得飞行器的期望俯仰角θd和期望滚转角φd:
为了控制器算法设计,针对解耦后飞行器动力学模型(3)中的干扰,做出合理假设:干扰项di(i=1,2,…,6)及其一阶导数连续有界,即进一步地,扰动的变化率相对于四翼飞行器在飞行过程中的状态变化率是缓慢的,故相比较于状态量的快速变化而言,假设是合理的;
五、设计双闭环控制结构模型中干扰项的指数型非线性观测器:针对解耦后的四翼飞控***,分别设计位置子***和姿态子***的控制器,采用反演控制算法结合非线性指数干扰观测器对干扰项进行估计,从而完成综合控制器的设计,在此给出非线性指数观测器的引理:考虑带干扰的二阶非线性***:
六、有限时间预设性能函数的设定:在已有的飞行器控制文献中,主要集中于飞控***轨迹稳定跟踪控制,而对其轨迹跟踪的动态性能完全依赖所设计的控制器的动态性能,不能同时兼顾保证轨迹跟踪的稳定性和动态性;针对此控制目标,引入误差性能函数对飞控***的动态性能和稳态性能进行设定,定义性能函数如下:针对一个光滑连续函数ρ(t),若该函数具有如下性质:①ρ(t)>0;②③存在一个任意较小的正数④对于任意的t>T0,T0由所选参数决定,有则称该函数为有限时间预设性能函数(Finite-time convergence prescribed performance function,FTCPPF);
本控制器所选有限时间性能函数为:
值得注意的是,为避免性能函数(5)的奇异问题,选取的参数与常规预设性能控制算法中中的常规性能函数(Conventional-time convergence performancefunction,CTCPPF)ρ(t)=(ρ0-ρ∞)e-θt+ρ∞不同,式(5)能在有限时间内收敛到稳定值,两种性能函数性质如图3所示,FTC-PPF比CTC-PPF具有更快的“收紧”功能,能使误差变量更快地收敛到预设稳定区间;
七、对***误差进行转换:设***误差为e(t),按照预设性能要求,误差函数要求在预先设定的动态和稳态范围内收敛到零,并且收敛的动态时间与初始值无关且在有限时间内;为达到此目标,误差函数的约束不等式为:
-ρ(t)<e(t)<ρ(t) (6)
直接处理式(6)的难度较大,利用误差转换函数对不等式约束进行处理,将其设计成如下的误差变换等式:
e(t)=ρ(t)ftran(ε(t)) (7)
由式(7)与定义2可知,ε(t)是被转换后的偏差,此误差函数与原误差e(t)相关,且原偏差不等式(6)自动满足;在此选取误差转换函数为双曲正切函数:
对转换后的误差式(9)求导可得:
式中ε(t)的被控性能由控制器的性能决定,若此转换误差稳定有界,则原误差e(t)一致稳定有界且满足所要求的预设性能目标;
八、位置控制器设计:
依据控制结构图2可知,位置子***解耦成x,y,z三坐标轴方向上的控制量,在此以x轴为例设计控制器,y,z轴的控制器设计与x轴的控制器相同;
首先,将解耦后的飞行器动力学模型(3)统一写成:
由式(17)可知,设计虚拟控制律:
αx=exv(t)-λxrx -1(t)σx1 (18)
式中:λx>0为虚拟控制律待设计参数,式(17)可化简为:
接着,求出x轴控制器的实际控制律u1x:
由式(16)中的第二式可知:
设计非线性指数观测器为:
由式(22)可以确定x轴控制器的控制律为:
对x轴控制器的稳定性进行证明:
设计其控制器的Lyapunov函数为:
对V3求导,并将式(19)(22)和控制律式(23)代入可知:
式中:δx=2min{λx,μx,κx},由式(22)可得其解满足并且当V3>0时,故整个x轴子***依指数收敛,该***状态变量σx1,σx2一致收敛并满足预设性能要求,依据误差转换可知***原误差ex满足有限时间的预定性能要求;
同理设计位置环中的y,z轴方向上的控制器,其控制律分别为:
九、姿态控制器设计:
姿态环变量包括俯仰角子***、偏航角子***、滚转角子***变量;以俯仰角子***控制器为例来设计控制器,与位置环变量控制器设计同理;
αθ=eθv(t)-λθrθ -1(t)σθ1 (27)
同时,得出该***性非线性指数干扰观测器为:
最后:对控制律u2进行稳定性证明:选取该子***控制器的Lyapunov函数:
对其求导并将虚拟控制量式(27)和控制律式(29)代入可得:
式中:参数意义同式(25),所以俯仰角子***变量状态变量σθ1,σθ2一致收敛并满足预设性能要求,依据误差转换可知***原误差eθ满足有限时间的预定性能要求;
同理同步骤设计姿态环中的偏航角子***和滚转角子***控制器,其控制律分别为:
由解耦后的控制结构图3及式(3)中第三个式子可知,位置回路中的高度子***回路zd有独立控制变量u1,不依赖于姿态子***回路;因此结合虚拟控制量式(2)中的第三式和式(26)中第三式解得控制量u1:
u1=(u1z+g)·m/cosφcosθ (34)
至此,已完成整个四翼飞控***控制器设计。以此给出整个控制目标的相关定理如下:
值得注意的是,在实际控制控制器设计中,为避免控制律式子(29)、式子(32)、式子(33)以及式子(34)中的符号函数sgn(·)所带来的控制量抖振,将饱和函数σi2/|σi2|+ξ,(i=x,…,φ)代替开关符号函数;
最终得到:四翼飞行器在图2的控制结构下,采用干扰观测器(13)和有限时间收敛性能函数(5)的预定性能反演控制方法,以式(29)、(32)、(33)、(34)为控制律的控制器,***将快速高精度跟踪预设期望轨迹[xd,yd,zd,ψd]T,并且保证俯仰角姿态θ和滚转角姿态φ稳定。
一种四旋翼飞行器预设性能轨迹跟踪反演控制***,包括四旋翼飞行器模型以及由四旋翼飞行器模型解耦得到的双闭环控制结构模型,所述双闭环控制结构模型包括位置环以及姿态环,所述位置环包括有限时间预设性能反演位置控制器以及模型反解模块,所述姿态环包括有限时间预设性能反演姿态控制器,采用上述四旋翼飞行器预设性能轨迹跟踪反演控制***,能够具有预定性能的暂态和稳态跟踪性能,实现其高精度高性能轨迹跟踪控制目标。
为验证所设计的控制器的控制性能,通过MATLAB/SIMULINK对本文快速轨迹跟踪预设性能反演控制器(Fast-time Tracking Prescribed Performance Tracking Back-stepping Controller,PPFT-BC)进行仿真,为突出本文控制器的创新改进处和优良性能,与传统函数预设性能反演控制器(Convential-time Tracking Prescribed PerformanceBack-stepping Controller,CTPP-BC)进行对比仿真实验。
A、仿真参数设置:
选取有限时间跟踪性能函数(5)中的参数值为:ρ0=8,ρT0=0.01,τ=0.4,T0=ρ0 τ/τλ=1.1487,λ=5。FTPP-BC控制器参数与虚拟控制律参数分别选取为:λx=λy=λz=200,λθ=λψ=λφ=10,μx=μy=μθ=μψ=μφ=5,μz=3,Di=0.25(i=x,y,θ,φ,ψ);非线性指数观测器参数为:κi=3(i=x,y,z,θ,φ,ψ)。传统性能函数CTPP-BC控制器的参数设置如下:ρ0=0.8,ρ∞=0.001,h=0.8,λx=0.01,λy=0.05,λz=0.01,μx=5,μy=1200,μz=800,Di=0.5(i=x,y,z)。
四翼飞行器本体参数为:Ki=0.01(i=1,2,3),Ki=0.012(i=4,5,6);Iz=2.5Ii=1.25(i=x,y);l=0.2m;g=9.8m/s2。
仿真飞行轨迹为:螺旋盘升轨迹。规划位姿为:xd=5cos(t),yd=5sin(t),zd=2t,ψd=0。初始位姿:[x(0),y(0),z(0),θ(0),ψ(0),φ(0)]=[1,1,0,1,0,1]。飞行综合干扰di=0.1sin(0.1πt),(i=1,2,…,6);仿真时间为40s。
B、仿真结果分析:
①目标轨迹跟踪分析
从图4可知,FTPP-BC控制器的实际飞行轨迹在有限时间内快速高精度跟踪目标轨迹。尽管飞行器初始位置(1,1,0)和姿态(1,0,1)偏离规划位姿起点位姿,在控制器作用下大约经过T0=1,1487s精准进入规划飞行轨道并保持飞行姿态的一致性,而CTPP-BC控制算法下的飞行轨迹跟踪目标轨迹的调节时间较长,经过MATLAB仿真可知经过5.57秒才跟踪上目标轨迹。通过3D飞行跟踪图明显可知,本文算法控制器跟踪的快速性能效果明显优于CTPP-BC算法,跟踪的稳态性能也优于常规性能函数预设算法,两种算法的3D飞行轨迹跟踪效果如图4所示。
②飞行位置子***轨迹跟踪分析
图5~图10是飞行轨迹位姿子***的轨迹跟踪曲线,特别说明的是:虚拟控制量α参数λi(i=x,y,…,ψ)对跟踪性能的影响明显,太大出现跟踪不稳定,较小时出现跟踪不上规划轨迹,经过多次试验寻优,得出的参数如上文仿真参数配置所示。从位置子***跟踪轨迹曲线可知:x,y轴FTPP-BC控制器由于要克服初始姿态误差,经过有限时间调整,快速精确跟踪规划轨迹,z轴控制器无偏差跟踪规划轨迹。而CTPP-BC的x轴控制器的跟踪时间较长,y,z轴跟踪动态性比x轴良好,但是稳态性能均不及于FTPP-BC控制器。具体误差性能分析见图6。
③位置误差性能分析
图11~图13为位置环子***变量跟踪误差曲线图,从图可知:FTPP-BC控制器位置环子***各误差在预设性能函数约束下均在有限时间内(T0=1.1487,该时间可由性能函数参数按照被控对象进行最优化设定)收敛到零。“漏斗”状预设性能函数确保了被控误差的动态性能,使飞行器姿态更快更准跟踪飞行目标轨迹;由于有限时间性能函数的稳定域更加“紧缩”,所以FTPP-BC算法的x,y,z轴控制器的稳态性能显然优于CTPP-BC控制器。跟踪误差效果如图6所示。
④飞行姿态子***轨迹跟踪分析
从图8~图10的三个姿态跟踪曲线中可见:实际姿态变量在初始值与规划值不一致时,在控制器作用下也在有限时间内调整到规划的姿态。每个姿态变量调整时间在预先设置的控制范围内,这是由所运用有限时间函数控制器性能所决定。而传统预设性能函数的反演控制算法姿态量跟踪时间明显较长,并且经过一个较长的动态调节过程才能跟踪给定位姿,并且在跟踪的稳态性方面也明显劣于FTPP-BC控制器。
从图14的偏航角变量的轨迹跟踪误差性能曲线中验证出姿态环控制器能够在有限时间内按预设性能调整姿态环变量到规划设定值,并且无跟踪稳态误差。由于姿态目标值均为零,FTPP-BC控制器的稳态性能也优于CTPP-BC,两种控制器的稳态性能分析见图14~图16所示。
本发明主要针对四旋翼飞行器飞行干扰和动力学方程耦合特性,对飞行轨迹跟踪控制问题提出有限时间预设性能反演控制算法。为达到预先设定的误差跟踪目标,创新应用一种有限时间收敛性能函数并对其进行特性分析;利用误差坐标变换,将飞行器位置环与姿态环变量进行误差变量设定和转换,从而直接对不等式约束性能的变量转换成等式约束问题;为处理飞行器的外界干扰和轴耦合干扰,创新运用出一种指数收敛的非线性干扰观测器对综合干扰进行观测估计,将估计值运用在反演算法控制器中,从而设计出有限时间收敛的预设性能反演控制器。通过仿真实验验证出所设计控制器具有既定控制性能,为体现创新改良控制器的控制性能,通过对比仿真实验进一步验证出控制算法的优越性,具有较大的工程应用实践价值。
Claims (6)
1.一种四旋翼飞行器预设性能轨迹跟踪反演控制方法,其特征在于:该方法包括下列步骤:
(1)、求取四旋翼飞行器理想情况下的原始位姿动力学模型:选取地表某固定位置为大地坐标系原点建立大地坐标系Θ={O-XYZ},以此建立空间飞行坐标系Ω={Oa-XaYaZa},飞行器质心相对于大地坐标系原点的位置向量为[x,y,z],其姿态分别是滚转角、俯仰角以及偏航角,记为姿态向量[φ,θ,ψ],求得四旋翼飞行器控制***理想情况下的原始位姿动力学模型:其中,x为位置环中x轴对应的变量,y为位置环中y轴对应的变量,z为位置环中z轴对应的变量,θ为姿态环中俯仰角对应的变量,ψ为姿态环中偏航角对应的变量,φ为姿态环中滚转角对应的变量;ui(i=1,…,4)为实际输入控制器的控制律,其对应为前后左右四个旋翼电机的电压;Ki(i=1,2,…,6)为空气阻力系数;m是飞行器质量;l为飞行器机臂长度;Ix,Iy,Iz表示飞行器相对于机体坐标轴的转动惯量;g为重力加速度,取g=9.8m/s2;
(2)、定义虚拟控制变量项为:将步骤(1)中的原始位姿动力学模型进行解耦,解耦出的四旋翼飞行器控制***的模型为包括位置环和姿态环的双闭环控制结构模型,其中位置环为外环,姿态环为内环;所述双闭环控制结构模型为:其中,di(i=1,2,…,6)为四旋翼飞行器所受的综合扰动,包括大气气流扰动、***未建模动态扰动和不确定性干扰,干扰项di(i=1,2,…,6)及其一阶导数连续有界,即u1x,u1y,u1z为控制律u1解耦后的控制变量;
(3)、根据步骤(2)中得到的双闭环控制结构模型,由四旋翼飞行器的期望偏航角ψd,求解出四旋翼飞行器的期望俯仰角θd和期望滚转角φd:
(4)、设计出步骤(2)中双闭环控制结构模型中干扰项的指数型非线性观测器;
(5)、令四旋翼飞行器期望的位姿向量为:pd=[xd,yd,zd,ψd]T,而实际的位姿向量为:p=[x,y,z,ψ]T,则四旋翼飞行器控制***的***误差函数为:e(t)=pd-p;根据有限时间预设性能函数对控制***的***误差函数进行坐标变换,转换成具有稳态性能和动态性能要求的***变量;
(6)、利用反演控制算法结合步骤(4)中的非线性指数观测器来估计出综合干扰变量,以此得出实际输入控制器的控制律。
4.根据权利要求3所述的四旋翼飞行器预设性能轨迹跟踪反演控制方法,其特征在于:步骤(5)中,根据有限时间预设性能函数对控制***的***误差函数进行坐标变换,转换成具有稳态性能和动态性能要求的***变量的具体过程包括下列步骤:
(5.1)、根据有限时间预设性能函数,***误差函数要求在预先设定的动态和稳态范围内收敛到零,并且收敛的动态时间与初始值无关且在有限时间内,则设定***误差函数的约束不等式为:-ρ(t)<e(t)<ρ(t);
(5.2)、利用误差转换函数对步骤(5.1)中的约束不等式进行处理,转换为误差函数等式:e(t)=ρ(t)ftran(ε(t)),其中,ε(t)是被转换后的误差,ftran(ε(t))为误差转换函数,ftran(ε(t))选取双曲正切函数,表示为:
(5.4)、对转换后的误差函数等式进行求导,得到:
5.根据权利要求4所述的四旋翼飞行器预设性能轨迹跟踪反演控制方法,其特征在于:在步骤(6)中,运用反演控制算法结合步骤(4)中的非线性指数观测器来估计出综合干扰变量,以此得出控制器的控制律的具体方法包括下列步骤:
(6-1)、对位置环中变量x对应的控制律进行设计:
(6-1-3)、根据步骤(6-1-2)中的求导式来得到位置环中变量x对应的控制律为:
(6-4)、根据步骤(2)中定义的虚拟控制变量项以及步骤(6-1)~(6-3)中求取的位置环中x,y,z变量对应的控制律,可以解得实际输入控制器的控制律u1为:
u1=(u1z+g)·m/cosφcosθ;
(6-5)、对姿态环中变量θ对应的控制律进行设计:
(6-6)、根据步骤(6-5),同理得出实际输入控制器的控制律u3为:
(6-7)、根据步骤(6-5),同理得出实际输入控制器的控制律u4:
6.一种四旋翼飞行器预设性能轨迹跟踪反演控制***,其特征在于:包括四旋翼飞行器模型以及由四旋翼飞行器模型解耦得到的双闭环控制结构模型,所述双闭环控制结构模型包括位置环以及姿态环,所述位置环包括有限时间预设性能反演位置控制器以及模型反解模块,所述姿态环包括有限时间预设性能反演姿态控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110634707.8A CN113419565B (zh) | 2021-06-08 | 2021-06-08 | 四旋翼飞行器预设性能轨迹跟踪反演控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110634707.8A CN113419565B (zh) | 2021-06-08 | 2021-06-08 | 四旋翼飞行器预设性能轨迹跟踪反演控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113419565A true CN113419565A (zh) | 2021-09-21 |
CN113419565B CN113419565B (zh) | 2022-05-31 |
Family
ID=77788004
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110634707.8A Active CN113419565B (zh) | 2021-06-08 | 2021-06-08 | 四旋翼飞行器预设性能轨迹跟踪反演控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113419565B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114610055A (zh) * | 2022-02-07 | 2022-06-10 | 南通大学 | 飞行器控制方法与飞行器 |
CN114942649A (zh) * | 2022-06-06 | 2022-08-26 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
CN114967718A (zh) * | 2022-05-06 | 2022-08-30 | 四川大学 | 一种控制受限下的四旋翼轨迹跟踪最优控制方法 |
CN116225043A (zh) * | 2023-05-09 | 2023-06-06 | 南京信息工程大学 | 一种基于干扰观测器的四旋翼无人机预定性能控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5296793A (en) * | 1986-11-05 | 1994-03-22 | Massachusetts Institute Of Technology | State observer for synchronous motors |
CN106842910A (zh) * | 2016-11-17 | 2017-06-13 | 中国船舶科学研究中心(中国船舶重工集团公司第七0二研究所) | 一种基于干扰观测器的船舶减摇鳍滑模控制方法 |
CN108333928A (zh) * | 2018-01-23 | 2018-07-27 | 南京理工大学 | 一种基于动态面多直流无刷电机位置协调控制方法 |
CN111007877A (zh) * | 2019-11-20 | 2020-04-14 | 江苏信息职业技术学院 | 一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法 |
CN111435254A (zh) * | 2019-01-11 | 2020-07-21 | 天津工业大学 | 具有姿态有界输出的四旋翼飞行器分散控制 |
CN111722634A (zh) * | 2020-05-28 | 2020-09-29 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
CN111766889A (zh) * | 2020-05-06 | 2020-10-13 | 东北电力大学 | 基于输出反馈的四旋翼自适应动态面滑模控制器 |
CN112077847A (zh) * | 2020-09-08 | 2020-12-15 | 西华大学 | 受非匹配干扰机器人的位置跟踪控制方法 |
-
2021
- 2021-06-08 CN CN202110634707.8A patent/CN113419565B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5296793A (en) * | 1986-11-05 | 1994-03-22 | Massachusetts Institute Of Technology | State observer for synchronous motors |
CN106842910A (zh) * | 2016-11-17 | 2017-06-13 | 中国船舶科学研究中心(中国船舶重工集团公司第七0二研究所) | 一种基于干扰观测器的船舶减摇鳍滑模控制方法 |
CN108333928A (zh) * | 2018-01-23 | 2018-07-27 | 南京理工大学 | 一种基于动态面多直流无刷电机位置协调控制方法 |
CN111435254A (zh) * | 2019-01-11 | 2020-07-21 | 天津工业大学 | 具有姿态有界输出的四旋翼飞行器分散控制 |
CN111007877A (zh) * | 2019-11-20 | 2020-04-14 | 江苏信息职业技术学院 | 一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法 |
CN111766889A (zh) * | 2020-05-06 | 2020-10-13 | 东北电力大学 | 基于输出反馈的四旋翼自适应动态面滑模控制器 |
CN111722634A (zh) * | 2020-05-28 | 2020-09-29 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
CN112077847A (zh) * | 2020-09-08 | 2020-12-15 | 西华大学 | 受非匹配干扰机器人的位置跟踪控制方法 |
Non-Patent Citations (7)
Title |
---|
CHARALAMPOS P B, GEORGE A R: "Robust Adaptive Control of Feedback Linearizable MIMO Nonlinear Systems with prescribed performance", 《AJACCIO: 16TH MEDITERRANEAN CONFERENCE ON CONTROL AND AUTOMATION》 * |
JIEQING CHEN;RUISHENG SUN;BIN ZHU: "Disturbance observer-based control for small nonlinear UAV systems with transient performance constraint", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
JING Y W, LIU Y, ZHOU S W: "Prescribed Performance Finite-time Tracking Control for Uncertain Nonlinear Systems", 《JOURNAL OF SYSTEMS SCIENCE & COMPLEXITY》 * |
朱亮; 姜长生; 方炜: "基于非线性干扰观测器的不确定非线性***鲁棒轨迹线性化控制", 《信息与控制》 * |
潘世华;江道根;朱蓉;尹湘源: "四翼飞行器轨迹快速跟踪预设性能反演控制", 《控制工程》 * |
童颖裔; 董文瀚; 贺磊; 张晓敏: "四旋翼无人机预设性能反步轨迹跟踪控制", 《飞行力学》 * |
邹立颖; 李惠光; 李国友: "基于非线性干扰观测器的VTOL飞行器跟踪控制", 《高技术通讯》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114610055A (zh) * | 2022-02-07 | 2022-06-10 | 南通大学 | 飞行器控制方法与飞行器 |
CN114610055B (zh) * | 2022-02-07 | 2023-02-24 | 南通大学 | 飞行器控制方法与飞行器 |
CN114967718A (zh) * | 2022-05-06 | 2022-08-30 | 四川大学 | 一种控制受限下的四旋翼轨迹跟踪最优控制方法 |
CN114942649A (zh) * | 2022-06-06 | 2022-08-26 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
CN114942649B (zh) * | 2022-06-06 | 2022-12-06 | 北京石油化工学院 | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 |
CN116225043A (zh) * | 2023-05-09 | 2023-06-06 | 南京信息工程大学 | 一种基于干扰观测器的四旋翼无人机预定性能控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113419565B (zh) | 2022-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113419565B (zh) | 四旋翼飞行器预设性能轨迹跟踪反演控制方法及*** | |
Sun et al. | Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles | |
Song et al. | Adaptive nonsingular fast terminal sliding mode guidance law with impact angle constraints | |
CN106406102B (zh) | 一种含干扰观测器的高超声速飞行器跟踪控制方法 | |
CN109782795B (zh) | 一种利用耦合的面对称高超声速飞行器横侧向控制方法及控制*** | |
Wang et al. | Partial integrated guidance and control with impact angle constraints | |
CN103728882B (zh) | 微陀螺仪的自适应反演非奇异终端滑模控制方法 | |
CN106802660A (zh) | 一种复合强抗扰姿态控制方法 | |
CN111258216B (zh) | 一种适用于四旋翼飞行器的滑模重复控制器 | |
CN113885543B (zh) | 一种复杂海况干扰下的航行体自抗扰横滚控制器的设计方法 | |
CN113985901A (zh) | 基于扰动估计的高超声速飞行器预设性能控制方法及装置 | |
Li et al. | Three-dimensional adaptive sliding mode guidance law for missile with autopilot lag and actuator fault | |
CN113268072A (zh) | 一种基于特征模型的四旋翼无人机抗扰控制方法 | |
Han et al. | Three-dimensional impact time and angle guidance via controlling line-of-sight dynamics | |
CN116795126A (zh) | 一种输入饱和与输出受限的变形飞行器控制方法 | |
Wu et al. | A novel guidance law for intercepting a highly maneuvering target | |
Yun et al. | Robust Smooth Sliding‐Mode‐Based Controller with Fixed‐Time Convergence for Missiles considering Aerodynamic Uncertainty | |
Zhu et al. | A PID based approximation-free controller with prescribed performance function for model helicopter attitude control | |
Ma et al. | Differential geometric guidance command with finite time convergence using extended state observer | |
Ryu et al. | Missile autopilot design for agile turn control during boost-phase | |
Shen et al. | An improved chattering-free sliding mode control with finite time convergence for reentry vehicle | |
Wu et al. | A Novel Fixed-Time Convergence Three-Dimensional Guidance Law for Intercepting Highly Maneuvering Targets | |
Li et al. | Sliding Mode Control Based on High‐Order Linear Extended State Observer for Near Space Vehicle | |
Liu et al. | Wide-speed vehicle control considering flight-propulsion coupling constraints | |
Cui et al. | Prescribed finite-time ESO-based prescribed finite-time control and its application to partial IGC design |
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 |