CN102289207A - 一种可变飞行模态无人机广义指令生成器及其指令生成方法 - Google Patents
一种可变飞行模态无人机广义指令生成器及其指令生成方法 Download PDFInfo
- Publication number
- CN102289207A CN102289207A CN201110152547XA CN201110152547A CN102289207A CN 102289207 A CN102289207 A CN 102289207A CN 201110152547X A CN201110152547X A CN 201110152547XA CN 201110152547 A CN201110152547 A CN 201110152547A CN 102289207 A CN102289207 A CN 102289207A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mtd
- value
- angle
- 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 135
- 239000013598 vector Substances 0.000 claims abstract description 319
- 238000006243 chemical reaction Methods 0.000 claims abstract description 119
- 230000008569 process Effects 0.000 claims abstract description 93
- 239000011159 matrix material Substances 0.000 claims abstract description 10
- 230000001133 acceleration Effects 0.000 claims description 74
- 238000009966 trimming Methods 0.000 claims description 29
- 230000001419 dependent effect Effects 0.000 claims description 18
- 238000005096 rolling process Methods 0.000 claims description 18
- 230000008859 change Effects 0.000 claims description 10
- 230000003247 decreasing effect Effects 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 7
- 230000000670 limiting effect Effects 0.000 claims description 5
- 238000013459 approach Methods 0.000 claims description 4
- 230000002441 reversible effect Effects 0.000 claims description 4
- 230000011218 segmentation Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims 1
- 238000005457 optimization Methods 0.000 abstract description 6
- 230000000694 effects Effects 0.000 description 5
- 230000007423 decrease Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000011217 control strategy Methods 0.000 description 3
- 230000001276 controlling effect Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 230000002829 reductive effect Effects 0.000 description 2
- 230000001105 regulatory effect Effects 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
- 241000695274 Processa Species 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 230000003631 expected effect Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,该指令生成器包括导引指令生成器、被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器。将模态转换过程的配平等效为依次完成由倾转角与期望俯仰角组合组成的序列中各组合状态的配平,特定倾转角与期望俯仰角组合状态下通过代价函数指导迭代优化配平,实现了状态矢量与广义操纵面控制矢量的配平值随着倾转角与空速指令平稳变化。将配平结果序列采用分段曲线拟合方法建立导引指令生成器、被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器所有的内部函数。且本发明利用matlab数学软件高效、准确的实现迭代优化配平与曲线拟合的工作。
Description
技术领域
本发明属于无人机的飞行控制技术领域,具体涉及一种可变飞行模态无人机广义指令生成器及其指令生成方法。
背景技术
可变飞行无人机是在常规固定翼飞机基础上增加推力/拉力矢量装置,既实现了直升机的短距起降能力,又具有固定翼飞机的高速巡航能力,从而降低了对起飞着陆环境的依赖,并高效的执行任务,具有广阔的应用前景。
可倾转的旋翼与矢量喷管是推力/拉力矢量比较有代表性的形式。可见,推力/拉力矢量可能会包含多个操纵量,除了油门操纵外,某些操纵量主要产生俯仰操作效应,某些操纵量主要产生偏航操作效应,某些操纵量主要产生滚转操作效应。因此,可以将推力/拉力矢量的操纵面与气动操纵面统称为广义操纵面。如果将推力/拉力矢量垂直向上拉动或者垂直向下推动对应的倾转角定义为90°,将推力/拉力矢量水平向前拉动或者垂直向后推动的倾转角定义为0°,可变飞行模态无人机从直升机悬停状态到固定翼飞行模态转化过程中空速逐渐增加,倾转角逐渐减小,推力/拉力矢量操作效能逐渐退化,气动操纵面操作效能逐渐增强。
可变飞行模态无人机模态转换控制首先遇到的问题是模态转换如何导引,转换过程中需要控制哪些状态量,并且这些状态量的指令是如何被导引变化的问题。模态转换过程是平衡状态连续更新的过程,在某倾转角下,空速只有处在某限定的对应范围之内,无人机才能稳定平飞。不同的空速、倾转角对应关系可能会导致姿态角或者某些有效操纵面的大幅度波动,影响转换效果,甚至引起安全事故。模态转换过程平衡状态是通过力与力矩的配平操作来完成,而可变飞行模态无人机操纵面数量多于方程数量导致多解问题,不同操纵面偏转范围及所承担的操作效能不同,试凑的方法工作量大,效率低下,很难达到好的配平效果。因此,需要设计高效的优化迭代算法,实现整个模态转换过程合理配平。由于模态转换过程中的无人机的状态连续变化,控制律可能需要融合无人机的状态平衡值值及广义操纵面的控制矢量平衡值信息,从而增强对于整个模态的适应性。
许多研究者往往采用试凑的方法实现可变飞行模态无人机模态转换过程中的配平,配平过程未考虑综合优化姿态角及操纵面偏转角,稳定性较差,计算复杂,没有指出怎么利用配平数据来生成指令系统来引导自动模态转换飞行,也没有充分的将配平信息作为指令系统的输出,应用用于控制律,可变飞行模态无人机的自动模态转换受到限制。因此,需要给出可变飞行模态无人机的控制策略,设计高效、优化算法实现全过程的合理配平,并且利用配平值设计模态转换的指令系统和平衡值系统,从而为平稳、安全的模态转换控制提供依据。
发明内容
本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,本发明在于将模态转换过程的配平等效为依次完成由倾转角与期望俯仰角组合组成的序列中各组合状态的配平,特定的倾转角与期望俯仰角组合状态下通过代价函数指导迭代优化配平,实现了状态矢量与广义操纵面控制矢量的配平值随着倾转角与空速指令平稳变化。将配平结果序列采用分段曲线拟合方法建立导引指令生成器、被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器所有内部函数。
本发明提出一种可变飞行模态无人机广义指令生成器,包括导引指令生成器、被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器;模态转换指令TL与时间t进入到导引指令生成器后,根据倾转角生成函数τ(TL,t)生成导引模态转换的倾转角指令τ,根据空速生成函数Vkg(TL,t)生成空速指令Vkg,并将倾转角指令τ和空速指令Vkg均发送至被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器;通过被控状态指令生成器得到空速指令Vkg、高度指令Hg、侧偏距指令Dzg和偏航角指令ψg;通过状态基准值生成器得到状态矢量平衡值X*;通过广义操纵面基准指令生成器得到广义操纵面控制矢量的平衡值δ*。
本发明提出一种可变飞行模态无人机广义指令生成器的指令生成方法,具体包括以下几个步骤:
步骤一:确定的模态转换飞行的导引方式及无人机被控状态量:
(1)选取倾转角与空速的组合作为模态转换飞行的引导方式;
(2)无人机被控状态量选取为空速、高度、侧偏距、偏航角;高度指令为固定值H0,侧偏距指令为0,偏航角指令是由航线中从点与到点经纬度信息计算得到的确定值,空速指令由模态转换过程配平后确定的倾转角生成函数τ(TL,t)与空速生成函数Vkg(TL,t)确定。
步骤二:(1)确定无人机能够平稳转换的合理配平的原则:
俯仰角配平值等于期望俯仰角,广义操纵面控制矢量中各个控制量的配平值相对于其偏转范围最小。
选取代价函数C为:
其中,表示期望的俯仰角,α*表示迎角配平值,表示俯仰角配平值,表示升降舵配平值,分别表示推力/拉力矢量的第i个俯仰操纵量配平值,n3表示推力/拉力矢量俯仰操纵量的数目,k0表示俯仰角误差系数,k1表示推力/拉力矢量俯仰操纵量δTz1、δTz2、…、δTzn3的代价系数,k2表示升降舵δz的代价系数,cT表示推力/拉力矢量俯仰操纵量的权限系数,cz表示升降舵的权限系数,分别表示推力/拉力矢量第i个俯仰操纵量的最大允许偏转范围,δzmax表示升降舵最大允许偏转范围。
推力/拉力俯仰操纵量权限系数cT及升降舵的权限系数cz为:
cz=1-cT
其中,τ表示倾转角,τmax表示最大的倾转角,τ1取值范围为τmax/6~τmax/4,τ2取值范围为3×τmax/4~5×τmax/6;
步骤三:对于模态转换过程中特定倾转角与期望俯仰角的组合状态在matlab软件中建立表示可变飞行模态无人机运动学方程的模型文件,利用matlab软件的配平函数,通过调整空速配平初值、广义操纵面控制矢量的配平初值,不断迭代优化实现代价函数值最小,达到特定倾转角及期望俯仰角组合状态下的合理配平。具体过程为:
(1)搭建航迹坐标系下可变飞行模态无人机的输入输出关系图:
航迹坐标系选用苏联坐标系,其状态矢量X选取空速Vk、迎角α、侧滑角β、滚转角速率ωx、偏航角速率ωy、俯仰角速率ωz、俯仰角偏航角ψ、滚转角γ、高度H、侧偏距Dz、升降速度Vyd、侧偏速度Vzd;广义操纵面控制矢量δ为倾转角为τ、副翼偏转角δx、方向舵偏转角δy、升降舵偏转角δz、油门开度δp、推力/拉力滚转操纵量偏转角δTx1、δTx2、…、推力/拉力偏航操纵量偏转角δTy1、δTy2、…、推力/拉力俯仰操纵量偏转角δTz1、δTz2、…、其中n1表示推力/拉力矢量滚转操纵量的数目,n2表示推力/拉力矢量偏航操纵量的数目,n3表示推力/拉力矢量俯仰操纵量的数目;γs、ψs、θ分别表示航迹滚转角、航向角、航迹俯仰角;定义无人机的质量为m,滚转转动惯量为Ix、偏航转动惯量为Iy、俯仰转动惯量为Iz、惯性积为Ixy;机体部分产生的升力为Y、阻力为Q、侧力为Z,推力/拉力矢量产生的航迹坐标系前向拉力为Txh、纵向拉力为Tyh、侧向拉力为Tzh;推力/拉力矢量产生的地面坐标系前向拉力为Tyd、侧向力为Tzd;机体产生的滚转、偏航、俯仰力矩分别为Mxb、Mxb、Mzb,推力拉力矢量产生的滚转、俯仰、偏航力矩分别为MxT、MxT、MzT,总的滚转力矩Mx=Mxb+MxT,偏航力矩My=Myb+MyT,俯仰力矩Mz=Mzb+MzT。
状态矢量的微分方程分别为:
(2)matlab软件配平函数的配置及使用方法:
设定状态矢量配平初值为:
广义操纵面控制矢量配平初值为:
输出矢量配平初值为Y0=X0;限定横侧向状态矢量配平值与横侧向操纵量的配平值均等于0;限定纵向状态矢量中空速配平值倾转角配平值τ*、高度配平值H*等于配平初值Vk0、τ0、H0;不限制俯仰角油门开度δp、升降舵偏转角δz,推力/拉力矢量俯仰控制量偏转角δTz1、δTz2、…、状态矢量限制阵为IX=[1;3;4;5;6;8;9;10;11;12;13],输出矢量的限制阵为IY=IX,广义操纵面的控制矢量限制阵为IU=[1;2;3;6;7;…;5+n1+n2;6+n1+n2]。
(3)对于特定的倾转角和期望俯仰角组合状态,通过调整空速配平初值使得俯仰角配平值逼近期望俯仰角,通过调整广义操纵面中权限高并且相对偏转角度大的操纵面来优化广义操纵面控制矢量的配平值,从而达到代价函数值最小,具体步骤为:
③根据状态量配平初值Vk0(i),α0(i),H0(i)构造第i次迭代的状态矢量配平初值X0(i),构造第i次迭代的广义操纵面控制矢量的配平初值为δ0(i),输出矢量的配平初值Y0(i)=X0(i);
根据配平函数[X*(i),δ*(i),Y*(i)]=trim(′model′,X0(i),δ0(i),Y0(i),IX,IU,IY)进行第i次迭代配平,得到状态矢量配平值X*(i),广义操纵面控制矢量配平值δ*(i),输出矢量配平值Y0 *(i);将期望俯仰角俯仰角配平值和广义操纵面控制矢量配平值δ*(i)带入到代价函数计算公式中,得到第i次迭代的代价函数值C(i)。α*(i)表示迎角配平值;
④空速调整阶段:
⑤操纵面调整段:
根据状态量配平初值Vk0(j),α0(j),H0(j)构造状态矢量配平初值X0(j),构造第j次迭代的广义操纵面控制矢量的配平初值δ0(j),输出矢量配平初值Y0(j)=X0(j),
根据配平函数[X*(j),δ*(j),Y*(j)]=trim(′model′,X0(j),δ0(j),Y0(j),IX,IU,IY),得到状态矢量配平值X*(j),广义操纵面控制矢量配平值δ*(j),输出矢量配平值Y0 *(j),将期望俯仰角俯仰角配平值广义操纵面控制矢量配平值δ*(j)带入到代价函数计算公式中,得到第j次迭代的代价函数值C(j);α*(j)表示迎角配平值;
如果且代价函数值C(j)<C(j-1),当τ<(τ1+τ2)/2,则选取推力拉力矢量中配平值相对最大偏转范围的偏转角度最大的操纵面(k=1,2,…,n3)为被调整操纵面δM(j),当τ≥(τ1+τ2)/2,选取升降舵δz为被调整操纵面δM(j);对于被调整操纵面配平初值进行调整其中表示被调整操纵量的配平初值,表示对于操纵面配平初值的调整角度相对于最大偏转操作范围的数值,表示被调操纵面的最大偏转范围,将被调整操纵面的配平初值δM0(j+1)带入到广义操纵面控制矢量配平初值δ0(j+1)对应位置中,其他操纵面配平初值等于广义操纵面控制矢量配平值δ*(j)对应值,状态矢量配平初值X0(j+1)=X0(j),返回步骤第⑤步进行第j+1次迭代;
步骤四:建立从最小期望俯仰角固定翼平飞状态到直升机悬停状态之间一系列由倾转角与期望俯仰角组合组成的序列,不断重复步骤三的配平过程实现该组合序列中所有组合状态下的合理配平,从而完成模态转换过程合理配平。
(1)划分模态转换过程的阶段,并确定各阶段的期望俯仰角:
将模态转换过程分为三个阶段:直升机加减速阶段、倾转角倾转阶段和固定翼加减速阶段;倾转角倾转阶段要求倾转角恒定为对于直升机悬停模态下,空速配平初值为0.0001m/s,给出广义操纵面控制矢量配平初值δ0,俯仰角配平初值等于倾转角倾转阶段的期望俯仰角采用步骤三的配平过程进行迭代,如果无法实现配平则按照步长增加期望的俯仰角重复步骤三的配平过程,最终实现配平得到俯仰角配平值及倾转角配平值τ*,从而确定直升机悬停状态下的期望俯仰角和最大倾转角τmax=τ*;固定翼加减速阶段最小期望俯仰角αmin表示飞机安全迎角,表示最小俯仰角。
(2)确定模态转换过程倾转角与期望俯仰角组合序列:
h1∈Z
h2=floor[(τmax-0)/Δτ]+1 h2∈Z
其中,h1、h2、h3属于整数集Z,函数floor[x]表示不大于x的最大整数;从最小期望俯仰角固定翼平飞状态到直升机悬停状态之间,倾转角τ与期望俯仰角组合所组成的的组合序列为:
(3)①确定最小期望俯仰角固定翼平飞状态的配平初值:
最小期望俯仰角的固定翼平飞状态下,无人机的升力公式为:
ρ表示空气密度,CY(αmin)表示在最小期望迎角αmin下产生的升力系数,S表示机翼面积,g为重力加速度,Vkmax表示最小期望俯仰角固定翼平飞状态的飞行速度。
固定翼加减速阶段下最小期望迎角下的飞行速度:
最小期望俯仰角固定翼平飞状态空速配平初值满足Vk0>Vkmax;
将所有状态量配平初值带入到状态矢量配平初值相应位置,从而确定最小期望俯仰角固定翼平飞状态矢量配平初值X01,将广义操纵面控制矢量所有配平初值带入到广义操纵面控制矢量配平初值的相应位置,从而确定最小期望俯仰角固定翼平飞状态广义操纵面控制矢量的配平初值δ01。
②按照从最小期望俯仰角的固定翼平飞状态到直升机悬停状态之间倾转角与俯仰角期望值组合所组成的序列逐步配平,将组合序列中前一倾转角与期望俯仰角组合确定的配平结果作为下一个组合状态的配平初值,更新广义操纵面控制矢量配平初值中的倾转角初值为新的倾转角与期望俯仰角组合中的倾转角,采用步骤三的合理配平过程确定新的倾转角与期望俯仰角组合的配平,从而获得模态转换过程配平结果序列。
由倾转角与期望俯仰角组合序列所确定的所有的状态矢量配平值与广义操纵面控制矢量配平值组成模态转换过程配平结果序列:
步骤五:根据步骤四中得到的由倾转角与期望俯仰角组合序列所确定的配平结果序列,将模态转换过程的引导指令及被控状态的进行定量化,从而确定引导指令生成函数及被控状态生成函数,用于驱动无人机的模态转换。
(1)由模态转换过程配平结果序列确定引导指令生成函数:
对倾转角倾转阶段所有的倾转角与期望俯仰角的组合通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=h1,(h1+1),…,(h1+h2),以倾转角τh组成的序列为自变量,以空速配平值组成的序列为因变量进行多项式曲线拟合,得到拟合函数Vkg(τ)。
在空速给定值Vkg<VkT时,倾转角固定为最大倾转角τmax,空速给定值按照加速度为改变;在空速给定值处于VkT<Vkg≤VkA时,倾转角按照速率为ωτ倾转;空速给定值Vkg>VkA时,倾转角固定为最小倾转角0°,空速给定值按照加速率为改变。
在模态转换时刻t0,初始空速为0m/s,初始倾转角为τmax,当TL=-1,由倾转角与空速组合来引导的倾转角逐渐减小、空速逐渐增加的正向倾转的导引指令生成器函数表示如下:
在模态转换时刻t0,初始空速为Vkmax,初始倾转角为0°,当TL=1,由倾转角与空速组合来引导的倾转角逐渐增加、空速逐渐减小的反向倾转的导引指令生成器函数表示如下:
其中,TL表示模态转换指令,TL=-1表示倾转角逐渐减小、空速逐渐增加的正向模态转换过程,TL=1表示倾转角逐渐增加、空速逐渐减小的反向模态转换过程,Limit(x,xmin,xmax)表示将变量x限幅在最小值xmin与最大值xmax之间的限幅函数:
(2)由模态转换全过程配平结果序列确定被控状态指令生成函数:
空速指令生成函数空速输出值等于导引指令生成器生成的空速导引指令Vkg(τ,Vkg)=Vkg(TL,t)。
高度指令生成函数Hg(τ,Vkg)=H0。其中H0表示进行模态转换飞行的高度。
侧偏距指令生成函数Dzg(τ,Vkg)=0,其中H0表示进行模态转换飞行的高度;
对于从点经度纬度分别为LA、BA,到点经纬度分别为LB、BB,设定正北方向为零航向,则根据导航运算公式得到偏航角指令生成函数为:
步骤六:直升机加减速阶段空速给定值满足Vkg≤VkT,对应倾转角与期望俯仰角的组合状态其中h=(h1+h2),(h1+h2+1),…,(h1+h2+h3);倾转角倾转阶段空速给定值满足VkT<Vkg≤VkA,对应倾转角与期望俯仰角的组合状态其中h=h1,(h1+1),…,(h1+h2);固定翼加减速阶段空速给定值满足Vkg>VkA,对应倾转角与期望俯仰角的组合状态其中h=1,2,…,h1;根据空速给定值Vkg分段,分别对于无人机的状态矢量配平值进行曲线拟合,得到无人机的状态基准值生成函数X*(τ,Vkg),对于广义操纵面控制矢量配平值进行曲线拟合,得到广义操纵面基准指令生成函数δ*(τ,Vkg),具体过程为:
(1)根据配平结果序列,以倾转角τ和空速给定值Vkg为自变量对于无人机状态矢量的配平值进行分段拟合,确定基准状态生成函数X*(τ,Vkg)。
状态基准值生成函数X*(τ,Vkg)中的侧滑角基准值生成函数β*(τ,Vkg)、滚转角速率基准值生成函数偏航角速率基准值生成函数俯仰角速率基准值生成函数滚转角基准值生成函数γ*(τ,Vkg)、侧偏距基准值生成函数升降速度基准值生成函数侧偏速度基准值生成函数恒为0;高度基准指令生成函数H*(τ,Vkg)=H0,偏航角基准指令生成函数ψ*(τ,Vkg)=ψg(τ,Vkg),空速基准指令生成函数俯仰角基准值由空速Vkg、倾转角τ分段拟合得到,俯仰角配平值拟合函数为:
直升机加减速阶段,对于倾转角与期望俯仰角的组合状态通过配平得到状态矢量配平值及广义操纵面控制矢量配平值其中,h=(h1+h2),(h1+h2+1),…,(h1+h2+h3);以状态矢量配平值中的空速配平值为自变量,以俯仰角配平值为因变量进行多项式曲线拟合,得到直升机加减速阶段的俯仰角拟合函数
固定翼加减速阶段,对于倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=1,2,…,h1,以状态矢量配平值中的空速配平值为自变量,以俯仰角配平值为因变量进行多项式曲线拟合,得到固定翼加减速的俯仰角拟合函数
(2)根据配平结果序列,以倾转角τ和空速给定值Vkg为自变量对于无人机广义操纵面控制矢量的配平值进行分段曲线拟合,确定广义操纵面基准指令生成函数δ*(τ,Vk)。
对于直升机加减速阶段所有倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=(h1+h2),(h1+h2+1),…,(h1+h2+h3),以状态矢量配平值中的空速配平值为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到直升机加减速阶段的拟合函数 l=1,2,…,n3,表示推力/拉力矢量中第l个俯仰操纵量在直升机加减速阶段的配平值,表示推力/拉力矢量中第l个俯仰操纵量在直升机加减速阶段的拟合函数。
对于倾转角倾转阶段所有于倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中h=h1,(h1+1),…,(h1+h2),以倾转角τh为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到倾转角倾转阶段的拟合函数 l=1,2,…,n3,表示推力/拉力矢量中第l个俯仰操纵量在倾转角倾转阶段的配平值,表示推力/拉力矢量中第l个俯仰操纵量在倾转角倾转阶段的拟合函数。
对于固定翼加减速阶段所有倾转角与期望俯仰角的组合通过配平得到对应的状态配平值及广义操纵面配平值其中,h=1,2,…,h1,以状态矢量配平值中的为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到固定翼加减速阶段的拟合函数 l=1,2,…,n3,表示推力/拉力矢量中第l个俯仰操纵量在固定翼加减速阶段的配平值,表示推力/拉力矢量中第l个俯仰操纵量在固定翼加减速阶段的拟合函数。
本发明优点在于:
(1)本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,通过对模态转换机理深入分析,给出一种合理、平稳的转换策略,为控制律设计打下良好基础。
(2)本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,给出一种可变飞行模态无人机模态转换过程的配平方法,模态转换过程中的某一平衡状态由倾转角与期望俯仰角组合确定,该方法通过倾转角与期望俯仰角的组合组成的序列来表征模态转换过程,将模态转换过程的配平等效为依次完成组合序列中各个组合状态下配平,从而将期望俯仰角与模态转换过程中倾转角对应,清晰直观。
(3)本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,基于倾转角与期望俯仰角的组合序列对应状态进行依次配平,将序列中前一组合实现的配平值作为后一组合的配平初值,保证了状态矢量配平值及广义操纵面控制矢量配平值随着倾转角及空速指令的连续平稳变化。
(4)本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,在对于特定的倾转角与期望俯仰角组合状态下进行配平过程,采用了代价函数指导配平过程的迭代优化,保证了无人机俯仰角配平值跟踪期望俯仰角,同时兼顾操纵面的操作权限及偏转范围,优化了模态转换过程的广义操纵面控制矢量的配平值,防止操纵面的饱和。
(5)本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,充分利用数学软件matlab的强大的功能,高效、准确的实现飞机运动方程的搭建、迭代优化配平、曲线的拟合等复杂工作。
(6)本发明提出一种可变飞行模态无人机广义指令生成器及其指令生成方法,广义指令生成器根据导引信息解算无人机的状态矢量平衡值及广义操纵面控制矢量的平衡值,便于控制律设计。
附图说明
图1:本发明提出一种可变飞行模态无人机广义指令生成器的结构示意图;
图2:本发明中偏航角控制示意图;
图3:本发明中模态转换飞行被控状态量示意图;
图4:本发明特定倾转角与期望俯仰角组合下配平的流程图;
图5:本发明中模态转换全过程配平流程图;
图6-A:采用本发明得到的某小型倾转旋翼无人机倾转角与空速对应关系图;
图6-B:采用本发明得到的某小型倾转旋翼无人机迎角配平曲线图;
图6-C:采用本发明得到的某小型倾转旋翼无人机俯仰角配平曲线图;
图6-D:采用本发明得到的某小型倾转旋翼无人机油门配平曲线图;
图6-E:采用本发明得到的某小型倾转旋翼无人机升降舵配平曲线图;
图6-F:采用本发明得到的某小型倾转旋翼无人机倾角中值配平曲线图。
具体实施方式
下面结合附图对本发明进一步详细说明:
本发明提出一种可变飞行模态无人机广义指令生成器,如图1所示,包括导引指令生成器、被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器。
模态转换指令TL与时间t进入到导引指令生成器后,根据倾转角生成函数τ(TL,t)生成导引模态转换的倾转角指令τ,根据空速生成函数Vkg(TL,t)生成空速指令Vkg,并将倾转角指令τ和空速指令Vkg均发送至被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器。
被控制状态指令生成器由空速指令生成函数Vkg(τ,Vkg)、高度指令生成函数Hg(τ,Vkg)、侧偏距指令生成函数Dzg(τ,Vkg)、偏航角指令生成函数ψg(τ,Vkg)组成。空速指令生成函数Vkg(τ,Vkg)根据倾转角指令τ,解算出空速指令Vkg;高度指令生成函数Hg(τ,Vkg)根据倾转角指令τ与空速指令Vkg,解算得出高度指令Hg;侧偏距指令生成函数Dzg(τ,Vkg)根据倾转角指令τ与空速指令Vkg,解算得出侧偏距指令Dzg,偏航角指令生成函数ψg(τ,Vkg)根据倾转角指令τ与空速指令Vkg,解算得出偏航角指令ψg。
操纵面状态基准值生成器由状态基准指令生成函数X*(τ,Vkg)构成,其中X*(τ,Vkg)包含了无人机的空速基准值生成函数迎角基准值生成函数α*(τ,Vkg)、侧滑角基准值生成函数β*(τ,Vkg)、滚转角速率基准值生成函数偏航角速率基准值生成函数俯仰角速率基准值生成函数俯仰角基准值生成函数偏航角基准值生成函数ψ*(τ,Vkg)、滚转角基准值生成函数γ*(τ,Vkg)、高度基准值生成函数H*(τ,Vkg)、侧偏距基准值生成函数升降速度基准值生成函数和侧偏速度基准值生成函数状态基准值生成器根据相应的基准值生成函数生成对应倾转角及空速导引指令下相应的无人机状态矢量平衡值X*。
广义操纵面基准指令生成器由状态基准指令生成函数δ*(τ,Vkg)构成,其中X*(τ,Vkg)包含了倾转角基准指令生成函数为τ*(τ,Vkg)、副翼基准指令生成生成函数方向舵基准指令生成生成函数升降舵基准指令生成生成函数油门基准指令生成生成函数推力/拉力滚转操纵量基准指令生成生成函数推力/拉力偏航操纵量基准指令生成生成函数推力/拉力俯仰操纵量基准指令生成生成函数其中n1表示推力/拉力矢量滚转操纵面量的数目,n2表示推力/拉力矢量偏航操纵面量的数目,n3表示推力/.拉力矢量俯仰操纵面量的数目。广义操纵面基准指令生成器根据相应的基准指令生成函数生成对应倾转角及空速导引指令下的相应广义操纵面控制矢量的平衡值δ*。
本发明还提出一种可变飞行模态无人机广义指令生成器的指令生成方法,具体包括以下几个步骤:
步骤一:综合分析应用环境、任务性质及无人机配置,定性确定的模态转换飞行的导引方式及无人机被控状态量。
可变飞行模态无人机的模态转换飞行的导引方式和被控状态量是无人机的整体控制策略问题,它决定以何种方式进行模态转换飞行,是模态转换控制律设计的前提。导引方式和被控状态量选取不当,控制律设计将没有意义,无法实现预期的稳定安全转换飞行的效果。
(1)确定空速与倾转角组合引导方式:
由于可变飞行模态无人机在模态转换过程中,倾转角与空速都连续变化,不同的倾转角与空速的组合代表不同的转换过程,因此,选取倾转角与空速的组合作为模态转换飞行的引导方式。
(2)确定定高模态、无侧偏、定航向且空速给定随倾转角连续变化的控制策略:
可变飞行模态无人机比较典型的应用于舰艇、野外、海岸线等无跑道或者短距跑道的环境中,往往按照编排的航线飞行来执行任务,因此,要求可变飞行模态无人机进行的轨迹控制为纵向控制高度即定高模态,横侧向控制侧偏距,即无侧偏。按照航线飞行要求控制侧偏为0。爬升转换飞行与下降转换飞行,由于转换过程高度变换伴随动能与势能的转换而引起较大的俯仰角波动,影响模态转换的平稳性,因此,选用定高模态转换飞行。
由于倾转角与空速的组合引导模态转换飞行过程,必然要求空速跟踪空速指令,而采用前偏距控制和俯仰控制只是间接的实现空速的连续增加,不能实现精确的闭环控制。因此,将空速作为无人机的被控状态量。
由于航向的静稳定性的存在,常规的固定翼无人机在航线飞行阶段往往不进行航向控制,无人机机头会指向气流的来向。可变飞行模态无人机往往在舰艇、野外、海岸线等气流变化明显的环境中,如图2所示,如果不控制航向可能会导致机头来回摇摆,同时推力/拉力矢量产生侧力,需要无人机的滚转作用来抵消,并减小了推力/拉力矢量的对于空速的贡献效率,因此,需要控制偏航角使机头指向航线方向,即定航向,保证模态转换中横侧向平稳性。
如图3所示,无人机被控状态量选取为空速、高度、侧偏距、偏航角。其中,高度指令为固定值H0,侧偏距指令为0。偏航角指令是由航线中从点与到点经纬度信息计算得到的确定值,空速指令由模态转换全过程配平后确定的倾转角生成函数τ(TL,t)与空速生成函数Vkg(TL,t)确定。
步骤二:根据可变飞行模态无人机飞行平稳性、操纵面的权限、操纵面的效率及操纵面偏转范围等因素来确定无人机平稳转换的合理配平原则及代价函数。
(1)确定无人机能够平稳转换的合理配平的原则:
可变飞行模态无人机合理配平的原则:俯仰角配平值等于期望俯仰角,同时广义操纵面控制矢量中各个控制量的配平值操纵面相对于其最大偏转范围最小。
代价函数是对于配平合理程度的量度,代价函数越小,表示配平过程越合理,模态转换过程越平稳。选取代价函数C为:
其中,表示期望的俯仰角,α*表示迎角配平值,表示俯仰角配平值,表示升降舵配平值,表示推力/拉力矢量的第i个俯仰操纵量的配平值。n3表示推力/拉力矢量俯仰操纵量的数目。k0表示俯仰角误差系数,k1表示推力/拉力矢量俯仰操纵量δTz1、δTz2、…、δTzn3的代价系数,k2表示升降舵δz的代价系数,cT表示推力/拉力矢量俯仰操纵量的权限系数,cz表示升降舵的权限系数。表示推力/拉力矢量第i个俯仰操纵量δTzi的最大允许偏转范围,δzmax表示升降舵最大允许偏转范围。
倾转角τ处于不同值时,推力/拉力俯仰操纵量权限系数cT及升降舵的权限系数cz为:
cz=1-cT
其中,τ表示倾转角,τmax表示最大的倾转角,τ1取值范围为τmax/6~τmax/4,τ2取值范围为3×τmax/4~5×τmax/6。
代价函数C中的代价系数k0、k1、k2的选取要求以最大权限调整广义操纵面相对偏转角度时,不会导致代价函数值的增加。定义最大允许俯仰角偏差为广义操纵面最大允许调整的偏转角除以其最大偏转范围数值为升降舵最大允许调整的偏转角除以其最大偏转范围的数值为则:
步骤三:对于模态转换过程中由特定倾转角与期望俯仰角的组合状态在matlab软件中建立表示可变飞行模态无人机运动学方程的模型文件,利用matlab软件的配平函数,通过调整空速配平初值、广义操纵面控制矢量的配平初值,不断迭代优化实现代价函数值最小,达到特定倾转角及期望俯仰角组合状态下的合理配平。具体过程为:
(1)搭建航迹坐标系下可变飞行模态无人机的输入输出关系图:
航迹坐标系选用苏联坐标系,其状态矢量X选取空速Vk、迎角α、侧滑角β、滚转角速率ωx、偏航角速率ωy、俯仰角速率ωz、俯仰角偏航角ψ、滚转角γ、高度H、侧偏距Dz、升降速度Vyd、侧偏速度Vzd。广义操纵面控制矢量δ为倾转角为τ、副翼偏转角δx、方向舵偏转角δy、升降舵偏转角δz、油门开度δp、推力/拉力滚转操纵量偏转角δTx1、δTx2、…、推力/拉力偏航操纵量偏转角δTy1、δTy2、…、推力/拉力俯仰操纵量偏转角δTz1、δTz2、…、其中n1表示推力/拉力矢量滚转操纵量的数目,n2表示推力/拉力矢量偏航操纵量的数目,n3表示推力/拉力矢量俯仰操纵量的数目。γs、ψs、θ分别表示航迹滚转角、航向角、航迹俯仰角。定义无人机的质量为m,滚转转动惯量为Ix、偏航转动惯量为Iy、俯仰转动惯量为Iz、惯性积为Ixy。机体部分产生的升力为Y、阻力为Q、侧力为Z,推力/拉力矢量产生的航迹坐标系前向拉力为Txh、纵向拉力为Tyh、侧向拉力为Tzh。推力/拉力矢量产生的地面坐标系前向拉力为Tyd、侧向力为Tzd。机体产生的滚转、偏航、俯仰力矩分别为Mxb、Mxb、Mzb,推力拉力矢量产生的滚转、俯仰、偏航力矩分别为MxT、MxT、MzT。则有总的滚转力矩Mx=Mxb+MxT,偏航力矩My=Myb+MyT,俯仰力矩Mz=Mzb+MzT。
状态矢量的微分方程分别为:
(2)matlab软件配平函数配置及使用方法:
设定状态矢量配平初值为:
广义操纵面控制矢量配平初值为:
输出矢量配平初值为Y0=X0。限定横侧向状态矢量配平值与横侧向操纵量的配平值均等于0。限定纵向状态矢量中空速配平值倾转角配平值τ*、高度配平值H*等于配平初始Vk0、τ0、H0。不限制俯仰角油门开度δp、升降舵偏转角δz,推力/拉力矢量俯仰控制量偏转角δTz1、δTz2、…、状态矢量限制阵为IX=[1;3;4;5;6;8;9;10;11;12;13],输出矢量的限制阵为IY=IX,广义操纵面的控制矢量限制阵为IU=[1;2;3;6;7;…;5+n1+n2;6+n1+n2]。
在matlab软件环境中,采用如下的公式对于第(1)步中建立的表示可变模态无人机输入输出关系的模型文件model.mdl进行一次配平:
通过配平,可以得到此次配平过程的状态矢量配平值广义操纵面控制矢量配平值及输出矢量配平值状态矢量配平值包含了状态量配平值α* β*、 ψ*、γ*、H*、广义操纵面控制矢量配平值包含广义操纵面控制量配平值τ*、
(3)对于特定的倾转角和期望俯仰角组合状态,通过调整空速给定值使得俯仰角配平值逼近期望俯仰角,通过调整广义操纵面中权限高并且配平值相对其偏转范围的偏转角度大的操纵面来优化广义操纵面控制矢量的配平值,从而达到代价函数值最小,如图4所示,具体步骤为:
③根据状态量配平初值Vk0(i),α0(i),H0(i)构造第i次迭代的状态矢量配平初值X0(i),构造第i次迭代的广义操纵面控制矢量的配平初值为δ0(i),输出矢量的配平初值Y0(i)=X0(i)。
根据配平函数[X*(i),δ*(i),Y*(i)]=trim(′model′,X0(i),δ0(i),Y0(i),IX,IU,IY)进行第i次迭代配平,得到状态矢量配平值X*(i),广义操纵面控制矢量配平值δ*(i),输出矢量配平值Y0 *(i)。将期望俯仰角俯仰角配平值和广义操纵面控制矢量配平值δ*(i)带入到代价函数计算公式中,得到第i次迭代的代价函数值C(i)。α*(i)表示迎角配平值。
④空速调整阶段:
如果且满足C(i)≥C(i-1),则更新j=i+1,δ0(j)=δ*(i-1), H0(j)=H0,跳出空速调整段,进入第⑤步操纵面调整段。
⑤操纵面调整段:
根据状态量配平初值Vk0(j),α0(j),H0(j)构造状态矢量配平初值X0(j),构造第j次迭代的广义操纵面控制矢量的配平初值δ0(j),输出矢量配平初值Y0(j)=X0(j)。
根据配平函数[X*(j),δ*(j),Y*(j)]=trim(′model′,X0(j),δ0(j),Y0(j),IX,IU,IY),得到状态矢量配平值X*(j),广义操纵面控制矢量配平值δ*(j),输出矢量配平值Y0 *(j)。将期望俯仰角俯仰角配平值广义操纵面控制矢量配平值δ*(j)带入到代价函数计算公式中,可以得到第j次迭代的代价函数值C(j)。α*(j)表示迎角配平值。
如果且代价函数值C(j)<C(j-1),当τ<(τ1+τ2)/2,则选取推力拉力矢量中配平值相对最大偏转范围的偏转角度最大的操纵面(k=1,2,…,n3)为被调整操纵面δM(j),当τ≥(τ1+τ2)/2,选取升降舵δz为被调整操纵面δM(j)。对于被调整操纵面配平初值进行调整其中表示被调整操纵量的配平初值,表示对于操纵面配平初值的调整角度相对于最大偏转范围的数值,表示被调操纵面的最大偏转范围。将被调整操纵面的配平初值δM0(j+1)带入到广义操纵面控制矢量配平初值δ0(j+1)对应位置中,其他操纵面配平初值等于广义操纵面控制矢量配平值δ*(j)对应值,状态矢量配平初值X0(j+1)=X0(j),返回步骤第⑤步进行第j+1次迭代;
步骤四:建立从最小期望俯仰角固定翼平飞状态到直升机悬停状态之间一系列由倾转角与期望俯仰角组合组成的序列,不断重复步骤三的配平过程实现该组合序列中所有组合状态下合理配平,从而完成模态转换过程合理配平。
(1)划分模态转换过程的阶段,并确定各阶段的期望俯仰角:
将模态转换过程分为三个阶段:直升机加减速阶段、倾转角倾转阶段和固定翼加减速阶段。倾转角倾转阶段要求倾转角恒定为(为0°~6°中的常数)。对于直升机悬停模态(直升机加减速阶段的开始阶段)下,选定空速配平初值为0.0001m/s,给出广义操纵面控制矢量配平初值δ0,俯仰角配平初值等于倾转角倾转阶段的期望俯仰角采用步骤三的配平过程进行迭代,如果无法实现合理配平则按照步长增加期望的俯仰角重复步骤三的配平过程,最终实现合理配平得到俯仰角配平值及倾转角配平值τ*,从而确定直升机悬停状态下的期望俯仰角和最大倾转角τmax=τ*。固定翼加减速阶段最小期望迎角下由设计者根据飞机安全迎角αmin给出,由于模态转换过程中保持定常平飞,所以最小俯仰角所以固定翼加减速阶段最小期望俯仰角
(2)确定模态转换过程中倾转角与期望俯仰角组合序列:
设定直升机加减速阶段倾转角固定,期望俯仰角连续变化;倾转角倾转阶段倾转角连续变化,期望俯仰角恒定;固定翼加减速阶段倾转角固定,期望俯仰角连续变化。因此,倾转角与期望俯仰角的组合可以代表模态转换过程的不同的平衡状态。将倾转角与期望俯仰角组合按照从最小期望俯仰角固定翼平飞状态到直升机悬停状态组成序列,指导模态转换过程的配平。
倾转角倾转阶段期望俯仰角为常数倾转角处于τmax~0°,倾转角每隔步长Δτ选取一个值。则该阶段用于指导不同配平状态的倾转角与期望俯仰角组合状态的数目h2为:
h2=floor[(τmax-0)/Δτ]+1 h2∈Z
翼平飞状态的配平初值。按照从最小期望俯仰角固定翼平飞状态到直升机悬停状态之间倾转角与俯仰角期望值组合所组成的序列,重复采用步骤三的合理配平过程依次完成组合序列中各组合状态的合理配平,操纵面从而获得模态转换过程配平结果序列。具体过程为:
①确定最小期望俯仰角固定翼平飞状态的配平初值。
最小期望俯仰角的固定翼平飞状态所确定的倾转角与期望俯仰角组合是组合序列中第一个组合状态。由于序列中的后续组合状态的配平初值依据前一组合状态配平结果选取,因此需要给出最小期望俯仰角的固定翼平飞状态,即组合序列中第一个组合状态下的配平初值,使得组合序列中后续组合状态的配平能够依次进行下去。
最小期望俯仰角的固定翼平飞状态下,无人机的升力公式为:
ρ表示空气密度,CY(αmin)表示在最小期望迎角αmin下产生的升力系数,S表示机翼面积,g为重力加速度,Vkmax表示最小期望俯仰角固定翼平飞状态的飞行速度。
得到固定翼加减速阶段下最小期望迎角下的飞行速度:
因此,最小期望俯仰角固定翼平飞状态空速配平初值满足Vk0>Vkmax。
将所有状态量配平初值带入到状态矢量配平初值相应位置,从而确定最小期望俯仰角固定翼平飞状态矢量配平初值X01,将广义操纵面控制矢量所有配平初值带入到广义操作面控制矢量配平初值的相应位置,从而确定最小期望俯仰角固定翼平飞状态广义操纵面控制矢量的配平初值δ01。
②按照从最小期望俯仰角的固定翼平飞状态到直升机悬停状态之间倾转角与俯仰角期望值组合所组成的序列逐步配平,将组合序列中前一倾转角与期望俯仰角组合状态确定的配平结果作为下一个组合状态的配平初值,更新广义操纵面控制矢量配平初值中的倾转角初值为新的倾转角与期望俯仰角组合中的倾转角,采用步骤三的合理配平过程确定新的倾转角与期望俯仰角组合的配平,从而获得模态转换过程配平结果序列。
如图5所示,首先初始化迭代系数h=1,给出在最小期望俯仰角固定翼平飞状态确定的倾转角与期望俯仰角组合下的状态矢量配平初值X01与广义操纵面控制矢量配平初值δ01,按照步骤三的配平过程,得到状态矢量配平值与广义操纵面控制矢量配平值
对于倾转角与期望俯仰角的组合序列中第h个组合状态h=1,2,…,(h1+h2+h3),按照步骤三的配平过程实现合理配平,得到状态矢量配平值与广义操纵面控制矢量配平值则序列中第(h+1)个倾转角与期望俯仰角的组合状态的状态矢量配平初值X0h+1=Xh *,广义操纵面控制矢量配平初值δ0h+1=δh *,更新广义操纵面控制矢量配平初值δ0h+1中倾转角配平初值τ0h+1=τh+1。更新迭代系数h=h+1,按照步骤三的配平过程得到状态矢量配平值Xh+1 *及广义操纵面控制矢量配平值δh+1 *。按照上述步骤迭代至h>(h1+h2+h3),完成模态转换过程中倾转角与期望俯仰角的组合序列所有组合状态下的合理配平。
由倾转角与期望俯仰角组合序列所确定的所有的状态矢量配平值与广义操纵面控制矢量配平值组成模态转换过程配平结果序列:
步骤五:根据步骤四中得到的由倾转角与期望俯仰角组合序列所确定的配平结果序列,将模态转换过程的引导指令及被控状态的进行定量化,从而确定引导指令生成函数及被控状态生成函数,用于驱动无人机的模态转换。
(1)由模态转换过程配平结果序列确定引导指令生成函数。
模态指令生成器包含倾转角导引指令生成函数τ(TL,t)与空速导引指令生成函数Vkg(TL,t)。TL表示转换的方向,TL=1表示倾转角逐渐增加、空速逐渐减小的反向向模态转换过程,TL=-1表示倾转角逐渐减小、空速逐渐增加的正向向模态转换过程。
对倾转角倾转阶段所有的倾转角与期望俯仰角的组合通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=h1,(h1+1),…,(h1+h2)。以倾转角τh组成的序列为自变量,以空速配平值组成的序列为因变量进行多项式曲线拟合,得到拟合函数Vkg(τ)。
在空速给定值Vkg<VkT时,倾转角固定为最大倾转角τmax,空速给定值按照加速度为改变;在空速给定值处于VkT<Vkg≤VkA时,倾转角按照速率为ωτ倾转;空速给定值Vkg>VkA时,倾转角固定为最小倾转角0°,空速给定值按照加速率为改变。
在模态转换时刻t0,初始空速为0m/s,初始倾转角为τmax,当TL=-1,由倾转角与空速组合来引导的倾转角逐渐减小、空速逐渐增加的正向倾转的导引指令生成器函数表示如下:
在模态转换时刻t0,初始空速为Vkmax,初始倾转角为0°,当TL=1,由倾转角与空速组合来引导的倾转角逐渐增加、空速逐渐减小的反向倾转的导引指令生成器函数表示如下:
其中,TL表示模态转换指令,TL=-1表示倾转角逐渐减小、空速逐渐增加的正向模态转换过程,TL=1表示倾转角逐渐增加、空速逐渐减小的反向模态转换过程。Limit(x,xmin,xmax)表示将变量x限幅在最小值xmin与最大值xmax之间的限幅函数:
(2)由模态转换全过程配平结果序列确定被控状态指令生成函数。
被控指令生成函数包含四个生成函数,空速生成函数Vkg(τ,Vkg),高度生成函数Hg(τ,Vkg),侧偏距生成函数Dzg(τ,Vkg),偏航角生成函数ψg(τ,Vkg)。
空速指令生成函数等于导引指令生成器生成的空速导引指令Vkg(τ,Vkg)=Vkg(TL,t)。
高度指令生成函数Hg(τ,Vkg)=H0,其中H0表示进行模态转换飞行的高度。
侧偏距指令生成函数Dzg(τ,Vkg)=0。
对于从点经度纬度分别为LA、BA,到点经纬度分别为LB、BB,设定正北方向为零航向,则根据导航运算公式得到偏航角指令生成函数为:
步骤六:根据步骤四中得到的配平结果序列,以倾转角与空速配平值为自变量,对于无人机状态矢量配平值与广义操纵面控制矢量的配平值进行曲线拟合,从而由当前的倾转角τ与空速指令Vkg解算无人机状态矢量配平值X*和广义操纵面控制矢量的配平值δ*信息,方便控制律设计。
由于模态转换过程通过倾转角与空速的组合分为三个阶段来引导。直升机加减速阶段空速给定值满足Vkg≤VkT,对应倾转角与期望俯仰角的组合状态其中h=(h1+h2),(h1+h2+1),…,(h1+h2+h3);倾转角倾转阶段空速给定值满足VkT<Vkg≤VkA,对应倾转角与期望俯仰角的组合状态其中h=h1,(h1+1),…,(h1+h2);固定翼加减速阶段空速给定值满足Vkg>VkA,对应倾转角与期望俯仰角的组合状态其中h=1,2,…,h1。因此,根据空速给定值Vkg分段,分别对于无人机的状态矢量配平值进行曲线拟合,得到无人机的状态基准值生成函数X*(τ,Vkg),对于广义操纵面控制矢量配平值进行曲线拟合,得到广义操纵面基准指令生成函数δ*(τ,Vkg)。具体过程为:
(1)根据配平结果序列,以倾转角τ和空速给定值Vkg为自变量对于无人机全部状态量的配平值进行分段拟合,确定基准状态生成函数X*(τ,Vkg)。
状态基准值生成函数X*(τ,Vkg)包含了配平中无人机全部状态的生成函数。其中侧滑角基准值生成函数β*(τ,Vkg)、滚转角速率基准值生成函数偏航角速率基准值生成函数俯仰角速率基准值生成函数滚转角基准值生成函数γ*(τ,Vkg)、侧偏距基准值生成函数升降速度基准值生成函数侧偏速度基准值生成函数恒为0。
高度基准指令生成函数H*(τ,Vkg)=H0,偏航角基准指令生成函数ψ*(τ,Vkg)=ψg(τ,Vkg),空速基准指令生成函数Vk *(τ,Vkg)=Vkg(TL,t)。
其中,直升机加减速阶段,对于倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=(h1+h2),(h1+h2+1),…,(h1+h2+h3)。以状态矢量配平值中的空速配平值为自变量,以俯仰角配平值为因变量进行多项式曲线拟合,得到直升机加减速阶段的俯仰角拟合函数
固定翼加减速阶段,对于倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=1,2,…,h1。以状态矢量配平值中的空速配平值为自变量,以俯仰角配平值为因变量进行多项式曲线拟合,得到固定翼加减速的俯仰角拟合函数
(2)根据配平结果序列,以倾转角τ和空速给定值Vkg为自变量对于无人机广义操纵面控制矢量的配平值进行分段曲线拟合,确定广义操纵面基准指令生成函数δ*(τ,Vk)。
广义操纵面基准值生成器函数δ*(τ,Vk)包含了配平中无人机全部操纵面的基准指令生成函数。其中,副翼基准指令生成生成函数方向舵基准指令生成生成函数推力/拉力滚转操纵量基准指令生成生成函数推力/拉力偏航操纵量基准指令生成生成函数均恒等于0。
对于直升机加减速阶段所有倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=(h1+h2),(h1+h2+1),…,(h1+h2+h3)。以状态矢量配平值中的空速配平值为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到直升机加减速阶段的拟合函数 其中,l=1,2,…,n3。表示推力/拉力矢量中第l个俯仰操纵量在直升机加减速阶段的配平值。表示推力/拉力矢量中第l个俯仰操纵量在直升机加减速阶段的拟合函数。
对于倾转角倾转阶段所有倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=h1,(h1+1),…,(h1+h2)。以倾转角τh为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到倾转角倾转阶段的拟合函数其中,l=1,2,…,n3。表示推力/拉力矢量中第l个俯仰操纵量在倾转角倾转阶段的配平值。表示推力/拉力矢量中第l个俯仰操纵量在倾转角倾转阶段的拟合函数。
对于固定翼加减速阶段所有倾转角与期望俯仰角的组合通过配平得到对应的状态配平值及广义操纵面控制矢量配平值其中,h=1,2,…,h1。以状态矢量配平值中的为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到固定翼加减速阶段的拟合函数其中,l=1,2,…,n3。表示推力/拉力矢量中第l个俯仰操纵量在固定翼加减速阶段的配平值。表示推力/拉力矢量中第l个俯仰操纵量固定翼加减速阶段的拟合函数。
某小型倾转旋翼无人机广义操纵面控制矢量包含倾转角τ、油门δp、副翼δx、方向舵δy、升降舵δz、油门差动δpd、倾角差动δtd、短舱倾角中值δte。其中短舱倾角δte是推力/拉力矢量的俯仰操纵量,倾角差动δtd是推力/拉力矢量的偏航操纵量,短舱倾角中值δte是推力/拉力矢量的俯仰操纵量。设定该倾转角最小期望俯仰角等于倾转角倾转阶段的期望俯仰角δd,倾转角倾转阶段的期望俯仰角δd=1.5°,经直升机阶段的配平确定最大期望俯仰角为最大倾转角为τmax=81.8°。设计其代价函数为:
倾转角τ处于不同值时,推力/拉力权限系数cT及气动操纵面的权限cz为:
cz=1-cT
其中,τ表示倾转角,τ1取值范围为τmax/6,τ2取值范围为5×τmax/6。
按照本发明方法,得到以空速为自变量的配平曲线如图6-A~6-F所示。由图6-A倾转角与空速的对应关系曲线可知,倾转角与空速都平稳变化,直升机加减速阶段到倾转角倾转阶段的临界速度VkT=3m/s,最小期望俯仰角固定翼平飞状态下最大平飞速度为Vkmax=24.1m/s。由图6-B迎角配平曲线与图6-C俯仰角配平曲线可知,在任何空速下的迎角配平值等于俯仰角配平值,保证倾转旋翼无人机定常平飞,并且俯仰角配平值逼近期望俯仰角,模态转换过程俯仰角配平值随着空速平稳变化。由图6-D油门配平曲线可知,模态转换过程中油门配平值随着空速平稳变化。由图6-E升降舵的配平曲线可知,模态转换过程中升降舵配平值随着空速平稳变化,并且在倾转角τ<τmax/2时对应空速下,升降舵配平值相对于其偏转范围较小。图6-F倾角中值配平曲线可知,模态转换过程中倾角中值配平值随着空速平稳变化,并且在倾转角τ>τmax/2时对应空速下,倾角中值配平值相对于其最大偏转范围数值较小。
根据该小型倾转旋翼无人机的特点设计倾转角速率ωτ=1°/s2,空速指令的加速度为模态转换时刻倾转角为τ0,空速给定值为Vkg=0m/s,初始倾转角为τmax,则倾转角逐渐减小、空速逐渐增加的正向倾转的导引指令生成函数为:
其中,Vkg(τ)=-0.0025173τ2-0.053098τ+23.452
状态指令生成函数中的俯仰角生成函数为:
其中,
广义操纵面基准指令生成器中油门基准指令生成函数为:
其中,
广义操纵面基准指令生成器中的升降舵基准指令生成函数为:
其中,
广义操纵面基准指令生成器中的倾角中值基准指令生成函数为:
其中,
Claims (5)
1.一种可变飞行模态无人机广义指令生成器,其特征在于:包括导引指令生成器、被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器;模态转换指令TL与时间t进入到导引指令生成器后,根据倾转角生成函数τ(TL,t)生成导引模态转换的倾转角指令τ,根据空速生成函数Vkg(TL,t)生成空速指令Vkg,并将倾转角指令τ和空速指令Vkg均发送至被控状态指令生成器、状态基准值生成器和广义操纵面基准指令生成器;通过被控状态指令生成器得到空速指令Vkg、高度指令Hg、侧偏距指令Dzg和偏航角指令ψg;通过状态基准值生成器得到状态矢量平衡值X*;通过广义操纵面基准指令生成器得到广义操纵面控制矢量的平衡值δ*。
2.根据权利要求1所述的一种可变飞行模态无人机广义指令生成器,其特征在于:所述的被控制状态指令生成器由空速指令生成函数Vkg(τ,Vkg)、高度指令生成函数Hg(τ,Vkg)、侧偏距指令生成函数Dzg(τ,Vkg)、偏航角指令生成函数ψg(τ,Vkg)组成;空速指令生成函数Vkg(τ,Vkg)根据倾转角指令τ,解算出空速指令Vkg;高度指令生成函数Hg(τ,Vkg)根据倾转角指令τ与空速指令Vkg,解算得出高度指令Hg;侧偏距指令生成函数Dzg(τ,Vkg)根据倾转角指令τ与空速指令Vkg,解算得出侧偏距指令Dzg,偏航角指令生成函数ψg(τ,Vkg)根据倾转角指令τ与空速指令Vkg,解算得出偏航角指令ψg。
3.根据权利要求1所述的一种可变飞行模态无人机广义指令生成器,其特征在于:所述的状态基准值生成器由状态指令生成函数X*(τ,Vkg)构成,其中X*(τ,Vkg)包含了无人机的空速基准值生成函数迎角基准值生成函数α*(τ,Vkg)、侧滑角基准值生成函数β*(τ,Vkg)、滚转角速率基准值生成函数偏航角速率基准值生成函数俯仰角速率基准值生成函数俯仰角基准值生成函数偏航角基准值生成函数ψ*(τ,Vkg)、滚转角基准值生成函数γ*(τ,Vkg)、高度基准值生成函数H*(τ,Vkg)、侧偏距基准值生成函数升降速度基准值生成函数和侧偏速度基准值生成函数状态基准值生成器根据相应的基准值生成函数生成对应倾转角及空速导引指令下相应的无人机状态矢量平衡值X*。
4.根据权利要求1所述的一种可变飞行模态无人机广义指令生成器,其特征在于:所述的广义操纵面基准指令生成器由状态指令生成函数δ*(τ,Vkg)构成,其中δ*(τ,Vkg)包含了倾转角基准指令生成函数为τ*(τ,Vkg)、副翼基准指令生成生成函数方向舵基准指令生成生成函数升降舵基准指令生成生成函数油门基准指令生成生成函数推力/拉力滚转操纵量基准指令生成生成函数推力/拉力偏航操纵量基准指令生成生成函数推力/拉力俯仰操纵量基准指令生成生成函数其中n1表示推力/拉力矢量滚转操纵面的数目,n2表示推力/拉力矢量偏航操纵面的数目,n3表示推力/.拉力矢量俯仰操纵面的数目,状态基准值生成器根据相应的基准指令生成函数生成对应倾转角及空速导引指令下的相应广义操纵面控制矢量的平衡值δ*。
5.一种可变飞行模态无人机广义指令生成器的指令生成方法,其特征在于:具体包括以下几个步骤:
步骤一:确定的模态转换飞行的导引方式及无人机被控状态量:
(1)选取倾转角与空速的组合作为模态转换飞行的引导方式;
(2)无人机被控状态量选取为空速、高度、侧偏距、偏航角;高度指令为固定值H0,侧偏距指令为0,偏航角指令是由航线中从点与到点经纬度信息计算得到的确定值,空速指令由模态转换过程配平后确定的倾转角生成函数τ(TL,t)与空速生成函数Vkg(TL,t)确定;
步骤二:(1)确定无人机平稳转换的配平原则:
俯仰角配平值等于期望俯仰角,广义操纵面控制矢量中各个控制量的配平值相对于其偏转范围最小;
(2)确定满足配平的代价函数C为:
其中,表示期望的俯仰角,α*表示迎角配平值,表示俯仰角配平值,表示升降舵配平值,分别表示推力/拉力矢量的第i个俯仰操纵量配平值,n3表示推力/拉力矢量俯仰操纵量的数目,k0表示俯仰角误差系数,k1表示推力/拉力矢量俯仰操纵量δTz1、δTz2、…、δTzn3的代价系数,k2表示升降舵δz的代价系数,cT表示推力/拉力矢量俯仰操纵量的权限系数,cz表示升降舵的权限系数,分别表示推力/拉力矢量第i个俯仰操纵量的最大允许偏转范围,δzmax表示升降舵最大允许偏转范围;
推力/拉力俯仰操纵量权限系数cT及升降舵的权限系数cz为:
cz=1-cT
其中,τ表示倾转角,τmax表示最大的倾转角,τ1取值范围为τmax/6~τmax/4,τ2取值范围为3×τmax/4~5×τmax/6;
步骤三:对于模态转换过程中倾转角与期望俯仰角的组合状态在matlab软件中建立表示可变飞行模态无人机运动学方程的模型文件,利用matlab软件的配平函数,通过调整空速配平初值、广义操纵面控制矢量的配平初值,不断迭代优化实现代价函数值最小,达到倾转角及期望俯仰角组合状态下的配平,具体过程为:
(1)搭建航迹坐标系下可变飞行模态无人机的输入输出关系图:
航迹坐标系选用苏联坐标系,其状态矢量X选取空速Vk、迎角α、侧滑角β、滚转角速率ωx、偏航角速率ωy、俯仰角速率ωz、俯仰角偏航角ψ、滚转角γ、高度H、侧偏距Dz、升降速度Vyd、侧偏速度Vzd;广义操纵面控制矢量δ为倾转角为τ、副翼偏转角δx、方向舵偏转角δy、升降舵偏转角δz、油门开度δp、推力/拉力滚转操纵量偏转角δTx1、δTx2、…、推力/拉力偏航操纵量偏转角δTy1、δTy2、…、推力/拉力俯仰操纵量偏转角δTz1、δTz2、…、其中n1表示推力/拉力矢量滚转操纵量的数目,n2表示推力/拉力矢量偏航操纵量的数目,n3表示推力/拉力矢量俯仰操纵量的数目;γs、ψs、θ分别表示航迹滚转角、航向角、航迹俯仰角;定义无人机的质量为m,滚转转动惯量为Ix、偏航转动惯量为Iy、俯仰转动惯量为Iz、惯性积为Ixy;机体部分产生的升力为Y、阻力为Q、侧力为Z,推力/拉力矢量产生的航迹坐标系前向拉力为Txh、纵向拉力为Tyh、侧向拉力为Tzh;推力/拉力矢量产生的地面坐标系前向拉力为Tyd、侧向力为Tzd;机体产生的滚转、偏航、俯仰力矩分别为Mxb、Mxb、Mzb、推力拉力矢量产生的滚转、俯仰、偏航力矩分别为MxT、MxT、MzT,总的滚转力矩Mx=Mxb+MxT,偏航力矩My=Myb+MyT,俯仰力矩Mz=Mzb+MzT;
状态矢量的微分方程分别为:
(2)matlab软件配平函数的配置及使用方法:
设定状态矢量配平初值为:
广义操纵面控制矢量配平初值为:
输出矢量配平初值为Y0=X0;限定横侧向状态矢量配平值与横侧向操纵量的配平值均等于0;限定纵向状态矢量中空速配平值倾转角配平值τ*、高度配平值H*等于配平初值Vk0、τ0、H0;不限制俯仰角油门开度δp、升降舵偏转角δz,推力/拉力矢量俯仰控制量偏转角δTz1、δTz2…状态矢量限制阵为IX=[1;3;4;5;6;8;9;10;11;12;13],输出矢量的限制阵为IY=IX,广义操纵面的控制矢量限制阵为IU=[1;2;3;6;7;…;5+n1+n2;6+n1+n2];
(3)对于倾转角和期望俯仰角组合状态,通过调整空速配平初值使得俯仰角配平值逼近期望俯仰角,通过调整广义操纵面中权限高并且相对偏转角度大的操纵面来优化广义操纵面控制矢量的配平值,达到代价函数值最小,具体步骤为:
③根据状态量配平初值Vk0(i),α0(i),H0(i)构造第i次迭代的状态矢量配平初值X0(i),构造第i次迭代的广义操纵面控制矢量的配平初值为δ0(i),输出矢量的配平初值Y0(i)=X0(i);
根据配平函数[X*(i),δ*(i),Y*(i)]=trim(′model′,X0(i),δ0(i),Y0(i),IX,IU,IY)进行第i次迭代配平,得到状态矢量配平值X*(i),广义操纵面控制矢量配平值δ*(i),输出矢量配平值Y0 *(i);将期望俯仰角俯仰角配平值和广义操纵面控制矢量配平值δ*(i)带入到代价函数计算公式中,得到第i次迭代的代价函数值C(i),α*(i)表示迎角配平值;
④空速调整阶段:
⑤操纵面调整段:
根据状态量配平初值Vk0(j),α0(j),H0(j)构造状态矢量配平初值X0(j),构造第j次迭代的广义操纵面控制矢量的配平初值δ0(j),输出矢量配平初值Y0(j)=X0(j);
根据配平函数[X*(j),δ*(j),Y*(j)]=trim(′model′,X0(j),δ0(j),Y0(j),IX,IU,IY),得到状态矢量配平值X*(j),广义操纵面控制矢量配平值δ*(j),输出矢量配平值Y0 *(j),将期望俯仰角俯仰角配平值广义操纵面控制矢量配平值δ*(j)带入到代价函数计算公式中,得到第j次迭代的代价函数值C(j);α*(j)表示迎角配平值;
如果且代价函数值C(j)<C(j-1),当τ<(τ1+τ2)/2,则选取推力拉力矢量中配平值相对最大偏转范围的偏转角度最大的操纵面(k=1,2,…,n3)为被调整操纵面δM(j),当τ≥(τ1+τ2)/2,选取升降舵δz为被调整操纵面δM(j);对于被调整操纵面配平初值进行调整其中表示被调整操纵量的配平初值,表示对于操纵面配平初值的调整角度相对于最大偏转操作范围的数值,表示被调操纵面的最大偏转范围,将被调整操纵面的配平初值δM0(j+1)带入到广义操纵面控制矢量配平初值δ0(j+1)对应位置中,其他操纵面配平初值等于广义操纵面控制矢量配平值δ*(j)对应值,状态矢量配平初值X0(j+1)=X0(j),返回步骤第⑤步进行第j+1次迭代;
步骤四:建立从最小期望俯仰角固定翼平飞状态到直升机悬停状态之间一系列由倾转角与期望俯仰角组合组成的序列,不断重复步骤三的配平过程实现该组合序列中所有组合状态下的配平,从而完成模态转换过程的配平;
(1)划分模态转换过程的阶段,并确定各阶段的期望俯仰角:
将模态转换过程分为三个阶段:直升机加减速阶段、倾转角倾转阶段和固定翼加减速阶段;倾转角倾转阶段要求倾转角恒定为对于直升机悬停模态下,空速配平初值为0.0001m/s,给出广义操纵面控制矢量配平初值δ0,俯仰角配平初值等于倾转角倾转阶段的期望俯仰角采用步骤三的配平过程进行迭代,如果无法实现配平则按照步长增加期望的俯仰角重复步骤三的配平过程,实现配平得到俯仰角配平值及倾转角配平值τ*,从而确定直升机悬停状态下的期望俯仰角和最大倾转角τmax=τ*;固定翼加减速阶段最小期望俯仰角αmin表示飞机安全迎角,表示最小俯仰角;
(2)确定模态转换过程倾转角与期望俯仰角组合序列:
倾转角倾转阶段期望俯仰角为常数倾转角处于τmax~0°,倾转角每隔步长Δτ选取一个值,则该阶段倾转角与期望俯仰角组合状态的数目h2为:
h2=floor[(τmax-0)/Δτ]+1 h2∈Z
h3∈Z
(3)①确定最小期望俯仰角固定翼平飞状态的配平初值:
最小期望俯仰角的固定翼平飞状态下,无人机的升力公式为:
ρ表示空气密度,CY(αmin)表示在最小期望迎角αmin下产生的升力系数,S表示机翼面积,g为重力加速度,Vkmax表示最小期望俯仰角固定翼平飞状态的飞行速度;
固定翼加减速阶段下最小期望迎角下的飞行速度:
最小期望俯仰角固定翼平飞状态空速配平初值满足Vk0>Vkmax;
将所有状态量配平初值带入到状态矢量配平初值相应位置,从而确定最小期望俯仰角固定翼平飞状态矢量配平初值X01,将广义操纵面控制矢量所有配平初值带入到广义操纵面控制矢量配平初值的相应位置,从而确定最小期望俯仰角固定翼平飞状态广义操纵面控制矢量的配平初值δ01;
②按照从最小期望俯仰角的固定翼平飞状态到直升机悬停状态之间倾转角与俯仰角期望值组合所组成的序列逐步配平,将组合序列中前一倾转角与期望俯仰角组合确定的配平结果作为下一个组合状态的配平初值,更新广义操纵面控制矢量配平初值中的倾转角初值为新的倾转角与期望俯仰角组合中的倾转角,采用步骤三的配平过程确定新的倾转角与期望俯仰角组合的配平,从而获得模态转换过程配平结果序列;
由倾转角与期望俯仰角组合序列所确定的所有的状态矢量配平值与广义操纵面控制矢量配平值组成模态转换过程配平结果序列:
步骤五:根据步骤四中得到的由倾转角与期望俯仰角组合序列所确定的配平结果序列,将模态转换过程的引导指令及被控状态的进行定量化,从而确定引导指令生成函数及被控状态生成函数,用于驱动无人机的模态转换:
(1)由模态转换过程配平结果序列确定引导指令生成函数:
对倾转角倾转阶段所有的倾转角与期望俯仰角的组合通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=h1,(h1+1),…,(h1+h2),以倾转角τh组成的序列为自变量,以空速配平值组成的序列为因变量进行多项式曲线拟合,得到拟合函数Vkg(τ);
在空速给定值Vkg<VkT时,倾转角固定为最大倾转角τmax,空速给定值按照加速度为改变;在空速给定值处于VkT<Vkg≤VkA时,倾转角按照速率为ωτ倾转;空速给定值Vkg>VkA时,倾转角固定为最小倾转角0°,空速给定值按照加速率为改变;
在模态转换时刻t0,初始空速为0m/s,初始倾转角为τmax,当TL=-1,由倾转角与空速组合来引导的倾转角逐渐减小、空速逐渐增加的正向倾转的导引指令生成器函数表示如下:
在模态转换时刻t0,初始空速为Vkmax,初始倾转角为0°,当TL=1,由倾转角与空速组合来引导的倾转角逐渐增加、空速逐渐减小的反向倾转的导引指令生成器函数表示如下:
其中,TL表示模态转换指令,TL=-1表示倾转角逐渐减小、空速逐渐增加的正向模态转换过程,TL=1表示倾转角逐渐增加、空速逐渐减小的反向模态转换过程,Limit(x,xmin,xmax)表示将变量x限幅在最小值xmin与最大值xmax之间的限幅函数:
(2)由模态转换全过程配平结果序列确定被控状态指令生成函数:
空速指令生成函数空速输出值等于导引指令生成器生成的空速导引指令Vkg(τ,Vkg)=Vkg(TL,t);
高度指令生成函数Hg(τ,Vkg)=H0,其中H0表示进行模态转换飞行的高度;
侧偏距指令生成函数Dzg(τ,Vkg)=0,其中H0表示进行模态转换飞行的高度;
对于从点经度纬度分别为LA、BA,到点经纬度分别为LB、BB,设定正北方向为零航向,则根据导航运算公式得到偏航角指令生成函数为:
步骤六:直升机加减速阶段空速给定值满足Vkg≤VkT,对应倾转角与期望俯仰角的组合状态其中h=(h1+h2),(h1+h2+1),…,(h1+h2+h3);倾转角倾转阶段空速给定值满足VkT<Vkg≤VkA,对应倾转角与期望俯仰角的组合状态其中h=h1,(h1+1),…,(h1+h2);固定翼加减速阶段空速给定值满足Vkg>VkA,对应倾转角与期望俯仰角的组合状态其中h=1,2,…,h1;根据空速给定值Vkg分段,分别对于无人机的状态矢量配平值进行曲线拟合,得到无人机的状态基准值生成函数X*(τ,Vkg),对于广义操纵面控制矢量配平值进行曲线拟合,得到广义操纵面基准指令生成函数δ*(τ,Vkg),具体过程为:
(1)根据配平结果序列,以倾转角τ和空速给定值Vkg为自变量对于无人机状态矢量的配平值进行分段拟合,确定基准状态生成函数X*(τ,Vkg);
状态基准值生成函数X*(τ,Vkg)中的侧滑角基准值生成函数β*(τ,Vkg)、滚转角速率基准值生成函数偏航角速率基准值生成函数俯仰角速率基准值生成函数滚转角基准值生成函数γ*(τ,Vkg)、侧偏距基准值生成函数升降速度基准值生成函数侧偏速度基准值生成函数恒为0;高度基准指令生成函数H*(τ,Vkg)=H0,偏航角基准指令生成函数ψ*(τ,Vkg)=ψg(τ,Vkg),空速基准指令生成函数Vk *(τ,Vkg)=Vkg(TL,t);俯仰角基准值由空速Vkg、倾转角τ分段拟合得到,俯仰角配平值拟合函数为:
直升机加减速阶段,对于倾转角与期望俯仰角的组合状态通过配平得到状态矢量配平值及广义操纵面控制矢量配平值其中,h=(h1+h2),(h1+h2+1),…,(h1+h2+h3);以状态矢量配平值中的空速配平值为自变量,以俯仰角配平值为因变量进行多项式曲线拟合,得到直升机加减速阶段的俯仰角拟合函数
固定翼加减速阶段,对于倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=1,2,…,h1,以状态矢量配平值中的空速配平值为自变量,以俯仰角配平值为因变量进行多项式曲线拟合,得到固定翼加减速的俯仰角拟合函数
(2)根据配平结果序列,以倾转角τ和空速给定值Vkg为自变量对于无人机广义操纵面控制矢量的配平值进行分段曲线拟合,确定广义操纵面基准指令生成函数δ*(τ,Vk);
对于直升机加减速阶段所有倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中,h=(h1+h2),(h1+h2+1),…,(h1+h2+h3),以状态矢量配平值中的空速配平值为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到直升机加减速阶段的拟合函数 其中,l=1,2,…,n3,表示推力/拉力矢量中第l个俯仰操纵量在直升机加减速阶段的配平值,表示推力/拉力矢量中第l个俯仰操纵量在直升机加减速阶段的拟合函数;
对于倾转角倾转阶段所有于倾转角与期望俯仰角的组合状态通过配平得到对应的状态矢量配平值及广义操纵面控制矢量配平值其中h=h1,(h1+1),…,(h1+h2),以倾转角τh为自变量,分别以广义操纵面的油门配平值升降舵配平值推力/拉力矢量俯仰操纵量配平值为因变量进行多项式曲线拟合,得到倾转角倾转阶段的拟合函数 其中,l=1,2,…,n3,表示推力/拉力矢量中第l个俯仰操纵量在倾转角倾转阶段的配平值,表示推力/拉力矢量中第l个俯仰操纵量在倾转角倾转阶段的拟合函数;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110152547XA CN102289207B (zh) | 2011-06-08 | 2011-06-08 | 一种可变飞行模态无人机广义指令生成器及其指令生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110152547XA CN102289207B (zh) | 2011-06-08 | 2011-06-08 | 一种可变飞行模态无人机广义指令生成器及其指令生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102289207A true CN102289207A (zh) | 2011-12-21 |
CN102289207B CN102289207B (zh) | 2013-11-13 |
Family
ID=45335697
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110152547XA Expired - Fee Related CN102289207B (zh) | 2011-06-08 | 2011-06-08 | 一种可变飞行模态无人机广义指令生成器及其指令生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102289207B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106970531A (zh) * | 2017-05-02 | 2017-07-21 | 西北工业大学 | 倾转翼垂直起降无人机模态转换控制策略确定方法 |
CN108196557A (zh) * | 2017-12-29 | 2018-06-22 | 易瓦特科技股份公司 | 无人机的控制方法及装置 |
CN109669047A (zh) * | 2019-01-21 | 2019-04-23 | 深圳市南航电子工业有限公司 | 一种直升机悬停时指示空速显示方法和相关装置 |
CN109739251A (zh) * | 2018-12-28 | 2019-05-10 | 中国科学院工程热物理研究所 | 无人机分时控制方法 |
CN109878703A (zh) * | 2019-03-13 | 2019-06-14 | 南京灵龙旋翼无人机系统研究院有限公司 | 旋转机翼飞机多模式转换的控制分配方法 |
CN110262558A (zh) * | 2019-07-18 | 2019-09-20 | 成都飞机工业(集团)有限责任公司 | 一种无人机定点着陆的控制方法 |
CN111242521A (zh) * | 2020-04-24 | 2020-06-05 | 中国人民解放军国防科技大学 | 轨迹异常检测方法和系统 |
CN111694372A (zh) * | 2019-03-14 | 2020-09-22 | 波音公司 | 操作飞行包线管理系统 |
CN112034875A (zh) * | 2020-09-15 | 2020-12-04 | 西安爱生技术集团公司 | 一种常规布局通用型无人机全自动离地起飞控制方法 |
CN112462798A (zh) * | 2020-12-04 | 2021-03-09 | 三生万物(北京)人工智能技术有限公司 | 一种无人机及提高无人机航线飞行性能的方法 |
CN113206958A (zh) * | 2021-04-30 | 2021-08-03 | 成都睿铂科技有限责任公司 | 一种航线拍摄方法 |
CN116562052A (zh) * | 2023-07-05 | 2023-08-08 | 西安现代控制技术研究所 | 一种考虑可用过载约束下的侧向绕飞方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08198195A (ja) * | 1995-01-27 | 1996-08-06 | Nec Corp | 空中移動体 |
CN101236434A (zh) * | 2008-02-25 | 2008-08-06 | 北京航空航天大学 | 一种无人机多模态控制与切换方法 |
CN101256410A (zh) * | 2008-03-31 | 2008-09-03 | 北京航空航天大学 | 一种无人机飞行阶段转换方法 |
CN101264797A (zh) * | 2008-03-20 | 2008-09-17 | 北京航空航天大学 | 一种无人机滚转改平控制方法 |
CN101441478A (zh) * | 2008-12-26 | 2009-05-27 | 北京航空航天大学 | 一种小型无人机自动着陆拉平控制方法及其装置 |
CN101788822A (zh) * | 2010-01-18 | 2010-07-28 | 北京航空航天大学 | 一种无人机侧向控制方法 |
-
2011
- 2011-06-08 CN CN201110152547XA patent/CN102289207B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08198195A (ja) * | 1995-01-27 | 1996-08-06 | Nec Corp | 空中移動体 |
CN101236434A (zh) * | 2008-02-25 | 2008-08-06 | 北京航空航天大学 | 一种无人机多模态控制与切换方法 |
CN101264797A (zh) * | 2008-03-20 | 2008-09-17 | 北京航空航天大学 | 一种无人机滚转改平控制方法 |
CN101256410A (zh) * | 2008-03-31 | 2008-09-03 | 北京航空航天大学 | 一种无人机飞行阶段转换方法 |
CN101441478A (zh) * | 2008-12-26 | 2009-05-27 | 北京航空航天大学 | 一种小型无人机自动着陆拉平控制方法及其装置 |
CN101788822A (zh) * | 2010-01-18 | 2010-07-28 | 北京航空航天大学 | 一种无人机侧向控制方法 |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106970531A (zh) * | 2017-05-02 | 2017-07-21 | 西北工业大学 | 倾转翼垂直起降无人机模态转换控制策略确定方法 |
CN106970531B (zh) * | 2017-05-02 | 2020-01-14 | 西北工业大学 | 倾转翼垂直起降无人机模态转换控制策略确定方法 |
CN108196557B (zh) * | 2017-12-29 | 2021-07-09 | 易瓦特科技股份公司 | 无人机的控制方法及装置 |
CN108196557A (zh) * | 2017-12-29 | 2018-06-22 | 易瓦特科技股份公司 | 无人机的控制方法及装置 |
CN109739251A (zh) * | 2018-12-28 | 2019-05-10 | 中国科学院工程热物理研究所 | 无人机分时控制方法 |
CN109739251B (zh) * | 2018-12-28 | 2022-03-29 | 中国科学院工程热物理研究所 | 无人机分时控制方法 |
CN109669047A (zh) * | 2019-01-21 | 2019-04-23 | 深圳市南航电子工业有限公司 | 一种直升机悬停时指示空速显示方法和相关装置 |
CN109669047B (zh) * | 2019-01-21 | 2021-08-17 | 深圳市南航电子工业有限公司 | 一种直升机悬停时指示空速显示方法和相关装置 |
CN109878703A (zh) * | 2019-03-13 | 2019-06-14 | 南京灵龙旋翼无人机系统研究院有限公司 | 旋转机翼飞机多模式转换的控制分配方法 |
CN109878703B (zh) * | 2019-03-13 | 2022-05-24 | 南京灵龙旋翼无人机系统研究院有限公司 | 旋转机翼飞机多模式转换的控制分配方法 |
CN111694372A (zh) * | 2019-03-14 | 2020-09-22 | 波音公司 | 操作飞行包线管理系统 |
CN110262558A (zh) * | 2019-07-18 | 2019-09-20 | 成都飞机工业(集团)有限责任公司 | 一种无人机定点着陆的控制方法 |
US10902337B1 (en) | 2020-04-24 | 2021-01-26 | Jun Tang | Method and device of trajectory outlier detection, and storage medium thereof |
CN111242521A (zh) * | 2020-04-24 | 2020-06-05 | 中国人民解放军国防科技大学 | 轨迹异常检测方法和系统 |
CN112034875A (zh) * | 2020-09-15 | 2020-12-04 | 西安爱生技术集团公司 | 一种常规布局通用型无人机全自动离地起飞控制方法 |
CN112034875B (zh) * | 2020-09-15 | 2024-04-19 | 西安爱生技术集团公司 | 一种常规布局通用型无人机全自动离地起飞控制方法 |
CN112462798A (zh) * | 2020-12-04 | 2021-03-09 | 三生万物(北京)人工智能技术有限公司 | 一种无人机及提高无人机航线飞行性能的方法 |
CN113206958A (zh) * | 2021-04-30 | 2021-08-03 | 成都睿铂科技有限责任公司 | 一种航线拍摄方法 |
CN113206958B (zh) * | 2021-04-30 | 2023-06-09 | 成都睿铂科技有限责任公司 | 一种航线拍摄方法 |
CN116562052A (zh) * | 2023-07-05 | 2023-08-08 | 西安现代控制技术研究所 | 一种考虑可用过载约束下的侧向绕飞方法 |
CN116562052B (zh) * | 2023-07-05 | 2023-10-03 | 西安现代控制技术研究所 | 一种考虑可用过载约束下的侧向绕飞方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102289207B (zh) | 2013-11-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102289207A (zh) | 一种可变飞行模态无人机广义指令生成器及其指令生成方法 | |
CN109614633B (zh) | 一种复合式旋翼飞行器非线性建模及线性化配平方法 | |
Bapst et al. | Design and implementation of an unmanned tail-sitter | |
Das et al. | Dynamic inversion with zero-dynamics stabilisation for quadrotor control | |
Ke et al. | Design and implementation of a hybrid UAV with model-based flight capabilities | |
Moutinho et al. | Airship robust path-tracking: A tutorial on airship modelling and gain-scheduling control design | |
Singh et al. | Automatic path planning and control design for autonomous landing of UAVs using dynamic inversion | |
KR101118888B1 (ko) | 동적 시스템을 제어하는 시스템 및 방법 | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
Shi et al. | Nonlinear control of autonomous flying cars with wings and distributed electric propulsion | |
CN105759613A (zh) | 倾转旋翼机的控制方法和控制装置 | |
Argyle et al. | The vertical bat tail-sitter: dynamic model and control architecture | |
CN110471456A (zh) | 高超声速飞行器俯冲段制导、姿控、变形一体化控制方法 | |
Jung et al. | A comprehensive flight control design and experiment of a tail-sitter UAV | |
CN111538255A (zh) | 一种反蜂群无人机的飞行器控制方法及系统 | |
Reddinger et al. | Modeling and trajectory control of a transitioning quadrotor biplane tailsitter | |
Knoebel et al. | Preliminary modeling, control, and trajectory design for miniature autonomous tailsitters | |
Cerezo-Pacheco et al. | Integration of X-Plane and Matlab for modeling and simulation of a tiltrotor UAV | |
CN110989397B (zh) | 一种航空器失事搜寻仿真方法及系统 | |
Osborne | Transitions between hover and level flight for a tailsitter UAV | |
Cheng et al. | A corridor-based flight mode transition strategy for agile ducted-fan tail-sitter UAV: Altitude-hold transition | |
Orsag et al. | Hybrid fly-by-wire quadrotor controller | |
McIntosh et al. | A Switching-Free Control Architecture for Transition Maneuvers of a Quadrotor Biplane Tailsitter | |
Comer et al. | Full envelope flight control system design and optimization for a tilt-wing aircraft | |
CN117234228A (zh) | 一种倾转旋翼无人机倾转过程控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20131113 Termination date: 20140608 |
|
EXPY | Termination of patent right or utility model |