作者简介: 王乾(1985-), 男(汉), 天津, 博士研究生。
飞翼布局无人机(UAV)由于缺少垂直尾翼的安定作用,航向通道不稳定或具有弱稳定性,侧风条件下容易引起侧滑,影响航迹跟踪精度。针对一种没有安装侧滑角传感器的小型飞翼无人机,根据惯性器件测量数据和无人机气动参数,使用扩展Kalman滤波方法估计无人机的侧滑角大小并控制消除侧滑。在抑制侧滑的条件下,推导建立了无人机航迹跟踪侧向运动的非线性模型,利用反馈线性化方法,将运动模型转化为带有扰动的线性模型,进而引入虚拟控制变量,使用保性能 H∞鲁棒控制器设计方法,优化得到航迹跟踪反馈控制参数。仿真结果表明: 该方法能够估计并有效抑制侧风条件下飞翼无人机侧滑等干扰,实现航迹的精确跟踪。
Flying-wing unmanned aerial vehicles (UAV) have poor stability or are unstable in the lateral direction due to their tailless configuration, which can cause sideslip and affect tracking accuracy in the presence of crosswinds. This paper presents an extended Kalman filter method for estimating the angle-of-sideslip using inertial sensor data and aerodynamic data for a small flying-wing UAV without sideslip sensors. The estimation result is employed as a feedback to control the split drag rudders for reducing sideslip. In addition, the paper presents a nonlinear UAV lateral tracking model for small sideslip. The model is transformed to a linear system relative to the crosswind disturbance using feedback linearization. A performance restricted H∞ robust control design method is implemented based on the linear system by introducing a virtual control variable. Robust feedback control parameters are obtained from the optimization result. Simulations show the validity of the method in counteracting crosswind effects for accurate tracking.
飞翼布局无人机(UAV)由于缺少垂直尾翼,航向稳定性接近中性或不稳定。当飞行过程中存在侧风干扰时,飞翼无人机与常规布局飞机相比,由于缺少垂尾的“风标稳定性”作用,更容易产生侧滑,影响航迹跟踪精度。大型无人机一般安装有测量侧滑角的传感器,但测量结果容易受到结冰等因素影响。一些大学和科研机构用于试验验证算法的小型无人机平台由于研制成本和无人机载荷能力的限制,没有安装侧滑角传感器。因此,设计一种在没有侧滑角传感器条件下的抗侧风航迹跟踪控制方法,对飞翼布局无人机控制技术具有实际应用意义。
文[1]分析了飞翼无人机横侧向运动特征,文[2]通过仿真分析了侧风对航迹跟踪性能的影响。文[3]总结了3种常用的飞机抗侧风控制方法: 直接侧力法、侧滑法和侧航法。文[4]针对一种常规固定翼无人机使用自适应逆推控制方法,通过估计未知侧风扰动参数,使用逆推控制器设计方法消除侧风对航迹跟踪的影响,但所使用的无人机模型安装有垂直尾翼,可以自动消除侧滑,在飞翼无人机上该方法无法直接使用。文[5]使用线性二次型调节器(LQR)方法设计了一种弹性机翼飞机进近着陆阶段的抗侧风控制器。文[6]使用主动干扰抑制方法,通过估计干扰大小抑制消除侧风引起的干扰。文[1,7-8]针对飞翼无人机设计了抗侧风控制器,但使用的是传统的PID参数整定方法。这些航迹跟踪控制方法都假设侧滑角信息可以被测量或系统可以自动消除侧滑。针对航向不稳定的飞翼无人机在无侧滑角传感器条件下的抗侧风控制方法文献还较少。
本文以一种小型飞翼布局无人机为控制对象,在没有侧滑角测量传感器的条件下,利用惯性器件测量数据使用扩展Kalman滤波器(EKF)估计侧滑角作为反馈抑制侧滑。同时,使用保性能
本文选用北东地(NED)地理坐标系,无人机在机体坐标系下的受力关系为[9]
其中: F为合力,角标b表示机体坐标系, T为发动机推力, L为升力, D为空气阻力, Y为侧滑产生的侧力, α为迎角, β为侧滑角。 L, D和 Y满足 L=
在地理坐标系下,无人机动力学方程为
其中: m为无人机质量, g为重力加速度, Vk为地理坐标系下地速,
在平面地理坐标系下,参考航迹在地面投影使用直线方程 xsin ψc -ycos ψc +C=0表示, ψc为定常参考航向, C为常数。则航迹跟踪侧偏距可表示为
在该定义下,参考航线位于无人机右侧时,偏航距值为正。式(3)两边对时间求二阶导数,得到
将式(2)代入式(4), 进而代入式(1)展开可得
其中: Δ ψ=ψc -ψ, δ( β)为侧滑产生的力。当抑制侧滑时, β值较小, δ( β)为 β的一阶小量,且满足 β→0, δ( β)→0。如果使用侧航法,当进入稳态时, ϕ→0,
式(5)可转化为
无人机航迹跟踪控制一般首先使用协调转弯的方式将无人机航向调整至与参考航向之差小于预置阈值时,再接入航迹跟踪控制律,因此对于航迹跟踪收敛的控制律,可以保证 |Δ ψ|<45°。当 |Δ ψ|<45°且 |ϕ|<45°时, fZ( ϕ, θ,Δ ψ)关于 ϕ满足严格单调递减。由于当 ϕ=0时, fZ=0, 因此当 δ( β)→0时, Δ
为描述方便,定义状态变量 x1 =Δ Z, x2 =Δ
无人机航迹跟踪问题的目标即通过控制 ϕ使得 x1→0, x2→0。
由于无人机没有安装侧滑角测量装置,可以根据惯性测量装置数据,设计一种EKF滤波器,估计出侧滑角大小。选取状态变量为 X=[ V, α, β]T, 选取测量变量为 z=
其中: w∈ℝ3是随机驱动噪声,其协方差矩阵为 Q; v∈ℝ4是测量噪声,其协方差矩阵为 R。状态更新方程为 f( X( t), t) =
其中 p、 q和 r分别表示滚转、俯仰和偏航角速率。测量方程 h( X( t), t) =
在估计气动力时使用简化的气动参数模型 CL=CL0 +CL1 α, CD=CD0 +CD1 α, CY=CYββ, 其中 CL0、 CL1、 CD0、 CD1和 CYβ等气动力参数在估计中使用流体力学软件计算得到的估计值。
计算 f( X( t), t)和 h( X( t), t)的Jacobi矩阵,得到
其中
其中: Ts为采样周期, Xk=X( kTs)。状态变量中迎角和侧滑角的初值可取为0, 空速根据动压传感器测量值计算得到。 Q和 R的值由测量传感器精度和模型不确定性决定。
本文提出的抗侧风控制算法基于侧航法的控制策略,首先根据在线估计的侧滑角信息,使用开裂式阻尼方向舵控制无人机航向以消除侧滑角,令无人机状态满足节1中侧向运动模型推导过程中 β≈0的条件。其次,使用反馈线性化方法,通过引入虚拟控制变量,将侧向运动模型转化为带扰动的线性模型,再通过设计
使用阻尼方向舵控制航向,消除侧滑角。同时,由于飞翼布局飞行器没有安装垂尾,航向阻尼作用较弱,还需要使用阻尼方向舵增加航向阻尼,其控制律为
引入虚拟控制变量
则式(7)可以改写为带输入扰动的线性模型:
基于该模型设计鲁棒控制律,抑制侧风引起的扰动,控制律计算得到
其中 ϕc表示滚转角控制指令。根据无人机使用的惯导姿态测量精度Δ ϕm和飞控系统姿态控制精度Δ ϕc, 可以确定Newton法迭代误差 ε=max(Δ ϕm,Δ ϕc), 当相邻两次迭代得到的增量 |Δ ϕc |<ε, 则停止迭代。由于 fZ关于 ϕ单调有界,因此使用Newton法可以在较少的迭代步数内收敛,满足实时计算的要求。
由于系统不能完全消除侧风引起的侧滑产生的侧力干扰,为了使无人机具备抑制侧滑扰动的能力,根据以下定理设计状态反馈
定理1 给定如下系统
其中: x∈ℝ n是状态向量, u∈ℝ m是控制输入, z∈ℝ r是被调输出, w∈ℝ q是能量有界的未知外部扰动, As、 Bs1、 Bs2、 Cs和 Ds为系统方程矩阵。对于给定的标量 γ>0, 存在一个状态反馈
如果式(11)存在一个可行解 X*和 W*, 则式(10)的一个状态反馈 γ次优
同时,为了使无人机具备航迹跟踪快速响应的能力,减少控制过程超调振荡,需要增加对闭环系统极点配置约束,以保证无人机航迹跟踪控制响应满足性能要求。文[12]给出定理2。
定理2 对于复平面区域 DR, 如果存在一个对称矩阵 LR∈ℝ m×m和矩阵 MR∈ℝ m×m使得
则称 DR为一个线性矩阵不等式(LMI)区域。对于给定的区域 DR, 矩阵 A∈ℝ n×n的特征值都位于 DR中的充分必要条件是存在一个对称正定矩阵 X∈ℝ n×n, 使得
其中“”为矩阵的Kronecke r乘积。
控制器设计希望无人机能够快速跟踪航迹,闭环系统极点应位于复平面左半平面,且与虚轴有一定距离,以保证收敛速度。同时,需要考虑到如果配置极点实部过小,可能使反馈增益过大,导致虚拟控制变量始终处于饱和状态,而使系统跟踪性能下降甚至诱发振荡。另外,希望航迹跟踪基本没有超调,因此设定 DR为
根据定理1和2, 对于式(10), 带有闭环极点约束的 γ次优
该优化问题可以使用MATLAB中msfsyn函数进行求解。如果 X*和 W*是上述优化问题的最优解,则式(10)的状态反馈控制律可以表示为 u=W*
控制器抗侧风能力存在一定的适用范围,由 fZ表达式可见,当侧风逐渐增大,稳态时系统消除侧滑,偏航角 |Δ ψ|增大,则
本文基于某小型飞翼布局无人机(见图1), 利用CFD软件计算得到海拔500 m, 巡航速度25 m/s工作点的气动参数,使用MATLAB Simulink构建无人机非线性动力学仿真模型,其主要特征参数如表1所示。由航向静稳定导数可见,无人机航向通道具有弱不稳定性。
仿真设定一条自西向东,参考高度100 m的航线,设置10 m/s的南风作为侧风干扰,验证控制器抗侧风能力,无人机初始条件相同,对比三种无人机控制方法的航迹跟踪响应情况。方法1为本文提出的控制方案; 方法2使用方法1中的算法估计侧滑角并抑制侧滑,航迹跟踪使用如下经典的PID控制算法[3]
方法3中无侧滑角估计和侧滑抑制,航迹跟踪控制方法与方法2相同。
将式(8)中的无人机侧向运动模型表示为式(10)的形式,其系统矩阵为
由式(13)定义的 DR的参数取 h1 =-0 .1, h2 =1 .0, ϑ=6°。求解式(14)得到最优解 γ*=10 .0, 状态反馈增益 K=[ -0 .193 4, -0 .921 3]。限制无人机航迹跟踪阶段最大滚转角指令为 ±20°。反馈线性化中法迭代误差设定为0 .2°, 仿真结果表明,该条件下一般迭代3次即可收敛,满足实时性计算要求。其他仿真参数 Kβ=-10, Kr=5, Kψ=1 .6, KZ=-0 .1934, KdZ=-0 .921 3, KsZ=-0 .000 16, 仿真结果如图2—5所示。
由仿真结果可见,由于模型参数存在误差,侧滑角估计中使用的简化模型气动参数与仿真计算模型使用的气动参数存在偏差,侧滑角估计值与真实值在幅值上存在一定偏差,但两者极性和动态特征一致,配合航向阻尼,仍可以有效抑制侧滑。
侧偏跟踪结果中,方法1航迹跟踪侧偏误差最小,跟踪误差稳态时小于0.1 m。方法2使用与方法1相同的主反馈增益,仿真时间0~10 s的动态响应阶段曲线与方法1结果基本相同。稳态阶段出现振荡,侧偏跟踪误差约2 m, 表明本文提出的反馈线性化结构可以一定程度上抑制模型非线性诱发的振荡。方法2也可以通过降低增益的方式抑制振荡,但相应的会增加系统过渡过程响应时间。方法3由于没有抑制侧滑,南风作用下侧滑产生的侧力使航迹跟踪发散,说明侧滑对飞翼布局无人机航迹跟踪影响较大,必须加以抑制。
方法2中的偏航角反馈在航迹跟踪中起到类似阻尼的作用。该方法产生跟踪误差的原因是,当控制达到稳态时,由式(6), Δ
综上对比结果,利用侧滑角估计的结果可以有效抑制侧滑。与传统的航迹跟踪控制方法相比,基于式(6)设计的保性能
针对一种没有安装侧滑角传感器的小型飞翼布局无人机,基于无人机气动数据,本文设计了EKF滤波器利用惯性器件测量数据来估计侧滑角,并使用开裂式阻尼方向舵抑制侧滑,推导给出抑制侧滑角条件下无人机航迹跟踪侧向运动模型。基于该模型利用反馈线性化方法,将系统转化为带扰动的线性模型。同时,引入虚拟控制变量,使用保性能
[1] |
|
[2] |
|
[3] |
|
[4] |
|
[5] |
|
[6] |
|
[7] |
|
[8] |
|
[9] |
|
[10] |
|
[11] |
|
[12] |
|