一种受扰小型无人直升机的复合主动抗干扰轨迹跟踪控制方法技术

本发明专利技术公开了一种受扰小型无人直升机的复合主动抗干扰轨迹跟踪控制方法。该发明专利技术基于非线性干扰观测器和块状反步控制技术，首先，建立无人直升机系统带有集总干扰的6自由度刚体模型，并将其分解为三个耦合相对较小的子系统；其次，分别针对三个子系统，设计非线性干扰观测器估计集总干扰；第三，将块状反步控制技术和干扰估计量相结合，设计前馈‑反馈复合抗干扰轨迹跟踪控制器；最后，通过选取合适的观测器和反馈控制器增益，可使无人直升机精确跟踪期望的位置和偏航角。本发明专利技术形式简单，降低了现有跟踪控制技术的复杂度，能实现复杂干扰环境下小型无人直升机的精确轨迹跟踪，同时有效提升了系统的抗干扰性能。

A compound active anti-jamming trajectory tracking control method for small unmanned helicopter

【技术实现步骤摘要】
一种受扰小型无人直升机的复合主动抗干扰轨迹跟踪控制方法
本专利技术涉及一种受扰小型无人直升机的复合主动复合抗干扰轨迹跟踪控制方法，属于无人飞行器飞行控制的

技术介绍
在各种各样的无人飞行器中，无人直升机具有垂直起降，悬停，超低空和低速飞行，能在狭小、复杂和未知的环境中飞行等突出优势。由于这些显著的优势，无人直升机在军用和民用领域均具有广泛的应用前景，并且逐渐吸引了众多研究者的关注。然而，无人直升机系统是一个典型的强耦合、多输入多输出、静不稳定的非线性系统，同时还在飞行时还容易受到模型参数不确定、未建模动态等内部干扰和复杂外部环境干扰的影响，这给其飞行控制设计带来了很大的困难，其设计难度具体表现为：1)无人直升机系统的高度非线性。由于其空气动力学特性的复杂性，无人直升机系统具有很强的非线性，这给建立一个能精确描述系统特性且适于控制设计的系统模型带来了很大困难。2)无人直升机系统具有强耦合性。直升机具有四个直接控制量，它们对直升机的飞行方向、速度、姿态等六个自由度都产生控制作用，且四个控制量之间也有明显的耦合作用，本文档来自技高网...

【技术保护点】
1.一种受扰小型无人直升机的复合主动复合抗干扰轨迹跟踪控制方法，其特征在于，步骤包括：/n步骤一、将内部干扰和直升机所受的复杂外部环境干扰当作集总干扰，建立无人直升机系统6自由度刚体模型，所述内部干扰包括未确定系统参数、未建模动态；/n步骤二、将步骤一所述无人直升机系统6自由度刚体模型分解为三个子系统，包括一个二阶的高度子系统，一个二阶的偏航子系统和一个二维四阶的水平子系统；/n步骤三、针对步骤二所述的三个子系统中的6个集总干扰，分别构造非线性干扰观测器来对其进行估计，获得干扰估计量；/n步骤四、利用所述干扰估计量，基于块状反步控制技术设计复合抗干扰轨迹跟踪控制器，用于对所述三个子系统分别进行...

【技术特征摘要】
1.一种受扰小型无人直升机的复合主动复合抗干扰轨迹跟踪控制方法，其特征在于，步骤包括：
步骤一、将内部干扰和直升机所受的复杂外部环境干扰当作集总干扰，建立无人直升机系统6自由度刚体模型，所述内部干扰包括未确定系统参数、未建模动态；
步骤二、将步骤一所述无人直升机系统6自由度刚体模型分解为三个子系统，包括一个二阶的高度子系统，一个二阶的偏航子系统和一个二维四阶的水平子系统；
步骤三、针对步骤二所述的三个子系统中的6个集总干扰，分别构造非线性干扰观测器来对其进行估计，获得干扰估计量；
步骤四、利用所述干扰估计量，基于块状反步控制技术设计复合抗干扰轨迹跟踪控制器，用于对所述三个子系统分别进行补偿，同时对飞行轨迹进行实时跟踪。


2.根据权利要求1所述的一种受扰小型无人直升机的复合主动复合抗干扰轨迹跟踪控制方法，其特征在于：所述步骤一中简化的无人直升机6自由度刚体模型如下：



其中，P＝[x,y,z]T和V＝[u,v,w]T分别表示无人直升机在惯性坐标系下的位置和速度，是用于描述直升机姿态的三个欧拉角，Ω＝[p,q,r]T代表无人直升机在机体坐标系下的角速度，g代表重力加速度，e3＝[001]T；J＝diag{Jxx,Jyy,Jzz}为无人直升机在机体坐标系下的对角惯性矩阵，其中Jxx、Jyy、Jzz为转动惯量；U＝[δcol,δlon,δlat,δped]T代表四个控制量输入，分别为主旋翼总距控制输入δcol、纵向周期变距控制输入δlon、横向周期变距控制输入δlat、尾翼总距控制输入δped；Zw、Zcol为系统参数，dV＝[du,dv,dw]T和dΩ＝[dp,dq,dr]T分别表示作用在直升机上的集总力和力矩干扰，表示从机体坐标系到惯性坐标系的旋转矩阵，其中St、Ct、Tt分别表示三角函数sin(t)、cos(t)、tan(t)；为姿态向量变换矩阵；A和B为常系数矩阵，Y为系统的输出。


3.根据权利要求1所述的一种受扰小型无人直升机的复合主动复合抗干扰轨迹跟踪控制方法，其特征在于：所述步骤二中的三个子系统为：
高度子系统：...

【专利技术属性】
技术研发人员：王翔宇，于欣，李世华，杨俊，刘基玉，
申请(专利权)人：东南大学，
类型：发明
国别省市：江苏;32