CN109828602A - 一种基于观测补偿技术的航迹回路非线性模型变换方法 - Google Patents
一种基于观测补偿技术的航迹回路非线性模型变换方法 Download PDFInfo
- Publication number
- CN109828602A CN109828602A CN201910047309.9A CN201910047309A CN109828602A CN 109828602 A CN109828602 A CN 109828602A CN 201910047309 A CN201910047309 A CN 201910047309A CN 109828602 A CN109828602 A CN 109828602A
- Authority
- CN
- China
- Prior art keywords
- angle
- model
- flight path
- unmanned plane
- track
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于观测补偿技术的航迹回路非线性模型变换方法,属于无人机导航制导与控制技术领域。将固定翼无人机航迹回路运动模型分解为航迹偏角和航迹倾角运动模型、航迹速度运动模型以及横向位置和垂向位置运动模型,然后分别通过中间虚拟控制量的引入和方程的等效变换,将整个微分方程右端形式上与虚拟控制量线性无关的项视作总干扰,以获得航迹回路运动模型的仿射非线性形式,通过基于线性扩张状态观测器的观测补偿技术实现对各航迹运动状态和模型总扰动的估计,并在控制器时予以补偿。本发明方法实现模型仿射化处理,处理过程物理意义明确,参数整定方便,易于工程实现。
Description
技术领域
本发明属于无人机导航制导与控制技术领域,具体涉及一种基于观测补偿技术的航迹回路非线性模型变换方法。
背景技术
无人机又称无人驾驶飞行器,广泛应用于军用和民用领域;无人机航迹回路模型是指描述无人机航迹运动的数学模型。随着无人机的执行任务日趋多样,人们对无人机飞行控制器抵抗外部不确定扰动性能的要求也日益提高,传统的仅依靠姿态回路控制器抵抗外部扰动的方法已无法满足需求,加之无人机航迹回路模型的非仿射非线性特性,进一步增加了对无人机轨迹回路抗扰动非线性控制的研究需求。研究一种实现无人机航迹回路模型的仿射化处理方法,对于实现无人机三维轨迹的抗扰动高精度跟踪控制具有重要的意义,可以广泛应用于无人机地形回避,编队飞行以及自主空中加油等特殊任务。
在无人机的轨迹跟踪控制中,实现无人机直接沿实时给定的轨迹进行飞行具有重要的实用价值,但由于固定翼无人机轨迹环运动方程的强非线性、强耦合性及非仿射性,加之许多非线性控制方法是基于被控对象仿射非线性模型设计的,目前的无人机非线性抗干扰跟踪控制器研究主要集中于姿态控制,如参考文件1[王婕,宗群,田栢苓,范文茹.基于拟连续高阶滑模的高超声速飞行器再入姿态控制[J].控制理论与应用,2014,31(09):1166-1173.],参考文件2[Sun M,Zhang L,Wang Z,et al.PID pitch attitude control forunstable flight vehicle in the presence of actuator delay:Tuning and analysis[J].Journal of the Franklin Institute,2014,351(12):5523-5547],鲜有将固定翼无人机轨迹控制和姿态控制在同一种抗干扰理论框架下设计的研究,直接导致了轨迹环控制器抗扰性能受限,同时也很大程度上制约了许多具有较好抗扰动能力的非线性控制方法在无人机轨迹控制方面的应用。该情况对于某些存在强复杂气流扰动的无人机应用场所是非常不利的。
目前在软管式自主对接控制方面,国内外从不同角度开展了大量研究工作,取得了许多卓有成效的研究成果,但总体而言,多重复杂扰动条件下自主对接控制的效果并不理想。NASA在2006年的自主空中加油演示验证飞行中6次对接只有2次成功。X-47B虽然完成了无人机首次空中加油试验,但其成功对接的视频中锥套运动非常平稳,表明当时的气流扰动非常小,显然是精心选择气象条件的结果。与之形成鲜明对比的是,类似大小的气流扰动情况下,国内外在人工控制的空中加油实践方面却非常成功,经过艰苦的训练,战斗机飞行员往往能够达到很高的空中加油对接成功率。
对比自主加油控制和人工操纵控制本质特征,它们之间存在如下本质区别:1)控制方法方面,自主控制大多采用的是成熟的线性控制方法,如参考文件3和4记载,尤以LQR法为多,对于不确定性扰动缺乏针对性的措施。参考文件3:Valasek J,Gunnam K,KimmettJ,et al.Vision-based sensor and navigation system for autonomous airrefueling[J].Journal of Guidance,Control,and Dynamics,2005,28(5):979-989.参考文件4:Tandale M D,Bowers R,Valasek J.Trajectory tracking controller forvision-based probe and drogue autonomous aerial refueling[J].Journal ofGuidance Control and Dynamics,2006,29(4):846-857。而人工控制实现的是在增稳基础上的非线性控制,具有更高的控制效率,同时飞行员根据感受的操纵杆力的情况进行操纵补偿,能够最大限度地抑制干扰的影响。因此获取一种航迹回路非线性模型是非常有必要的。
发明内容
针对现有问题:无人机位置方程和航迹运动方程均为强耦合、非仿射非线性形式的,制约了许多具有较好抗扰动能力的非线性控制方法在无人机轨迹控制上的应用,其抗扰性能必然会受到很大程度上的限制,本发明提出一种基于观测补偿技术的航迹回路非线性模型变换方法,并满足上述要求。
本发明的基于观测补偿技术的航迹回路非线性模型变换方法,包括如下步骤:
步骤一、设定大气中各种变化的风场,将各种变化的风场矢量合成后作为固定翼无人机质心的风场,并将固定翼无人机质心的风场分解为惯性系下三轴风速度分量,获得航迹速度在惯性系下的三轴风速度分量。
步骤二、在固定翼无人机六自由度刚体运动模型的基础上,建立反映变化风场影响的固定翼无人机航迹回路运动模型,所述固定翼无人机航迹回路运动模型包括航迹偏角χ和航迹倾角γ运动模型、航迹速度Vk运动模型以及横向位置y和垂向位置z运动模型。
步骤三、依次针对气流角及航迹滚转角μ,定义中间变量υ1和υ2,所述气流角包括无人机的迎角α和无人机的侧滑角β。
步骤四、将步骤三定义的中间变量υ1和υ2作为姿态回路控制器的虚拟控制量,将步骤二建立的航迹偏角χ和航迹倾角γ运动模型,变化成面向控制设计的仿射非线性模型形式。
步骤五、将步骤二建立的航迹速度Vk运动模型,变化成面向控制设计的关于控制量油门开度δT的仿射非线性模型形式。
步骤六、选取航迹角向量[χγ]T作为姿态回路控制器的虚拟控制量,将步骤二建立的横向位置y和垂向位置z运动模型,变化成面向控制设计的仿射非线性模型形式。
步骤七、针对分别得到的三种运动模型的仿射非线性模型形式,将***动态中形式上与虚拟控制量线性无关的视为模型总干扰,采用线性扩张状态观测器(LESO)对仿射非线性模型状态及总干扰进行估计与补偿,并将在航迹回路控制器设计时予以补偿。
本发明与现有技术相比,具有以下明显优势:
(1)一种基于观测补偿技术的航迹回路非线性模型变换方法,可兼顾变化风场对无人机轨迹环运动的影响。
(2)一种基于观测补偿技术的航迹回路非线性模型变换方法,可将无人机位置方程和航迹运动方程同时处理变换成便于控制设计的简单的仿射非线性形式。
(3)本发明可在兼顾变化风场的条件下,同时实现无人机航迹回路运动状态方程的模型仿射化处理,处理过程物理意义明确,参数整定方便,易于工程实现。
附图说明
图1是本发明一种基于观测补偿技术的航迹回路非线性模型变换方法流程图;
图2是本实例中作用在无人机纵、横、垂三轴的变化风场干扰;
图3A为无人机的横向位置y随时间的跟踪效果示意图;
图3B为横向位置模型干扰Fy随时间的跟踪效果示意图;
图3C为无人机的垂向位置z随时间的跟踪效果示意图;
图3D为垂向位置模型干扰Fz随时间的跟踪效果示意图;
图3E为横向位置y的跟踪误差示意图;
图3F为横向位置模型干扰Fy的跟踪误差示意图;
图3G为垂向位置z的跟踪误差示意图;
图3H为垂向位置模型干扰Fz的跟踪误差示意图;
图4A为无人机航迹速度Vk随时间的跟踪效果示意图;
图4B为无人机航迹速度模型干扰随时间的跟踪效果示意图;
图4C为无人机航迹速度Vk的跟踪误差示意图;
图4D为无人机航迹速度模型干扰的跟踪误差示意图;
图5A为无人机航迹偏角χ随时间的跟踪效果示意图;
图5B为航迹偏角模型干扰Fχ随时间的跟踪效果示意图;
图5C为无人机的航迹倾角γ随时间的跟踪效果示意图;
图5D为航迹倾角模型干扰Fγ随时间的跟踪效果示意图;
图5E为航迹偏角χ的跟踪误差示意图;
图5F为航迹偏角模型干扰Fχ的跟踪误差示意图;
图5G为航迹倾角γ的跟踪误差示意图;
图5H为航迹倾角模型干扰Fγ的跟踪误差示意图。
具体实施方式
为了便于本领域普通技术人员理解和实施本发明,下面结合附图和实施例对本发明作进一步的详细描述。
本发明所提出的航迹回路非线性模型变换方法中,将固定翼无人机航迹回路运动模型分解为航迹偏角χ和航迹倾角γ运动模型、航迹速度Vk运动模型以及横向位置y和垂向位置z运动模型,然后分别通过中间虚拟控制量的引入和方程的等效变换,将整个微分方程右端形式上与虚拟控制量线性无关的项视作总干扰,以获得航迹回路运动模型的仿射非线性形式。在此基础上,通过基于线性扩张状态观测器(LESO)的观测补偿技术实现对各航迹运动状态和模型总扰动的估计,并在控制器时予以补偿。
本发明实施例中,无人机以200m/s的地速飞行,初始高度为7010m。
如图1所示,为本发明基于观测补偿技术的航迹回路非线性模型变换方法的步骤流程,下面对每一步骤进行具体说明。
步骤一、设定大气中各种变化的风场,将各种变化的风场矢量合成后作为固定翼无人机质心的风场,并将固定翼无人机质心的风场分解为惯性系下三轴风速度分量VW=[uwvw ww]T,VW为惯性系下风速度向量,uw、vw和ww分别为惯性系下沿纵、横、垂三个方向的风速度分量。
获得航迹速度在惯性系下的三轴分量VK=[uk vk wk]T,VK为惯性系下航迹速度向量,uk、vk和wk为惯性系下沿纵、横、垂三个方向的航迹速度分量。
在步骤一中建立仿真环境后设置仿真条件,选取中度大气紊流,并分别在10s,20s,30s时刻再加入幅值为5m/s的纵、横、垂三轴阶跃风。
步骤二、在平静大气环境下固定翼无人机六自由度刚体运动模型的基础上,分析大气中变化风场对无人机运动影响的本质,建立反映变化风场影响的固定翼无人机航迹回路运动模型,如公式(1)和(2)所示。
其中,无人机的位置方程为:
式中,x,y,z分别为无人机在惯性系下的纵、横、垂三维位置坐标,Vk为无人机的航迹速度,χ为无人机的航迹偏角,γ是无人机的航迹倾角;分别是x,y,z的微分。
地速及航迹角状态方程为:
式中,m为无人机质量,g为重力加速度;α,β,μ分别为无人机的迎角、无人机的侧滑角和无人机的航迹滚转角;T,D,C,L分别为无人机的发动机推力、无人机的阻力、无人机的侧力和无人机的升力;σ为发动机安装角;变化风场引起的迎角αw≈ww/V,变化风场引起的侧滑角βw≈vw/V,V是空速;航迹速度迎角αk≈wk/Vk,航迹速度侧滑角βk≈vk/Vk,为Vk对时间的一阶微分,为χ对时间的一阶微分,为γ对时间的一阶微分。
所述固定翼无人机航迹回路运动模型包括航迹偏角χ和航迹倾角γ运动模型、航迹速度Vk运动模型以及横向位置y和垂向位置z运动模型。
其中:m=11281kg。
横向位置y和垂向位置z运动模型:
航迹速度Vk运动模型:
航迹偏角χ和航迹倾角γ运动模型:
步骤三、依次针对气流角及航迹滚转角μ,定义中间变量υ1和υ2,所述气流角包括无人机的迎角α和无人机的侧滑角β;
υ1=αsinμ,υ2=αcosμ(6)
同时使得:
步骤四、依据步骤二建立的反映变化风场影响的固定翼无人机航迹回路运动模型中的航迹偏角χ和航迹倾角γ运动模型,基于反步法设计思想,选取步骤三定义的中间变量υ1和υ2,将[υ1υ2]T=[αsinμαcosμ]T作为姿态回路控制器的虚拟控制量,将强耦合、非仿射非线性的航迹偏角χ和航迹倾角γ运动模型变化成面向控制设计的仿射非线性模型形式;
具体步骤如下:
步骤401、无人机的航迹偏角χ和航迹倾角γ运动模型包括无人机的航迹偏角χ和无人机的航迹倾角γ运动非线性方程;
具体如下:
步骤402、分解无人机的发动机推力D、无人机的阻力C和无人机的侧力L并表示成关于迎角α和侧滑角β的形式;
分解过程如下:
Q=0.5ρV2;Q为动压;ρ为空气密度;S是无人机气动截面积,S=75.12m2;cD,cC,cL分别为推力D、阻力C和侧力L的气动系数;为平均气动弦长;q为俯仰角速率;cL,0为基本升力系数,cL,0=0.062;cD,0为零阻力系数,cD,0=0.023;cC,0为基本侧力系数,当无人机的外形左右对称时,cC,0=0;为机翼升力线斜率,为气动升力对迎角平方的偏导数,为俯仰角速度升力系数,为升降舵升力系数,为阻力导数,为气动阻力对迎角平分的偏导数,为升降舵阻力系数, 为升降舵平方的阻力系数,为侧力导数,为副翼侧力导数,为方向舵侧力导数,副翼舵偏角δa范围:-25°≤δa≤25°,升降舵偏角δe范围:-25°≤δe≤25°,方向舵偏角δr范围:-25°≤δr≤25°;为升力系数;为阻力系数;为侧力系数。
步骤403、将步骤402中已分解的动力D,C,L表达式代入无人机的航迹偏角χ和无人机的航迹倾角γ运动非线性方程,将无人机的航迹偏角χ运动非线性方程右端分解写成的相关项和无关项:
同理,将无人机的航迹倾角γ运动非线性方程右端分解写成的相关项和无关项:
步骤404、用中间变量υ1,υ2代替αsinμ,αcosμ,并将航迹偏角χ和航迹倾角γ运动非线性方程写成仿射非线性形式,完成航迹偏角χ和航迹倾角γ运动模型模型的变换。
X2=[γ χ]T,υ=[υ1 υ2]T=[αsinμ αcosμ]T,X3=[α β μ]T(15)
其中,F2为航迹角回路的总干扰,B2为航迹角回路的输入矩阵,为X2对时间的一阶微分,X2为为航迹角状态向量,X3为气流角状态向量,υ为中间的虚拟控制向量。
步骤五、将步骤二建立的反映变化风场影响的固定翼无人机航迹回路运动模型中的航迹速度Vk运动模型,变化成面向控制设计的关于控制量油门开度δT的仿射非线性模型形式。
具体步骤如下:
步骤501,无人机的航迹速度Vk运动模型写成标准微分方程形式,具体如下:
步骤502,分解发动机推力T,并表示成关于控制量油门开度δT的形式代入航迹速度Vk运动模型,其具体如下:
Tmax是发动机最大推力;Tmax=36849N,控制量油门开度δT范围:0≤δT≤1。
步骤503,将航迹速度Vk运动模型写成关于控制量油门开度δT的仿射非线性模型形式,完成航迹速度Vk运动模型的变换
其中,表示地速回路的总干扰,表示地速回路的输入矩阵。
步骤六、依据步骤二建立的反映变化风场影响的固定翼无人机航迹回路运动模型中的横向位置y和垂向位置z运动模型,基于反步法设计思想,选取航迹角向量[χγ]T作为姿态回路控制器的虚拟控制量,通过模型的等价变化,将横向位置y和垂向位置z运动模型变化成面向控制设计的仿射非线性模型形式。
具体步骤如下:
步骤601,在无人机横向位置y和垂向位置z运动模型中的横向位置y运动方程中同时增加和减少同一个关于χ的线性项Vkχ,在无人机垂向位置z运动方程中同时增加和减少同一个关于γ的线性项-Vkγ,具体如下;
步骤602,将无人机横向位置y运动方程和垂向位置z运动方程写成:
步骤603,将横向位置y运动方程和垂向位置z运动方程写成关于航迹偏角χ和航迹倾角γ的仿射非线性形式,完成横向位置y和垂向位置z运动模型的仿射非线性变换。
其中,F1表示位置回路的总干扰,B1表示位置回路的输入矩阵,为X1对时间的一阶微分,X1=[yz]T,X1为航迹位置状态向量。
步骤七、针对分别得到的面向控制设计的三种运动模型的仿射非线性模型形式,将***动态中形式上与虚拟控制量线性无关的视为总干扰,采用线性扩张状态观测器(LESO)对仿射非线性模型状态及总干扰进行估计与补偿,并将在控制器设计时予以补偿。
具体步骤如下:
步骤701、在上述已建立的面向控制设计的三种运动模型的仿射非线性模型基础上,将模型动态中Vk,Xi,i=1,2形式上与虚拟控制量线性无关的视为模型总干扰。
步骤702、以航迹偏角χ和航迹倾角γ运动模型变化成的仿射非线性模型为例,设计线性扩张状态观测器,线性扩张状态观测器具体设计如下:
构造如下的线性扩张状态观测器:
其中,x21为X2的实测值,为线性扩张状态观测器对状态X2的估计,为线性扩张状态观测器对总干扰F2的干扰估计,为对时间的一阶微分,为对时间的一阶微分,F2将在后续反馈控制设计中用以补偿模型扰动。li(i=1,2)为待设计的线性扩张状态观测器增益,且
l1=diag(2ω21,2ω22),l2=diag(ω21 2,ω22 2)
其中,ω21,ω22分别为χ,γ通道线性扩张状态观测器带宽;
步骤703、调节并选取合适的线性扩张状态观测器带宽ω21=15,ω22=15,实现对状态X2及总干扰F2进行估计与补偿;
步骤704、重复步骤702和703中的操作方式,分别对于航迹速度Vk运动模型变化成的仿射非线性模型以及横向位置y和垂向位置z运动模型变化成的仿射非线性模型中的状态及总干扰进行估计与补偿,其中所选取合适的横向位置y和垂向位置z运动模型线性扩张状态观测器带宽:ω11=5,ω2=5,航迹速度Vk运动模型线性扩张状态观测器带宽:
采用本发明方法无人机航迹回路模型转换方法在上述给定的风扰条件下,配合控制器控制作用,获取无人机航迹回路状态、扰动估计效果以及补偿结果。
如图2所示,是本实例中作用在无人机纵、横、垂三轴的变化风场干扰,其中,Wx,Wy和Wz表示总风扰在惯性系下沿纵、横、垂三方向的分量。
如图3A~图3H所示,是无人机横向位置y和垂向位置z运动模型航迹回路状态、扰动估计效果和估计无误差图,图3A为无人机的横向位置y随时间的跟踪效果示意图;图3B为横向位置模型干扰Fy随时间的跟踪效果示意图;图3C为无人机的垂向位置z随时间的跟踪效果示意图;图3D为垂向位置模型干扰Fz随时间的跟踪效果示意图;图3E为横向位置y的跟踪误差示意图,ey表示y的跟踪误差;图3F为横向位置模型干扰Fy的跟踪误差示意图,eFy表示Fy的跟踪误差;图3G为垂向位置z的跟踪误差示意图,ez表示z的跟踪误差;图3H为垂向位置模型干扰Fz的跟踪误差示意图,eFz表示的Fz的跟踪误差。可以看出无人机横、垂向状态估计十分准确,状态估计误差保持在10e-4量级以内;对应的模型干扰Fy和Fz的估计误差也分别都在10e-3和0.02以内,可以实现对模型总扰动的精确估计。
如图4A~图4D所示,是无人机航迹速度Vk运动模型航迹回路状态、扰动估计效果和估计误差图,图4A为无人机航迹速度Vk随时间的跟踪效果示意图;图4B为无人机航迹速度模型干扰随时间的跟踪效果示意图;图4C为无人机航迹速度Vk的跟踪误差示意图,表示Vk的跟踪误差;图4D为无人机航迹速度模型干扰的跟踪误差示意图,表示的跟踪误差。无人机航迹速度估计也非常准确,状态估计误差保持在0.01量级以内;对应的模型总干扰的估计误差也在0.4以内,在给定的飞行速度和高度这样的精度也是十分高的。
如图5A~图5H所示,是无人机航迹偏角χ和航迹倾角γ运动模型航迹回路状态与扰动估计效果和估计无误差图,图5A为无人机航迹偏角χ随时间的跟踪效果示意图;图5B为航迹偏角模型干扰Fχ随时间的跟踪效果示意图;图5C为无人机的航迹倾角γ随时间的跟踪效果示意图;图5D为航迹倾角模型干扰Fγ随时间的跟踪效果示意图;图5E为航迹偏角χ的跟踪误差示意图;图5F为航迹偏角模型干扰Fχ的跟踪误差示意图;图5G为航迹倾角γ的跟踪误差示意图;图5H为航迹倾角模型干扰Fγ的跟踪误差示意图。可以看出无人机航迹角状态χ,γ估计十分准确,状态估计误差分别保持在10e-3和0.05以内;对应的模型总干扰Fχ、Fγ的估计误差也分别都在0.05和2以内,在给定的飞行速度(200m/s)和高度(7010m)这样的精度也是比较高的。
综合上述数学分析和仿真验证,充分证明了本发明基于一种基于观测补偿技术的航迹回路非线性模型变换方法在无人机航迹回路模型仿射化处理上的有效性。
Claims (7)
1.一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,包括如下步骤:
步骤一、设定大气中各种变化的风场,将各种变化的风场矢量合成后作为固定翼无人机质心的风场,并将固定翼无人机质心的风场分解为惯性系下三轴风速度分量VW=[uw vwww]T,VW为惯性系下风速度向量,uw、vw和ww分别为惯性系下沿纵、横、垂三个方向的风速度分量;获得航迹速度在惯性系下的三轴分量VK=[uk vk wk]T,VK为惯性系下航迹速度向量,uk、vk和wk为惯性系下沿纵、横、垂三个方向的航迹速度分量;
步骤二、在固定翼无人机六自由度刚体运动模型的基础上,建立反映变化风场影响的固定翼无人机航迹回路运动模型,所述固定翼无人机航迹回路运动模型包括航迹偏角χ和航迹倾角γ运动模型、航迹速度Vk运动模型以及横向位置y和垂向位置z运动模型;
步骤三、依次针对气流角及航迹滚转角μ,定义中间变量υ1和υ2;
步骤四、将步骤三定义的中间变量υ1和υ2作为姿态回路控制器的虚拟控制量,将步骤二建立的航迹偏角χ和航迹倾角γ运动模型,变化成面向控制设计的仿射非线性模型形式;
步骤五、将步骤二建立的航迹速度Vk运动模型,变化成面向控制设计的关于控制量油门开度δT的仿射非线性模型形式;
步骤六、选取航迹角向量[χ γ]T作为姿态回路控制器的虚拟控制量,将步骤二建立的横向位置y和垂向位置z运动模型,变化成面向控制设计的仿射非线性模型形式;
步骤七、针对分别得到的三种运动模型的仿射非线性模型形式,将形式上与虚拟控制量线性无关的Fi,i=1,2视为模型总干扰,采用线性扩张状态观测器对仿射非线性模型状态及总干扰进行估计,并在航迹回路控制器设计时予以补偿。
2.如权利要求1所述的一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,步骤二中所述固定翼无人机航迹回路运动模型如公式(1)和(2)所示:
其中,无人机的位置方程为:
式中,x,y,z分别为无人机在惯性系下的纵、横、垂三维位置坐标,Vk为无人机的航迹速度,χ为无人机的航迹偏角,γ是无人机的航迹倾角;分别是x,y,z的微分;
地速及航迹角状态方程为:
式中,m为无人机质量,g为重力加速度;α,β,μ分别为无人机的迎角、无人机的侧滑角和无人机的航迹滚转角;T,D,C,L分别为无人机的发动机推力、无人机的阻力、无人机的侧力和无人机的升力;σ为发动机安装角;变化风场引起的迎角αw≈ww/V,变化风场引起的侧滑角βw≈vw/V,V是空速;航迹速度迎角αk≈wk/Vk,航迹速度侧滑角βk≈vk/Vk,为Vk对时间的一阶微分,为χ对时间的一阶微分,为γ对时间的一阶微分;
所述横向位置y和垂向位置z运动模型为:
所述航迹速度Vk运动模型为:
所述航迹偏角χ和航迹倾角γ运动模型为:
3.如权利要求2所述的一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,步骤三中所述的中间变量υ1和υ2如下所示:
υ1=αsinμ,υ2=αcosμ (6)
同时使得:
4.如权利要求3所述的一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,步骤四中将航迹偏角χ和航迹倾角γ运动模型变化成面向控制设计的仿射非线性模型形式具体为:
步骤401、无人机的航迹偏角χ和航迹倾角γ运动模型包括无人机的航迹偏角χ和无人机的航迹倾角γ运动非线性方程;
具体如下:
步骤402、分解无人机的发动机推力D、无人机的阻力C和无人机的侧力L并表示成关于迎角α和侧滑角β的形式;
分解过程如下:
Q为动压;S是无人机气动截面积;cD,cC,cL分别为推力D、阻力C和侧力L的气动系数;c为平均气动弦长;q为俯仰角速率;cL,0为基本升力系数;cD,0为零阻力系数;cC,0为基本侧力系数,当无人机的外形左右对称时;为机翼升力线斜率;为气动升力对迎角平方的偏导数;为俯仰角速度升力系数;为升降舵升力系数;为阻力导数;为气动阻力对迎角平分的偏导数;为升降舵阻力系数;为升降舵平方的阻力系数;为侧力导数;为副翼侧力导数;为方向舵侧力导数;δa为副翼舵偏角,δe为升降舵偏角,δr为方向舵偏角;为升力系数;为阻力系数;为侧力系数;
步骤403、将步骤402中已分解的动力D,C,L表达式代入无人机的航迹偏角χ和无人机的航迹倾角γ运动非线性方程,将无人机的航迹偏角χ运动非线性方程右端分解写成的相关项和无关项:
将无人机的航迹倾角γ运动非线性方程右端分解写成的相关项和无关项:
步骤404、用中间变量υ1,υ2代替αsinμ,αcosμ,并将航迹偏角χ和航迹倾角γ运动非线性方程写成仿射非线性形式,完成航迹偏角χ和航迹倾角γ运动模型的变换;
X2=[γ χ]T,υ=[υ1 υ2]T=[αsinμ αcosμ]T,X3=[α β μ]T (15)
其中,F2为航迹角回路的总干扰,B2为航迹角回路的输入矩阵,为X2对时间的一阶微分,X2为航迹角状态向量,X3为气流角状态向量,υ为中间的虚拟控制向量。
5.如权利要求4所述的一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,所述的步骤五中,将航迹速度Vk运动模型变化成面向控制设计的关于控制量油门开度δT的仿射非线性模型形式具体为:
步骤501、无人机的航迹速度Vk运动模型写成标准微分方程形式,具体如下:
步骤502、分解发动机推力T,并表示成关于控制量油门开度δT的形式代入航迹速度Vk运动模型,具体如下:
Tmax是发动机最大推力;δT是控制量油门开度范围;
步骤503、将航迹速度Vk运动模型写成关于控制量油门开度δT的仿射非线性模型形式,完成航迹速度Vk运动模型的变换:
其中,表示地速回路的总干扰,表示地速回路的输入矩阵。
6.如权利要求5所述的一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,所述步骤六中,将横向位置y和垂向位置z运动模型变化成面向控制设计的仿射非线性模型形式具体为:
步骤601,在无人机横向位置y和垂向位置z运动模型中的横向位置y运动方程中同时增加和减少同一个关于χ的线性项Vkχ,在无人机垂向位置z运动方程中同时增加和减少同一个关于γ的线性项-Vkγ,具体如下;
步骤602,将无人机横向位置y运动方程和垂向位置z运动方程写成:
步骤603,将横向位置y运动方程和垂向位置z运动方程写成关于航迹偏角χ和航迹倾角γ的仿射非线性形式,完成横向位置y和垂向位置z运动模型的仿射非线性变换;
其中,F1表示位置回路的总干扰,B1表示位置回路的输入矩阵,为X1对时间的一阶微分,X1=[y z]T,X1为航迹位置状态向量。
7.如权利要求6所述的一种基于观测补偿技术的航迹回路非线性模型变换方法,其特征在于,所述的步骤七,包括:
步骤701、在已建立的仿射非线性模型基础上,将模型动态中Vk,Xi,i=1,2形式上与虚拟控制量线性无关的Fi,i=1,2视为模型总干扰;
步骤702、对于航迹偏角χ和航迹倾角γ运动模型变化成的仿射非线性模型,设计线性扩张状态观测器,线性扩张状态观测器具体设计如下:
构造的线性扩张状态观测器:
其中,x21为X2的实测值,为线性扩张状态观测器对状态X2的估计,为线性扩张状态观测器对总干扰F2的干扰估计,为对时间的一阶微分,为对时间的一阶微分,F2将在后续反馈控制设计中用以补偿模型扰动;li,i=1,2为待设计的线性扩张状态观测器增益,且
l1=diag(2ω21,2ω22),l2=diag(ω21 2,ω22 2)
其中,ω21,ω22分别为χ,γ通道线性扩张状态观测器带宽;
步骤703、调节并选取合适的线性扩张状态观测器带宽,实现对状态X2及总干扰F2进行估计与补偿。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2018100533752 | 2018-01-19 | ||
CN201810053375 | 2018-01-19 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109828602A true CN109828602A (zh) | 2019-05-31 |
CN109828602B CN109828602B (zh) | 2020-09-04 |
Family
ID=66861002
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910047309.9A Active CN109828602B (zh) | 2018-01-19 | 2019-01-18 | 一种基于观测补偿技术的航迹回路非线性模型变换方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109828602B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111142562A (zh) * | 2019-12-27 | 2020-05-12 | 北京理工大学 | 基于应力矩阵的混合条件约束下的编队变换控制方法 |
CN111258231A (zh) * | 2020-01-20 | 2020-06-09 | 北京航空航天大学 | 仿猛禽视觉导航的自主空中加油对接半物理***及其方法 |
CN111538346A (zh) * | 2020-06-17 | 2020-08-14 | 郑州轻工业大学 | 一种四旋翼直升飞机的干扰观测补偿飞行控制方法 |
CN112000127A (zh) * | 2020-08-13 | 2020-11-27 | 上海航天控制技术研究所 | 一种基于反步法的飞行器横侧向联合控制方法 |
CN112161626A (zh) * | 2020-09-21 | 2021-01-01 | 北京航空航天大学 | 一种基于航路跟踪映射网络的高可飞性航路规划方法 |
CN114564047A (zh) * | 2022-04-28 | 2022-05-31 | 北京航空航天大学 | 一种考虑气象条件的无人机等速飞行控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102193557A (zh) * | 2010-03-04 | 2011-09-21 | 南京航空航天大学 | 无人机的鲁棒受限飞行控制方法 |
CN106774400A (zh) * | 2016-12-28 | 2017-05-31 | 北京航空航天大学 | 一种基于逆动力学的无人机三维轨迹制导方法 |
CN108873929A (zh) * | 2018-05-24 | 2018-11-23 | 北京航空航天大学 | 一种固定翼飞机自主着舰方法及*** |
-
2019
- 2019-01-18 CN CN201910047309.9A patent/CN109828602B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102193557A (zh) * | 2010-03-04 | 2011-09-21 | 南京航空航天大学 | 无人机的鲁棒受限飞行控制方法 |
CN106774400A (zh) * | 2016-12-28 | 2017-05-31 | 北京航空航天大学 | 一种基于逆动力学的无人机三维轨迹制导方法 |
CN108873929A (zh) * | 2018-05-24 | 2018-11-23 | 北京航空航天大学 | 一种固定翼飞机自主着舰方法及*** |
Non-Patent Citations (4)
Title |
---|
HUIPING ZHANG等: "Reduced-order Linear Extended State Observer Based Trajectory Linearization Control for Hypersonic Reentry Vehicle under High Maneuver Flight with Multiple Disturbances", 《IEEE CSAA GUIDANCE,NAVIGATION AND CONTROL CONFERENCE》 * |
XINGLING SHAO等: "Back-stepping robust trajectory linearization control for hypersonic reentry vehicle via novel tracking differentiator", 《JOURNAL OF THE FRANKLIN INSTITUTE》 * |
吴岸平等: "基于风场估计的无人机航迹规划方法研究", 《2014(第五届)中国无人机大会论文集》 * |
常勇等: "无人机非线性非仿射飞控***的自适应模糊H∞输出反馈控制及其应用", 《南京航空航天大学学报》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111142562A (zh) * | 2019-12-27 | 2020-05-12 | 北京理工大学 | 基于应力矩阵的混合条件约束下的编队变换控制方法 |
CN111258231A (zh) * | 2020-01-20 | 2020-06-09 | 北京航空航天大学 | 仿猛禽视觉导航的自主空中加油对接半物理***及其方法 |
CN111258231B (zh) * | 2020-01-20 | 2021-03-30 | 北京航空航天大学 | 仿猛禽视觉导航的自主空中加油对接半物理***及其方法 |
CN111538346A (zh) * | 2020-06-17 | 2020-08-14 | 郑州轻工业大学 | 一种四旋翼直升飞机的干扰观测补偿飞行控制方法 |
CN111538346B (zh) * | 2020-06-17 | 2023-02-10 | 郑州轻工业大学 | 一种四旋翼直升飞机的干扰观测补偿飞行控制方法 |
CN112000127A (zh) * | 2020-08-13 | 2020-11-27 | 上海航天控制技术研究所 | 一种基于反步法的飞行器横侧向联合控制方法 |
CN112000127B (zh) * | 2020-08-13 | 2022-01-14 | 上海航天控制技术研究所 | 一种基于反步法的飞行器横侧向联合控制方法 |
CN112161626A (zh) * | 2020-09-21 | 2021-01-01 | 北京航空航天大学 | 一种基于航路跟踪映射网络的高可飞性航路规划方法 |
CN112161626B (zh) * | 2020-09-21 | 2022-05-17 | 北京航空航天大学 | 一种基于航路跟踪映射网络的高可飞性航路规划方法 |
CN114564047A (zh) * | 2022-04-28 | 2022-05-31 | 北京航空航天大学 | 一种考虑气象条件的无人机等速飞行控制方法 |
CN114564047B (zh) * | 2022-04-28 | 2022-08-16 | 北京航空航天大学 | 一种考虑气象条件的无人机等速飞行控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109828602B (zh) | 2020-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109828602A (zh) | 一种基于观测补偿技术的航迹回路非线性模型变换方法 | |
Oh et al. | Approaches for a tether-guided landing of an autonomous helicopter | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN108873929B (zh) | 一种固定翼飞机自主着舰方法及*** | |
CN109426146A (zh) | 高超声速飞行器的高阶非奇异Terminal滑模控制方法 | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
Bulka et al. | Automatic control for aerobatic maneuvering of agile fixed-wing UAVs | |
CN107390531B (zh) | 参数学习有限时间收敛的高超声速飞行器控制方法 | |
Su et al. | A robust back-stepping based trajectory tracking controller for the tanker with strict posture constraints under unknown flow perturbations | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN109597303A (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
CN106527122B (zh) | 平流层飞艇定高飞行非线性pid控制方法 | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
CN103869817A (zh) | 一种倾转四旋翼无人机垂直起降控制方法 | |
Peddle | Autonomous flight of a model aircraft | |
Hegde et al. | Transition flight modeling and robust control of a VTOL unmanned quad tilt-rotor aerial vehicle | |
CN116300992A (zh) | 一种基于l1自适应动态逆的变体飞行器控制方法 | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN108958278B (zh) | 一种空天飞行器巡航段快速抗干扰制导方法 | |
CN110989397B (zh) | 一种航空器失事搜寻仿真方法及*** | |
CN106681337B (zh) | 基于奇次滑模的平流层飞艇定高飞行控制方法 | |
CN108279562A (zh) | 一种基于滑模pid控制的飞行机械臂 | |
Kumar et al. | Longitudinal control of agile fixed-wing UAV using backstepping | |
CN112947522A (zh) | 一种基于有限时间观测器的硬式空中加油姿态控制方法 | |
Cheng et al. | A corridor-based flight mode transition strategy for agile ducted-fan tail-sitter UAV: Altitude-hold transition |
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 |