飞行器跟踪控制的复合自抗扰控制方法
【专利摘要】本发明提出一种飞行器跟踪控制的复合自抗扰控制方法，可以提高飞行器轨迹跟踪系统的动态跟踪性能和稳定性。第一步：按照飞行器的运动规律，将飞行器状态变量进行时标划分，即根据响应时间的差别将状态变量分成四组，形成三个环路子系统控制模型；第二步：根据第一步建立的控制模型，设计非线性动态逆补偿控制律；第三步：根据第一步建立的被控对象模型以及第二步设计的动态逆控制律，设计其自抗扰控制器，包括跟踪微分器、扩张状态观测器和反馈控制律；第四步：根据上述得到的非线性动态逆补偿控制律和自抗扰控制器，设计系统的复合控制器的控制策略；至此完成飞行器跟踪控制的复合自抗扰控制。
【专利说明】飞行器跟踪控制的复合自抗扰控制方法
【技术领域】
[0001]本发明属于飞行器轨迹跟踪控制领域，涉及一种基于动态逆控制和自抗扰控制技术相结合的飞行器跟踪控制的复合自抗扰控制方法。
【背景技术】
[0002]轨迹跟踪控制是无人飞行器的核心任务，在三维空间中跟随预先规划的轨迹到达特定目标点是无人飞行器基本功能。飞行器系统非线性、多变量、时变以及多输入输出、高阶的特点使得传统的线性控制方法不能满足要求。随着现代控制理论的不断发展，在经典控制理论的范围之外开辟更有效的提高飞行器跟踪性能的新途径，已成为当前各国研究飞行器跟踪控制系统的重要课题。
[0003]动态逆方法作为非线性控制理论的典型代表，基本思想就是利用输出或状态反馈来抵消被控对象的非线性因素，得到系统的输入输出之间线性关系的新系统(即伪线性系统)，同时实现多变量系统的解耦控制。在解决非线性问题上，非线性动态逆控制器在设计的过程中避免了传统控制算法的大量的调参工作，而设计出来的控制律具有较强的适应性和通用性。在飞行器控制设计中，飞行器的模型参数的变更，只需调整解算相应的数学关系，而无需改变控制器的结构。它对相类似的控制对象都会有较好的控制效果。
[0004]自抗扰控制技术是吸收现代控制理论成果、发扬PID思想精髓(基于误差来消除误差)、开发运用特殊非线性效应来发展的新型实用技术。自抗扰控制技术完全独立于被控对象的数学模型，其最突出的特点就是把作用于被控对象的所有不确定因素的作用都归结为“未知扰动”而利用对象的输入输出数据对它进行实时估计并给予补偿。自抗扰的意义就在于此，这里并不需要直接测量外扰作用，也不需要实现知道扰动的作用规律。这也使得在恶劣的环境中要求实现高速高精度控制的场合，自抗扰控制技术更能显出其优越性。
【发明内容】
[0005]本发明是针对现有技术的缺陷，提出一种飞行器跟踪控制的复合自抗扰控制方法，可以提高飞行器轨迹跟踪系统的动态跟踪性能和稳定性。
[0006]本发明的技术方案如下:
[0007]—种飞行器跟踪控制的复合自抗扰控制方法，包括以下步骤:
[0008]第一步:按照飞行器的运动规律，将飞行器状态变量进行时标划分，即根据响应时间的差别将状态变量分成四组，形成三个环路子系统控制模型；
[0009]第二步:根据第一步建立的控制模型，设计非线性动态逆补偿控制律；
[0010]第三步:根据第一步建立的被控对象模型以及第二步设计的动态逆控制律，设计其自抗扰控制器，包括跟踪微分器、扩张状态观测器和反馈控制律；
[0011]第四步:根据上述得到的非线性动态逆补偿控制律和自抗扰控制器，设计系统的复合控制器的控制策略；
[0012]至此完成飞行器跟踪控制的复合自抗扰控制。[0013]第一步中所述的三个环路子系统包括快变量回路、较快变量回路、慢变量回路；其中快变量回路模型为:
[0014]X1 = (.?) + gr (χ)ιι
[0015]其中㈤= [./:,(幻㈤./:(.〒)f表示子系统的已建模动态，U= [Sa 5e 5J
7分别为副翼偏角，升降舵偏角，方向舵偏角^表示飞行器状态变量，AO表示输入矩阵；
X1= [P q r]τ为转动角速度向量，其中P为滚转角速度，q为俯仰角速度，r偏航角速度；
[0016]其中较快变量回路模型为:
[0017]X2 =fjx) +^m(X)Xi
[0018]其中=幻ffl(x)./.:,(.?)]7表示子系统的已建模动态，X1转动角速度向量，
I表示相关的飞行器状态变量，义(Y)表示输入矩阵；Χ2=[? β ρ；为姿态向量，其中
α为攻角，β为侧滑角，μ为滚转角；
[0019]其中慢变量回路模型为:
【权利要求】
1.一种飞行器跟踪控制的复合自抗扰控制方法，其特征在于，包括以下步骤: 第一步:按照飞行器的运动规律，将飞行器状态变量进行时标划分，即根据响应时间的差别将状态变量分成四组，形成三个环路子系统控制模型； 第二步:根据第一步建立的控制模型，设计非线性动态逆补偿控制律； 第三步:根据第一步建立的被控对象模型以及第二步设计的动态逆控制律，设计其自抗扰控制器，包括跟踪微分器、扩张状态观测器和反馈控制律； 第四步:根据上述得到的非线性动态逆补偿控制律和自抗扰控制器，设计系统的复合控制器的控制策略； 至此完成飞行器跟踪控制的复合自抗扰控制。
2.如权利要求1所述的一种飞行器跟踪控制的复合自抗扰控制方法，其特征在于，第一步中所述的三个环路子系统包括快变量回路、较快变量回路、慢变量回路；其中快变量回路模型为:
名=//(?) + --/(-〒)Μ 其中/Μ) 刃]表示子系统的已建模动态，U= [sa 5e SJt分别为副翼偏角，升降舵偏角，方向舵偏角；I表示飞行器状态变量，表示输入矩阵A1 =[P q r]τ为转动角速度向量，其中P为滚转角速度，q为俯仰角速度，r偏航角速度； 其中较快变量回路模型为: 其中fr,(x) y;(^f表示子系统的已建模动态，X1转动角速度向量，y表示相关的飞行器状态变量，义(Y)表示输入矩阵；Χ2= [α β μ]Τ为姿态向量，其中α为攻角，β为侧滑角，μ为滚转角； 其中慢变量回路模型为: 矣= 其中Us= [α β μ Τ]τ, T表示油门推力；表示子系统的已建模动态，X3 =[V Y X ]τ为飞行器的速度向量。
3.如权利要求2所述的一种飞行器跟踪控制的复合自抗扰控制方法，其特征在于，所述的设计非线性动态逆补偿控制律分为: 对于快变量回路和较快变量回路的控制律设计如下:
4.如权利要求1或2或3所述的一种飞行器跟踪控制的复合自抗扰控制方法，其特征在于，第三步所述的跟踪微分器采用以下模型:
5.如权利要求1或2或3所述的一种飞行器跟踪控制的复合自抗扰控制方法，其特征在于，第三步中所述的扩张状态观测器采用以下模型:
6.如权利要求1或2或3所述的一种飞行器跟踪控制的复合自抗扰控制方法，其特征在于，第三步中所述的自抗扰反馈控制律采用以下模型:
【文档编号】G05B13/04GK103777641SQ201410056776
【公开日】2014年5月7日 申请日期:2014年2月19日 优先权日:2014年2月19日
【发明者】夏元清, 王夕臣, 蒲钒, 谢竹峰, 付梦印, 柴森春 申请人:北京理工大学