《推力变向无人机的姿态控制系统及控制方法.pdf》由会员分享,可在线阅读,更多相关《推力变向无人机的姿态控制系统及控制方法.pdf(21页珍藏版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 102163059 A (43)申请公布日 2011.08.24 CN 102163059 A *CN102163059A* (21)申请号 201110106239.3 (22)申请日 2011.04.27 G05D 1/08(2006.01) (71)申请人 南京航空航天大学 地址 210016 江苏省南京市御道街 29 号 (72)发明人 甄子洋 浦黄忠 王新华 江驹 王道波 (74)专利代理机构 南京经纬专利商标代理有限 公司 32200 代理人 许方 (54) 发明名称 推力变向无人机的姿态控制系统及控制方法 (57) 摘要 本发明公开了一种推力变向无人机的。
2、姿态控 制系统及控制方法。本发明首次建立了推力变向 无人机的非线性全量数学模型和线性化纵横向数 学模型, 并利用融合估计和最优控制的方法, 提出 了本发明的基于姿态回路信息融合的推力变向无 人机的姿态控制系统及控制方法。对于推力变向 无人机的设计开发具有极为重要的现实意义。本 发明在控制性能方面优于传统单变量控制方法, 且计算简单, 完全满足实际飞行控制系统的实时 性要求。 (51)Int.Cl. (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书 3 页 说明书 13 页 附图 4 页 CN 102163060 A1/3 页 2 1. 一种推力变向无人机的姿态控制系统, 。
3、所述推力变向无人机采用单发动机, 发动机 安装位置处于飞机纵向对称面上, 所述姿态控制系统包括根据给定姿态指令信号解算控制 律, 得到姿态控制信号并将姿态控制信号输出给执行机构的姿态控制器, 其特征在于, 所述姿态控制器包括纵向姿态信息融合控制器和横向姿态信息融合控制器 ; 所述纵向姿态信息融合控制器的输入为期望的飞行速度增量 V*、 期望的俯仰角增 量 *、 期望的迎角增量 *、 期望的俯仰角速度增量 q*、 传感器反馈的俯仰角速度增 量 q、 传感器反馈的俯仰角增量 、 传感器反馈的迎角增量 、 传感器反馈的飞行 速度增量 V、 期望的升降舵偏角增量 e*、 油门开度增量 T*、 发动机推。
4、力纵向偏角 增量 T*; 输出为升降舵偏角增量 e、 油门开度增量 T、 发动机推力纵向偏角增量 T, 其信息融合最优控制律如下, 式中,为虚拟纵向状态向量Xlon的融合估计, Plon-1为融合估计的融合信息量, 且 融合估计及其信息量 Plon-1由下面公式逆向递推计算获得, 式中, Xlon V, , , qT, Ulon T, e, TT, Alon(k), Blon(k) 为连 续时间纵向线性化运动方程经过离散化后的系统矩阵, Rlon(k), Qlon(k) 为最优性能指标权 重矩阵, Xlon* V*, *, *, q*T为期望的纵向状态向量, Ulon* T*, e*, T*T。
5、为期望的纵向控制向量 ; 所述横向姿态信息融合控制器的输入为期望的侧滑角增量 *、 期望的滚转角增量 *、 期望的滚转角速度增量p*、 期望的偏航角速度增量r*、 传感器反馈的滚转角速度 增量 p、 传感器反馈的滚转角增量 、 传感器反馈的偏航角速度增量 r、 传感器反馈 的侧滑角增量 、 期望的副翼偏角增量 *、 期望的方向舵偏角增量 r*、 期望的发 动机推力横向偏角增量 T*, 输出为副翼偏角增量 、 方向舵偏角增量 r、 发动机 推力横向偏角增量 T, 其信息融合最优控制律如下, 式中, 为虚拟横向状态向量Xlat的融合估计, Plat-1为融合估计的融合信息量, 且融 合估计及其信息。
6、量 Plat-1由下面公式逆向递推计算获得, 式中, Xlat , , p, rT, Ulat a, r, TT, Alat(k), Blat(k) 为 连续时间横侧向线性化运动方程经过离散化后的系统矩阵, Rlat(k), Qlat(k) 为最优性能指 权 利 要 求 书 CN 102163059 A CN 102163060 A2/3 页 3 标权重矩阵, Xlat*, *, p*, r*T为期望的横向状态向量, Ulat* a*, r*, T*T为期望的横向控制向量, 其它参数为中间矩阵变量 ; 所述纵向线性化运动方程如下式所示, 式中, Xlon V, , , qT Ulon T, e。
7、, TT 所述横侧向线性化运动方程如下式所示, 式中, Xlat , , p, rT, Ulat a, r, TT, 权 利 要 求 书 CN 102163059 A CN 102163060 A3/3 页 4 2. 一种推力变向无人机的姿态控制方法, 所述推力变向无人机采用单发动机, 发动机 安装位置处于飞机纵向对称面上, 其特征在于, 所述推力变向无人机采用权利要求 1 所述 姿态控制系统进行姿态控制, 包括以下步骤 : 步骤 1、 姿态控制系统接收给定姿态指令信号、 传感器反馈姿态信号以及期望控制信 号, 所述给定姿态指令信号包括, 纵向期望姿态信号 Xlon* V*, *, *, q*。
8、T, 横向 期望姿态信号 Xlat* *, *, p*, r*T, 所述传感器反馈姿态信号包括, 纵向实际 姿态信号 Xlon V, , , qT, 横向实际姿态信号 Xlat , , p, r T, 所述期望控制信号包括, 纵向期望控制信号 U lon * T*, e*, T*T, 横向期望控 制信号 Ulat* a*, r*, T*T; 步骤 2、 姿态控制系统根据接收到的给定姿态指令信号解算姿态控制律, 得到纵向姿态 控制信号 Ulon T, e, TT, 横向姿态控制信号 Ulat a, r, TT; 步骤 3、 姿态控制系统将姿态控制信号发送给执行机构, 执行机构操纵无人机的气动舵 。
9、面、 油门开度、 推力方向, 实现控制无人机飞行姿态和飞行速度的目的。 权 利 要 求 书 CN 102163059 A CN 102163060 A1/13 页 5 推力变向无人机的姿态控制系统及控制方法 技术领域 0001 本发明涉及无人机的姿态控制系统及控制方法, 尤其涉及一种推力变向无人机的 姿态控制系统及控制方法, 属于飞行控制技术领域。 背景技术 0002 侦察攻击一体化无人机提高了部队的战场空间感知能力、 对高风险目标的突防能 力、 电子战能力和对敌防空系统的压制能力, 实现了对敌机动目标精确、 快速攻击, 是一种 适应信息战特点和需求的全新武器系统, 使无人机发展的重要趋势之一。
10、。 0003 推力矢量控制技术是目前比较先进的飞行控制手段, 在现代飞行器中得到成功应 用。 推力矢量技术在有人机上已被验证能够改善飞机的隐身性、 机动能力和敏捷性等, 因此 推力矢量技术的应用已成为无人机察打一体化发展的重要技术之一。所谓推力矢量技术, 是指发动机推力通过喷管或尾喷流的偏转产生的推力分量来替代原飞机的操纵面或增强 飞机的操纵功能, 对飞机的飞行进行实时控制的技术。 与一般的推力矢量技术相比较而言, 变推力轴线技术既不特指喷气发动机, 也不特指燃气舵, 它可以通过增加额外的辅助装置, 实现对螺旋桨飞机或喷气飞机的推力偏转, 从而使飞机获得额外的控制能力。变推力轴线 技术近年来刚。
11、开始有人研究, 仍然处于理论研究阶段, 理论研究和数值仿真结果表明它具 有与推力矢量技术相似的作用。此处的推力变向技术, 是涡喷式无人机的推力矢量技术与 螺旋桨无人机的变推力轴线技术的统称。所谓推力变向技术, 是指通过控制发动机使其推 力产生纵向或横向的偏转, 从而对飞机产生附加的推力分量和附加推力力矩, 实现对原有 气动操纵面的增强或替代的一种技术。 0004 关于推力矢量无人机、 变推力轴线无人机的非线性数学模型已有公开文献, 但是, 这些文献中的无人机飞行控制系统主要实现姿态控制、 高度控制和航路控制等飞行模态。 飞行航路控制系统的任务是使无人机能自动地按预定航线飞行, 对飞行器航向和偏。
12、离参考 航路线距离的控制。 0005 为了适应无人机察打一体化的发展趋势, 对推力变向无人机的姿态控制提出更高 的要求。传统无人机飞行控制策略主要基于经典的单变量控制回路频域或根轨迹方法。然 而, 无人机飞行控制系统是一个典型的多输入多输出系统, 传统方法难于协调处理。 无人机 飞行滚转角速度引起偏航力矩, 偏航角速度引起滚转力矩, 而侧滑角会引起滚转和偏航力 矩, 同时滚转和航向操纵也常常是交联的。现代控制理论的优势就在于解决多变量系统的 控制问题, 与经典设计方法相比, 现代控制技术不再是单回路逐个设计, 矩阵运算使得所有 的控制增益同时计算, 也即所有的控制回路同时闭合, 并且能够利用更。
13、多的系统状态信息。 利用现代控制技术设计飞行控制系统的试验和验证一直在不断地进行, 并取得了一些成功 的经验。最优控制理论是现代控制理论的重要组成部分, 传统最优控制方法主要有极小值 原理、 动态规划方法、 Lyapunov 函数方法、 矩阵配方法等。传统方法求解最优控制问题都是 基于严格的数学原理, 推导过程比较复杂, 且不适合解决非线性、 时滞性、 状态相关或控制 受约束等系统的最优控制问题。融合估计和最优控制都属于二次型最优化问题, 融合控制 说 明 书 CN 102163059 A CN 102163060 A2/13 页 6 的思想启发于融合估计, 是一种崭新的最优控制方法。利用融合。
14、估计的方法来求解最优控 制问题, 推导过程因为具有物理含义而显得容易理解, 并且有利于解决上述特定系统的最 优控制问题。 发明内容 0006 本发明所要解决的技术问题在于解决现有无人机姿态控制技术所存在的不足, 提 供一种基于姿态回路信息融合的推力变向无人机的姿态控制系统及控制方法。 0007 本发明采用以下技术方案 : 0008 一种推力变向无人机的姿态控制系统, 所述推力变向无人机采用单发动机, 发动 机安装位置处于飞机纵向对称面上, 所述姿态控制系统包括根据给定姿态指令信号解算控 制律, 得到姿态控制信号并将姿态控制信号输出给执行机构的姿态控制器, 所述姿态控制 器包括纵向姿态信息融合控。
15、制器和横向姿态信息融合控制器 ; 0009 所述纵向姿态信息融合控制器的输入为期望的飞行速度增量 V*、 期望的俯仰角 增量 *、 期望的迎角增量 *、 期望的俯仰角速度增量 q*、 传感器反馈的俯仰角速度 增量 q、 传感器反馈的俯仰角增量 、 传感器反馈的迎角增量 、 传感器反馈的飞行 速度增量 V、 期望的升降舵偏角增量 e*、 油门开度增量 T*、 发动机推力纵向偏角 增量 T*; 输出为升降舵偏角增量 e、 油门开度增量 T、 发动机推力纵向偏角增量 T, 其信息融合最优控制律如下, 0010 0011 0012 式中,为虚拟纵向状态向量 Xlon的融合估计, Plon-1为融合估计。
16、的融合信息 量, 且融合估计及其信息量 Plon-1由下面公式逆向递推计算获得, 0013 0014 式中, Xlon V, , , qT, Ulon T, e, TT, Alon(k), Blon(k) 为连续时间纵向线性化运动方程经过离散化后的系统矩阵, Rlon(k), Qlon(k) 为最优性能指 标权重矩阵, Xlon* V*, *, *, q*T为期望的纵向状态向量, Ulon* T*, e*, T*T为期望的纵向控制向量 ; 0015 所述横向姿态信息融合控制器的输入为期望的侧滑角增量 *、 期望的滚转角 增量 *、 期望的滚转角速度增量 p*、 期望的偏航角速度增量 r*、 传。
17、感器反馈的滚转 角速度增量 p、 传感器反馈的滚转角增量 、 传感器反馈的偏航角速度增量 r、 传感 器反馈的侧滑角增量 、 期望的副翼偏角增量 *、 期望的方向舵偏角增量 r*、 期 望的发动机推力横向偏角增量 T*, 输出为副翼偏角增量 、 方向舵偏角增量 r、 发动机推力横向偏角增量 T, 其信息融合最优控制律如下, 0016 0017 说 明 书 CN 102163059 A CN 102163060 A3/13 页 7 0018 式中, 为虚拟横向状态向量Xlat的融合估计, Plat-1为融合估计的融合信息量, 且融合估计及其信息量 Plat-1由下面公式逆向递推计算获得, 001。
18、9 0020 式中, Xlat , , p, rT, Ulat a, r, TT, Alat(k), Blat(k) 为连续时间横侧向线性化运动方程经过离散化后的系统矩阵, Rlat(k), Qlat(k) 为最优性能 指标权重矩阵, Xlat* *, *, p*, r*T为期望的横向状态向量, Ulat* a*, r*, T*T为期望的横向控制向量, 其它参数为中间矩阵变量 ; 0021 所述纵向线性化运动方程如下式所示, 0022 0023 式中, 0024 Xlon V, , , qT 0025 Ulon T, e, TT 0026 0027 0028 所述横侧向线性化运动方程如下式所示。
19、, 0029 0030 式中, 0031 Xlat , , p, rT, 0032 Ulat a, r, TT, 说 明 书 CN 102163059 A CN 102163060 A4/13 页 8 0033 0034 0035 一种推力变向无人机的姿态控制方法, 所述推力变向无人机采用单发动机, 发动 机安装位置处于飞机纵向对称面上, 所述推力变向无人机采用权利要求 1 所述姿态控制系 统进行姿态控制, 包括以下步骤 : 0036 步骤 1、 姿态控制系统接收给定姿态指令信号、 传感器反馈姿态信号以及期望控制 信号, 所述给定姿态指令信号包括, 纵向期望姿态信号 Xlon* V*, *, 。
20、*, q*T, 横向期望姿态信号 Xlat* *, *, p*, r*T, 所述传感器反馈姿态信号包括, 纵向 实际姿态信号 Xlon V, , , qT, 横向实际姿态信号 Xlat , , p, rT, 所述期望控制信号包括, 纵向期望控制信号 Ulon* T*, e*, T*T, 横向期 望控制信号 Ulat* a*, r*, T*T; 0037 步骤 2、 姿态控制系统根据接收到的给定姿态指令信号解算姿态控制律, 得到纵向 姿态控制信号 Ulon T, e, TT, 横向姿态控制信号 Ulat a, r, T T ; 0038 步骤 3、 姿态控制系统将姿态控制信号发送给执行机构, 执。
21、行机构操纵无人机的气 动舵面、 油门开度、 推力方向, 实现控制无人机飞行姿态和飞行速度的目的。 0039 本发明首次建立了推力变向无人机的非线性全量数学模型和线性化纵横向数学 模型, 并利用融合估计和最优控制的方法, 提出了本发明的基于姿态回路信息融合的推力 变向无人机的姿态控制系统及控制方法。 对于推力变向无人机的设计开发具有极为重要的 现实意义。 附图说明 0040 图 1 为本发明所建立的推力变向无人机非线性全量模型的结构示意图 ; 0041 图 2 为本发明的推力变向无人机的姿态控制系统控制原理示意图 ; 0042 图 3 为采用传统单回路姿态控制方法所得到的仿真结果 ; 0043 。
22、图 4 为采用本发明姿态控制方法所得到的仿真结果。 具体实施方式 0044 下面结合附图对本发明的技术方案进行详细说明 : 说 明 书 CN 102163059 A CN 102163060 A5/13 页 9 0045 要得到推力变向无人机的姿态控制系统及方法, 首先要建立推力变向无人机的非 线性全量模型。 该推力变向无人机采用单发动机, 其安装位置处于飞机纵向对称面上, 若是 螺旋桨无人机, 则推力变向机械装置安装于发动机上, 可实现发动机的两自由度偏转运动。 设发动机推力 T 在飞机对称面上的投影与 xb轴的夹角记为 T, 称之为推力纵向偏转角, 投 影在机体轴下为正 ; 推力在 xb-。
23、yb平面的投影与 xb轴的夹角记为 T, 称之为推力横向偏转 角, 投影在对称平面右侧为正。推力变向无人机的非线性全量模型由动力学方程组和运动 学方程组组成。动力学方程组包含质心移动的动力学方程组 ( 又称力方程组 ) 和绕质心转 动的动力学方程组 ( 又称力矩方程组 )。无人机的运动学方程组包括质心移动的运动学方 程组 ( 又称导航方程组 ) 和绕质心转动的运动学方程组 ( 又称运动方程组 )。描述推力变 向无人机的数学模型需要明确输入输出关系, 为此建立如图 1 所示的模型结构框图, 图中 虚线框描述的就是推力变向无人机的动力学和运动学模型。 推力变向无人机系统的控制输 入信号包括升降舵偏。
24、转角e、 副翼舵偏转角a、 方向舵偏转角r、 油门大小T、 推力偏转 角 T、 T, 状态或输出信号包括飞行速度 V、 迎角 、 侧滑角 、 航迹倾斜角 、 航迹方位 角空间位置坐标 x, y, z、 空间姿态角 , , 及其角速率 p, q, r, 飞机的合外力由气动 力 Ax, Ay, Az、 重力 Gx, Gy, Gz和推力 Tx, Ty, Tz组成, 合外力矩由气动力矩MA, NA和推力力矩 MT, NT组成。 0046 基于推力变向无人机的受力和力矩分析, 容易获得其非线性动力学和运动学方程 组。 与常规无人机不同, 变推力无人机的控制输入信号增加了发动机推力的两个偏转角, 使 飞机。
25、 yb轴和 zb轴向的推力分量不再是零, 因此无人机的合外力发生变化, 由于发动机的安 装位置不在质心处, 因此也引起无人机的合外力矩发生改变。 0047 推力变向无人机的数学模型与常规无人机相比, 具有以下特点 : 0048 (1)对于常规无人机, 合外力和外力矩计算式中的推力偏转角为TT0, 即 推力在机体坐标系 yb轴和 zb轴向没有分量。由于推力变向无人机的合外力和外力矩与常 规无人机不同, 导致动力学特性也不同。 在力方程组中, 推力变向无人机增加了推力在yb轴 和 zb轴向的分量所引起的部分。在力矩方程组中, 推力变向无人机增加了推力在 yb轴和 zb 轴向的分量引起的力矩项。 0。
26、049 (2) 无人机质心移动的运动学方程描述了飞机在空间位置的变化规律, 绕质心转 动的运动学方程描述了飞机空间姿态的变化规律, 它与飞机旋转角速度密切相关。推力变 向无人机的运动学方程组的描述形式与常规无人机相同, 但是两者的各个状态物理量的动 力学特性不同, 导致运动学特性也会发生改变。 0050 下面根据引入推力变向技术后无人机合外力和外力矩的变化情况, 建立推力变向 无人机的动力学方程组。 0051 根据推力变向无人机的发动机推力的两个偏转角在机体坐标系中的几何关系, 可 得推力 T 在机体坐标轴系的投影为 说 明 书 CN 102163059 A CN 102163060 A6/1。
27、3 页 10 0052 0053 对于常规无人机, 由于 T T 0, 因此 Tx T, Ty Tz 0。 0054 推力变向无人机的合外力由发动机推力、 气动力和重力构成。根据机体坐标系中 飞行器在合外力作用下的线运动方程, 可以推导得到力方程组 0055 0056 式中, D、 Y、 L 分别表示空气阻力、 侧力和升力, m 为飞机质量, Gxa, Gya, Gza分别表示 飞机重力在气流坐标系中的三轴分量。 0057 在研究无人机飞行轨迹特性时, 常采用航迹坐标系上投影的质心动力学方程, 此 时无人机所受的推力、 气动力和重力均需投影到航迹坐标系中。根据飞行器在合外力作用 下的线运动方程。
28、, 可得力方程组为 0058 0059 式中, 为航迹滚转角。 0060 由于常规无人机的发动机推力始终沿着轴线方向保持不变, 因此, 推力变向无人 机的质心移动方程组与常规无人机的区别之处在于, 常规无人机的力方程组中推力沿机体 坐标系的三个分量分别为 Tx T, Ty Tz 0, 将其代入上述力方程组, 即可获得常规无人 机的力方程组。 0061 设推力变向无人机的发动机推力作用点在机体坐标系的坐标为 (lx, ly, lz), 由于 推力作用点位于飞机的对称面Oxz上, 因此ly0, 于是发动机推力力矩的三轴分量表示为 0062 0063 式中, 若 lz 0, lx 0, 当 T 0 。
29、时, 有 Ty 0,NT 0, 即推力产生的滚转 说 明 书 CN 102163059 A CN 102163060 A7/13 页 11 力矩为负, 推力产生的偏航力矩为正, 当 T 0 时, 有 MT 0, 即推力产生低头力矩。对于 常规无人机, 则有 MT Tlz, 0064 若由动量矩定理表示质心的转动运动, 可得变向无人机绕质心转动的动力学方程 组为 0065 0066 由于推力变向无人机与常规无人机的合外力力矩不同, 使得绕质心转动的动力学 特性发生改变。 0067 飞行器运动方程组的线性化一般是在小扰动假设条件下进行的, 在该条件下, 纵 向气动力和力矩对横侧参数在基准运动状态下。
30、的导数为零, 横侧向气动力和力矩对纵向参 数在基准运动下的导数也是零。由于推力变向技术能够补偿飞行操纵效率, 因此在对推力 变向无人机数学模型进行线性化处理时, 有必要考虑发动机推力的两个偏转角。在定直 平飞基准运动状态下, 推力变向无人机的飞行状态满足 : (3)T* T* 0。本节中变量符号带上标 “*” 表示的是基 准运动状态下的变量。 0068 利用小扰动线性化方法, 求出发动机推力的动力学偏导数、 阻力、 升力和侧力的偏 导数、 纵向力矩和横向力矩的偏导数, 基于上述对推力、 空气动力和合外力力矩的偏量分 析, 对推力变向无人机的动力学和运动学方程组进行线性化。求出推力变向无人机的阻。
31、力 线性化方程、 推力变向无人机的升力线性化方程、 推力变向无人机的侧力线性化方程, 求出 机体坐标系下推力变向无人机的力矩线性化方程组。 导航方程组和运动方程组的偏量表达 式、 线性化几何关系方程可参考有关文献, 与常规无人机相同。 0069 推力变向无人机的纵向耦合方程组包括 V, , , q, e, T, T 等七个变量。基于上述线性表达式, 可得推力变向无人机纵向线性化运动方程为 : 0070 0071 式中, 0072 Xlon V, , , qT 0073 Ulon T, e, TT 0074 说 明 书 CN 102163059 A CN 102163060 A8/13 页 12。
32、 0075 0076 横侧向耦合的方程组包含 , , p, r, a, r, T等七个变量。 基于上述线性表达式, 可得推力变向无人机的横侧向线性化运动方程为 : 0077 0078 式中, 0079 Xlat , , p, rT 0080 Ulat a, r, TT 0081 0082 0083 为了便于公众了解本发明的技术方案, 用下表 1 将本发明涉及的物理量进行说 明 : 说 明 书 CN 102163059 A CN 102163060 A9/13 页 13 0084 说 明 书 CN 102163059 A CN 102163060 A10/13 页 14 0085 说 明 书 C。
33、N 102163059 A CN 102163060 A11/13 页 15 0086 0087 表 1 0088 上述高阶线性常微分方程组描述了推力变向无人机偏离基准运动后纵横向运动 的偏离情况, 有关变量的量纲导数可参考文献。 与常规无人机不同, 推力变向无人机的纵向 线性状态方程中增加了控制量 T, 横向线性状态方程中增加了控制量 T, 相应的控 制输入矩阵也增加了对应的分量。 0089 推力变向无人机的姿态控制问题中, 飞行纵向姿态的稳定和控制就是俯仰角的稳 定和控制, 通过控制升降舵和推力纵向偏角来实现, 飞行横侧向姿态的稳定和控制就是要 保证高精度的偏航角和滚转角的稳定和控制, 通。
34、过方向舵、 副翼舵以及推力横向偏转角操 纵来实现。由于控制器设计方法是基于离散状态方程的, 因此有必要对无人机纵横向线性 化方程转化为离散状态方程。 0090 对上述推力变向无人机的纵向、 横侧向线性化模型, 即式 (6)、 (7) 所示, 进行离散 化, 然后设计 0091 首先设计纵向姿态的融合控制器, 建立纵向姿态控制的最优性能指标模型, 如下 说 明 书 CN 102163059 A CN 102163060 A12/13 页 16 式所示 : 0092 0093 0094 式中, Xlon*为期望姿态信号, Ulon*(k) 为期望控制信号, Qlon QlonT 0、 Rlon R。
35、lonT 0 为权重矩阵, k 为时间序列, N 为终端时刻。根据信息融合控制理论与方法, 建立如下信 息表达式 0095 0096 式中, mlon和 nlon为白噪声序列, Emlon(k+1) 0, varmlon(k+1) Qlon-1(k+1), Enlon(k) 0, varnlon(k) Rlon-1(k)。基于信息融合估计定理, 得到纵向姿态的融合控 制律为 0097 (9) 0098 0099 式中, 0100 0101 类似地, 可得到推力变向无人机的横侧向姿态的融合控制律为 0102 (11) 0103 0104 式中, 0105 0106 基于上述纵向、 横侧向姿态的融。
36、合控制律, 可得到本发明的推力变向无人机的姿 态控制系统, 如图 2 所示。 0107 采用本发明的姿态控制系统进行推力变向无人机姿态控制, 按照以下方法 : 0108 步骤 1、 姿态控制系统接收给定姿态指令信号、 传感器反馈姿态信号以及期望控制 信号, 所述给定姿态指令信号包括, 纵向期望姿态信号 Xlon* V*, *, *, q*T, 横向期望姿态信号 Xlat* *, *, p*, r*T, 所述传感器反馈姿态信号包括, 纵向 实际姿态信号 Xlon V, , , qT, 横向实际姿态信号 Xlat , , p, rT, 所述期望控制信号包括, 纵向期望控制信号 Ulon* T*, 。
37、e*, T*T, 横向期 望控制信号 Ulat* a*, r*, T*T; 0109 步骤 2、 姿态控制系统根据接收到的给定姿态指令信号解算姿态控制律, 得到纵向 姿态控制信号 Ulon T, e, TT, 横向姿态控制信号 Ulat a, r, T 说 明 书 CN 102163059 A CN 102163060 A13/13 页 17 T ; 0110 步骤 3、 姿态控制系统将姿态控制信号发送给执行机构, 执行机构操纵无人机的气 动舵面、 油门开度、 推力方向, 实现控制无人机飞行姿态和飞行速度的目的。 0111 为了验证本发明在推力变向无人机姿态控制中的有效性和先进性, 对受到气流。
38、扰 动下的某型推力方向可变的螺旋桨无人机纵横向姿态的稳定过程进行仿真研究, 控制系统 的结构图如图 2 所示。受控对象是全量非线性方程组描述的推力变向无人机, 其气动参数 通过风洞实验获得, 动态方程采用龙格-库塔法进行计算, 仿真工具采用Matlab软件。 考虑 无人机在高度 h 500m、 飞行速度 V 50m/s, 处于定直平飞平衡状态。假设无人机从初始 时刻开始 4s 内持续受到阵风干扰, 气流方向为aero 45, 扰动气流速度为 Vaero 20m/s, 说明无人机的俯仰、 滚转和偏航姿态均受到强干扰。 0112 采用常规单回路设计方法的姿态控制仿真结果如图 3 所示 ; 采用本发。
39、明姿态控制 系统的仿真结果如图 4 所示。其中虚线表示纯气动舵面控制方式下的姿态响应曲线, 实线 表示增加了推力变向控制的姿态响应曲线。 0113 从仿真结果可以得出以下几点结论 : 0114 (1) 推力变向技术能够提高飞机操纵效率, 减小气动舵面的偏转量, 一定程度上能 够避免气动舵面饱和的不利情况, 充分说明了推力变向控制对气动舵面有补偿作用 ; 0115 (2) 气动舵面加推力变向控制下的姿态稳定过程要比纯气动舵面控制下的姿态稳 定过程更加快速, 推力变向无人机受阵风扰动的影响要比常规无人机的更小。 0116 (3) 信息融合控制方法对受阵风干扰下的姿态稳定效果要优于线性单回路设计方 法, 从而验证了融合最优控制方法作为多变量控制方法的优越性。 说 明 书 CN 102163059 A CN 102163060 A1/4 页 18 图 1 说 明 书 附 图 CN 102163059 A CN 102163060 A2/4 页 19 图 2 说 明 书 附 图 CN 102163059 A CN 102163060 A3/4 页 20 图 3 说 明 书 附 图 CN 102163059 A CN 102163060 A4/4 页 21 图 4 说 明 书 附 图 CN 102163059 A 。