一种无人机中立位置自动调整的飞行控制方法
【技术领域】：
[0001] 本发明涉及无人机飞行控制技术领域，尤其是基于中立位置的经典飞行控制技 术。
【背景技术】：
[0002] 无人机各项性能(包括起飞着陆性能、作业飞行性能、飞行安全可靠性能、系统的 自动化性和可维护性等）的优劣在很大程度上都取决于其飞控系统的设计。飞行控制系统 虽然已经历了从A/P、SAS、CAS到FBW的巨大变化和发展，但PID经典控制技术却始终在无人 机上应用最为广泛。不仅因为其拥有根轨迹、Bode图、Nyquist图等这些设计工具，使设计者 能够看得见系统动态是如何被修正的，并且用于评价和鉴定飞行控制系统性能和飞机飞行 品质的准则和判据也都是建立在经典控制理论的概念之上的。
[0003] PID经典控制系统是建立在飞行器某一中立位置附近的模型上的，并通过系统偏 离平衡位置的偏差进行控制。但在实际飞行过程当中，由于内部结构或外部环境的变化，飞 行器的中立位置自身可能发生变化，并且这种变化并不容易被检测与度量，因而在计算状 态偏差时会带来误差。
【发明内容】
[0004] PID经典控制系统是基于系统某一中立位置建立的，并利用状态偏差的积分来消 除稳态误差。当系统中立位置发生变化时，如果积分系数较小，积分作用要通过系统稳定在 新的中立位置较长时间后才能发挥作用，稳定过程很慢;如果积分系数较大，则控制系统的 迟滞作用明显，不仅降低了控制系统的动态性能，而且带来了安全隐患。
[0005] 针对现有技术存在的缺陷，本发明提供一种无人机中立位置自动调整的飞行控制 方法。其是在PID经典控制系统上的基础上进行改进。在飞行过程中实时算出相应的中立位 置，并且在此基础上增加基于姿态响应的舵面中立位置修正项，从而大大提高了 PID经典控 制系统对中立位置变化的适应能力。
[0006] 本发明的技术方案是：
[0007] -种无人机中立位置自动调整的飞行控制方法，其特征在于:无人机在飞行过程 中，根据无人机当前飞行状态(速度、重量)与海拔高度实时计算出各个舵面中立位置的理 论计算值;同时根据飞行状态与控制指令的偏差，计算目标舵面偏量，然后采用偏差修正算 法，生成无人机各舵面中立位置修正项，实时修正各舵面中立位置的理论计算值与实际值 的偏差。
[0008] 无人机在飞行过程中，根据无人机当前飞行状态与海拔高度，采用数据插值或气 动公式估算的方法实时计算出各个舵面中立位置的理论计算值，下面分别两种方法的具体 步骤。
[0009] 第一种方法:在无人机飞行控制系统中存储有标准的大气数据参数表以及无人机 气动参数表。上述参数表是以理论计算、风洞试验测定、飞行试验测定等常规现有技术，得 出无人机在一系列状态与环境下的气动参数，形成相应的数据表，并存贮在无人机飞行控 制系统中。基于此，采用数据插值方法实时计算出各个舵面中立位置的理论计算值，步骤如 下：
[0010] (1)根据各中立位置和与之相关的无人机对应状态参数与外界环境参数(包括空 气密度、侧风大小），确定中立位置数据表，即设某一中立位置可用函数表示为
[0011] ρ = Γ(ξ?,ξ2,···,^η)
[0012]其中，{ξ]为影响某中立位置Ρ的参数集合。
[0013] 这里，各中立位置分别为俯仰角中立位置、滚转角中立位置、升降舵中立位置、油 门中立位置。对于俯仰角中立位置、升降舵中立位置和油门中立位置，与这三个中立位置相 关的无人机状态参数包括飞行速度、飞行高度、无人机质量等;对于滚转角中立位置，与之 相关的无人机状态参数是目标航线的侧向风的分量，以及飞行高度、无人机质量等。
[0014] 则在飞行包线内，以理论计算、风洞试验测定、飞行试验测定等常规现有技术，可 得出无人机在一系列状态与环境下的中立位置，形成相应的数据表，即
[001 5] Pkl,k2,-",kn - f(Cl,kl ,^2,k2 , - ,Cn,kn)
[0016] 其中，pki为对某中立位置p的离散数列，|i,ki为对影响参数的离散数列。
[0017] ⑵根据该中立位置对应的当前状态参数与环境参数⑴々，…，ξη)，判定每一个 参数所处的数据表对应区间，ΒΡ
[0018]
[0019] ξ2￡[ξ2)32,ξ2^2]
[0020] .
[0021] .
[0022] .
[0023] ξη￡[ξη；3η,ξη^η]
[0024] (3)根据区间节点上的数据，通过插值的方式求出中立位置，即
[0025]
[0026]
[0027]
[0028] 第二种方法:在无人机飞行控制系统中存储有标准的大气数据参数表以及无人机 气动参数表。上述参数表是以理论计算、风洞试验测定或飞行试验测定方式，得出无人机在 一系列状态与环境下的气动参数，形成相应的数据表，并存贮在无人机飞行控制系统中。基 于此，采用气动公式估算的方法实时计算出各个舵面中立位置的理论计算值，步骤如下： [0029] (1)根据当前的飞行速度、海拔高度、无人机质量，通过升重平衡得出升力系数。
[0030]
[0031] 其中Ρ为大气密度，Sw为机翼面积，m为飞行器质量，g为重力加速度，以上参数均已 知，以大气数据参数表或无人机气动参数表的形式存储在无人机飞行控制系统中。
[0032] (2)根据升力系数、升力线斜率与零升迎角得出平飞迎角。
[0033]
[0034] 其中，Cl为平飞升力系数，CLQ为零迎角升力系数，Cu为升力线斜率，以上参数均已 知，以大气数据参数表或无人机气动参数表的形式存储在无人机飞行控制系统中。
[0035] (3)根据平飞迎角、目标航迹可以得出俯仰角中立位置。
[0036] θ=α+γ
[0037] 其中，α为平飞迎角，γ为目标航迹倾角。
[0038] (4)根据平飞迎角、静稳定系数、升降舵操纵增益，通过力矩平衡可以得出升降舵 中立位置。
[0039]
'-ymae
[0040] 其中，CmQ为零迎角俯仰力矩系数，cma为俯仰静稳定裕度，Ude为俯仰操纵增益，以 上参数均已知，以大气数据参数表或无人机气动参数表的形式存储在无人机飞行控制系统 中。
[0041] (5)根据当前的飞行速度、海拔高度，通过推阻平衡可以得出平飞阻力与平飞需用 推力。
[0042]
[0043]其中，T为平飞需用推力，D为平飞阻力，P为大气密度，V为飞行速度，Sw为机翼面 积，cD为阻力系数，α为平飞升力系数，a为升阻计算系数，以上参数均已知，以大气数据参数 表或无人机气动参数表的形式存储在无人机飞行控制系统中。
[0044] (6)根据平飞需用推力与动力系统相应参数得出油门中立位置。
[0045]
[0046]
[0047]
[0048] 其中ω为螺旋桨转速，Urff为需用电压，二者为待计算的中间变量;Kpl，Kp2为由螺 旋桨正值参数，R为电枢回路总内阻，Κ ν为电势系数，Κτ为电动机的扭矩常数，Kq为负载系数， λ为电机参数，Um为电机额定电压，δ τ为油门控制量，以上动力系统参数已知，是由动力系统 厂家给出或试验测得。
[0049] (7)根据当前目标航线的侧向风的分量，无人机侧面积以及无人机质量，通过侧力 平衡得出滚转角中立位置。
[0050]
[0051]其中Δρι为无人机两侧压力差，与垂直于航线的风的分量正相关，Si为无人机侧面 积，以上参数均已知，以大气数据参数表或无人机气动参数表的形式存储在无人机飞行控 制系统中。
[0052]本发明中，根据飞行状态与控制指令的偏差，采用偏差修正算法，生成无人机各舵 面中立位置修正项，实时修正舵面中立位置理论计算值与实际值的偏差，其方法为：
[0053] (1)计算目标姿态角
[0054]由经典PID控制技术，根据目标指令与实际指令的偏差，通过比例、微分、积分运 算，分别得到目标俯仰角与目标滚转角。
[0055] 其中目标俯仰角，由目标高度与实际高度的偏差，经PID控制器给出；
[0056] 目标滚转角，由目标航向与实际航向的偏差，经PID控制器给出；
[0057] 目标高度与目标航向，由具体的飞行任务航线给出；实际的高度、航向，由机载传 感器测量得到。
[0058] (2)计算目标舵面偏量
[0059] 由经典PID控制技术，根据目标姿态角与实际姿态角的偏差，通过比例、微分、积分 运算，得到升降舵、副翼、油门等目标舵面偏量S。
[0060] 其中升降舵的目标舵面偏量，由目标俯仰角与实际俯仰角的偏差，经PID控制器给 出；
[0061] 副翼的目标舵面偏量，由目标滚转角与实际滚转角的偏差，经PID控制器给出； [0062]油门的目标控制量，由目标速度与实际速度的偏差，经PID控制器给出；
[0063]目标俯仰角、目标滚转角由上一步计算得出，目标速度由当时无人机执行任务情 况人为指定，实际俯仰角、实际滚转角以及实际速度可由机载传感器实时测出。
[0064] (3)计算舵面中立位置修正项
[0065]对各个目标舵面偏量即升降舵、副翼、油门的目标舵面偏量进行积分平均，且各自 积分平均的时间应不小于相应控制通道动态响应周期的2倍，该平均值用作相应舵面中立 位置修正项。这里，控制通道，是指滚转、俯仰、偏航三个姿态对应的控制回路;动态响应周 期，是指飞行器在平衡位置受到扰动以后，进行的模态运动的振荡周期。
[0066]积分应考虑饱和处理，在此以滑动窗口积分为例，舵面中立位置修正项等于
[0067]
[0068] 其中，T为窗口长度，t为当前时间，τ为积分时间，δ为目标舵面偏量。
[0069] 经过本发明一种无人机中立位置自动调整的飞行控制方法，最终得到的实际目标 舵面控制量为舵面中立位置、目标舵面偏量、舵面中立位置修正项之和。
[0070] 本发明的有益效果：
[0071] 通过自动计算无人机中立位置并在控制中作相应调整，实现适