CN109976368B - 一种基于直接分配法和零空间的飞行器控制分配方法 - Google Patents
一种基于直接分配法和零空间的飞行器控制分配方法 Download PDFInfo
- Publication number
- CN109976368B CN109976368B CN201910302183.5A CN201910302183A CN109976368B CN 109976368 B CN109976368 B CN 109976368B CN 201910302183 A CN201910302183 A CN 201910302183A CN 109976368 B CN109976368 B CN 109976368B
- Authority
- CN
- China
- Prior art keywords
- control
- pseudo
- distribution method
- matrix
- inverse solution
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 72
- 239000011159 matrix material Substances 0.000 claims description 28
- 238000012937 correction Methods 0.000 claims description 10
- 238000012545 processing Methods 0.000 claims description 4
- 230000017105 transposition Effects 0.000 claims description 2
- 238000010606 normalization Methods 0.000 claims 1
- 230000002028 premature Effects 0.000 abstract 1
- 238000013461 design Methods 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 3
- 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 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 238000011425 standardization method Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于直接分配法和零空间的飞行器控制分配方法,先通过直接分配法求取在期望力矩方向上的最大可达力矩,再使用零空间控制分配方法对所得最大可达力矩进行控制分配,使得控制分配所得实际输出力矩尽可能接近最大可达力矩,同时避免飞行器操纵面的过早饱和,进一步拓宽基于零空间的伪逆控制分配算法的应用范围。
Description
技术领域
本发明属于飞行器控制领域,特别涉及了一种飞行器控制分配方法。
背景技术
随着现代飞行器对其可靠性、机动性、安全性、隐身性能等方面要求的不断提高,现代飞行器的气动布局较传统飞行器发生了很大变化。与传统飞行器相比,现代飞行器常采用多个操纵量组成的冗余配置方案,这使得采用传统的控制器设计方法对现代飞行器的飞行控制律进行设计变得日益复杂。为解决这一问题,控制分配问题应运而生。控制分配方法经过近三十年由国内外众多学者专家的不断研究与探索,已日臻成熟。控制分配作为处理过驱动控制系统设计的有效方法,已经极大地引起了相关研究人员的关注。控制分配方法大体经历了由非优化控制分配方法到优化控制分配方法、从单目标控制分配方法到多目标控制分配方法、从线性控制分配方法到非线性控制分配方法、从静态控制分配方法到动态控制分配方法、从单纯的控制分配理论研究到采用控制分配方法对冗余系统进行重构控制研究等发展过程,衍生出多种控制分配策略。
自控制分配技术提出以来,得到了快速地发展,它有效地降低了冗余控制系统的控制器设计难度,极大地简化了飞行器控制系统的设计。控制分配技术经过近30年由国内外众多学者专家的不断研究与探索,已日益成熟。目前为止,对控制分配方法的研究大多假设系统是线性的,或者假设伪控制量与操纵量偏转量之间呈线性关系Bu=v。
传统的直接分配法从力矩可达集中寻找多个操纵面组合的最佳方案,几何意义直观,但具有计算复杂度高的特点,将其转化成线性规划形式可以有利于算法的求解,有效降低算法的计算复杂度。伪逆法将最优性能指标应用于控制分配问题,但使用该方法在力矩可达集内仍然存在部分控制力矩不可达的情况,这影响了伪逆法的应用范围。级联伪逆法进一步扩展了解空间,但当期望力矩超出可达力矩集边界时,无法进行控制优化。
针对伪逆法与级联伪逆法的不足,采用零空间向量修正策略对伪逆解进行修正,但当期望力矩超出可达力矩集,使用零空间向量无法对伪逆解进行修正,这限制了该方法的使用范围。
发明内容
为了解决上述背景技术提出的技术问题,本发明提出了一种基于直接分配法和零空间的飞行器控制分配方法。
为了实现上述技术目的,本发明的技术方案为:
一种基于直接分配法和零空间的飞行器控制分配方法,包括以下步骤:
(1)获取系统实时的期望力矩v;
(2)采用直接分配法求解控制分配问题,得到期望力矩方向上的最大可达力矩vmax;
(3)采用伪逆法计算出最大可达力矩所对应的操作面偏转指令的伪逆解up;
(4)判断伪逆解up是否超出操纵面物理约束,若未超出则直接输出伪逆解up为最终的控制分配结果;否则采用零空间修正伪逆解up,进入步骤(5);
(5)对零空间修正伪逆解进行初始化;
(6)判断零空间修正伪逆解的迭代次数是否达到设置的最大迭代次数,若未达到则进入步骤(7);否则对当前的操作面偏转指令进行缩放处理后输出为最终的控制分配结果;
(8)确定零空间修正的最小调整步长;
(9)根据最小调整步长计算修正后的操作面偏转指令u*;
(10)判断修正后的操作面偏转指令u*是否超出操纵面物理约束,若未超出则直接输出u*为最终的控制分配结果;否则将u*赋值给up并返回步骤(6)。
进一步地,在步骤(2)中,将控制分配问题转换为直接分配法形式:
其中,J为目标函数,ρ为实数,u∈Rm为操纵面偏转指令,umax和umin分别为操作面偏转指令的上、下界,Bu为系统控制效率矩阵,u1∈Rm为一向量,若ρ>1,则令u=u1/ρ,否则令u=u1;
通过使用直接分配法求解控制分配问题得到在期望力矩方向上的最大可达力矩vmax=Buu。
进一步地,在步骤(3)中,将控制分配问题以最优化方式描述,并忽略操纵面物理约束,得:
进一步地,在步骤(5)中,给定系统控制效率矩阵Bu、最大可达力矩vmax、操作面偏转指令的上、下界umax和umin以及迭代计步器ST=1;
其中,ui为u中的第i个元素,umini和umaxi分别为umin和umax中的第i个元素,li=umaxi-umini,i=1,…,m,m为u中元素个数,m个偏置向量Gi组成矩阵G,m个对角矩阵H(i,i)组成矩阵H。
进一步地,在步骤(7)中,采用下式对伪逆解进行标准化:
其中,下标s1表示集合s中的第1个元素,ups1表示up中s集合中第1个元素,Gs1表示G中s集合中第1个元素,H(s1,s1)表示矩阵H中第s1行、第s1列的元素,urs1为ur中s集合中第1个元素,uri为ur中第i个元素,N为矩阵Bu零空间的一组基,Ns为N中集合s对应的部分,上标T表示转置,Hs为H(s1,s1),H(s2,s2),…,H(se,se)组成的向量;
采用上述技术方案带来的有益效果:
本发明通过引入控制分配环节,能够极大地简化冗余系统控制器设计的复杂度,且与传统的控制分配方法相比,本发明提出的基于直接分配法与零空间的控制分配方法既能够充分考虑操纵面物理约束等约束条件,还能够使得控制分配环节在有限步内计算结束;本发明通过将直接分配法与基于伪逆法的零空间控制分配方法相结合,使得本发明所提出的的控制分配方法适用范围更加宽广;具体优点包括:
(1)本发明提出的基于直接分配法与零空间的控制分配方法,对操纵舵面物理约束上下界的符号不敏感,只与物理约束区间长度与上下界值有关;
(3)本发明通过将直接分配法与基于伪逆法的零空间控制分配方法相结合,使得本发明所提出的控制分配方法较原方法在处理期望力矩不可达问题时更加有效;
(4)本发明通过使用截取法与基于直接分配法与零空间的控制分配方法相结合,使得操纵量偏转量更加接近最大可达力矩。
附图说明
图1是本发明针对的冗余控制系统的结构框图。
图2是本发明的方法流程图。
具体实施方式
以下将结合附图,对本发明的技术方案进行详细说明。
本发明所针对的冗余控制系统的结构框图如图1所示,系统数学表达表述如下:
式中:x∈Rn为飞行器的状态变量;u∈Rm为操纵面的偏转指令,且u∈Ωu={u|umin≤u≤umax},umin和umax为操纵面约束的上下确界;A∈Rn×n为系统矩阵;B∈Rn×m为系统的控制矩阵且B列不满秩;C∈Rk×n为系统输出矩阵。
由系统的过驱动特性,引入虚拟控制指令:v=Buu,其中v∈Rl为控制器输出的虚拟指令;Bu为系统的控制效率矩阵。可以将上式重新表示为:
式中:Bv为虚拟控制器所对应的系统输入矩阵。
控制分配问题可以表示为如下约束欠定方程组优化求解问题:
步骤1、计算期望力矩v
假设飞控系统的虚拟控制器已知,即系统的虚拟控制信号v已知。
步骤2、计算最大可达力矩
将控制分配问题转换为直接分配法形式:
其中:ρ为实数,u1∈Rm为一向量。且若ρ>1,则令u=u1/ρ,否则令u=u1。
通过使用直接分配法求解控制分配问题能够得到在期望力矩方向上的最大可达力矩由vmax=Buu。
步骤3、伪逆法计算伪逆解
将控制分配问题以最优化方式描述,并忽略操纵量物理约束可得:
步骤4、判断伪逆解是否饱和
判断步骤3中所得的伪逆解是否位于操纵舵面物理约束之内,若伪逆解满足操纵舵面物理约束则输出操纵面偏转指令。
步骤5、零空间修正伪逆解初始化
给定系统的控制效率矩阵Bu,最大可达力矩vmax,以及作动器位置上下界约束umax及umin,并将计步器ST值置为1。
步骤6、判断是否达到最大迭代次数若未达到最大迭代次数则继续下列步骤,否则对所得操纵面偏转指令用缩放法处理后直接输出操纵面偏转指令。
当期望力矩可达,且步骤3所得伪逆解超出操纵机构物理约束时,可以通过引入修正向量un来对伪逆解进行修正,使得修正后的解既满足控制分配描述中的等式约束,还满足操纵面的物理约束,即:
u*=up-un
同时,为使得修正后所得解满足等式约束,还应满足:
v=Buu=Bu(up-un)=Buup-Buun
即Buun=0,亦即un在Bu的零空间内,则上式还可以表述为:
v=BuPv-BuNvf
式中N为矩阵Bu零空间中的一组基;vf∈Rm-n为一自由向量。
假设up中部分元素ups需要调整到期望位置ua,其中下标s表示选定的元素,则有:
式中:Δ=ups-ua。
则只需要确定自由向量vf或向量Δ,即可使用零空间修正向量使得伪逆解满足操纵量物理约束。
通过下式将伪逆解标准化:
式中:u′psi=upsi-Gsi,u′ai=uai-Gsi,下标中si表示s中第i个元素的值,该值为up中某元素的下标,upsi表示up中下标为si所对应的元素,H(si,si)表示矩阵H中第si行、si列所对应的元素。
则可知:
PAN算法使期望修正的元素与目标元素在修正后其标准化形式依然相等,即:
为保证算法调节的有效性并弥补因忽略变号情况导致的自由度损失,定义:
步骤9、计算修正后的操纵面偏转指令
修正后的操纵面偏转指令:
步骤10、判断操纵面偏转指令是否满足物理约束
若操纵面偏转指令满足物理约束则输出控制分配结果u=u*,否则令up=u*,ST=ST+1并回到步骤6继续执行。
实施例仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明保护范围之内。
Claims (3)
1.一种基于直接分配法和零空间的飞行器控制分配方法,其特征在于,包括以下步骤:
(1)获取系统实时的期望力矩v;
(2)采用直接分配法求解控制分配问题,得到期望力矩方向上的最大可达力矩vmax;
将控制分配问题转换为直接分配法形式:
其中,J为目标函数,ρ为实数,u∈Rm为操纵面偏转指令,umax和umin分别为操作面偏转指令的上、下界,Bu为系统控制效率矩阵,u1∈Rm为一向量,若ρ>1,则令u=u1/ρ,否则令u=u1;
通过使用直接分配法求解控制分配问题得到在期望力矩方向上的最大可达力矩vmax=Buu;
(3)采用伪逆法计算出最大可达力矩所对应的操作面偏转指令的伪逆解up;
将控制分配问题以最优化方式描述,并忽略操纵面物理约束,得:
(4)判断伪逆解up是否超出操纵面物理约束,若未超出则直接输出伪逆解up为最终的控制分配结果;否则采用零空间修正伪逆解up,进入步骤(5);
(5)对零空间修正伪逆解进行初始化;
给定系统控制效率矩阵Bu、最大可达力矩vmax、操作面偏转指令的上、下界umax和umin以及迭代计步器ST=1;
定义偏置向量对角矩阵其中,ui为u中的第i个元素,umini和umaxi分别为umin和umax中的第i个元素,li=umaxi-umini,i=1,…,m,m为u中元素个数,m个偏置向量Gi组成矩阵G,m个对角矩阵H(i,i)组成矩阵H;
(6)判断零空间修正伪逆解的迭代次数是否达到设置的最大迭代次数,若未达到则进入步骤(7);否则对当前的操作面偏转指令进行缩放处理后输出为最终的控制分配结果;
用下式对伪逆解进行标准化:
(8)确定零空间修正的最小调整步长;
(9)根据最小调整步长计算修正后的操作面偏转指令u*;
(10)判断修正后的操作面偏转指令u是否超出操纵面物理约束,若未超出则直接输出u*为最终的控制分配结果;否则将u*赋值给up并返回步骤(6)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910302183.5A CN109976368B (zh) | 2019-04-16 | 2019-04-16 | 一种基于直接分配法和零空间的飞行器控制分配方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910302183.5A CN109976368B (zh) | 2019-04-16 | 2019-04-16 | 一种基于直接分配法和零空间的飞行器控制分配方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109976368A CN109976368A (zh) | 2019-07-05 |
CN109976368B true CN109976368B (zh) | 2020-07-07 |
Family
ID=67084724
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910302183.5A Active CN109976368B (zh) | 2019-04-16 | 2019-04-16 | 一种基于直接分配法和零空间的飞行器控制分配方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109976368B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111158340B (zh) * | 2019-12-31 | 2022-01-18 | 山东交通学院 | 效率矩阵列向量成比例下过驱动系统控制可达集确定方法 |
CN111045420B (zh) * | 2019-12-31 | 2022-01-18 | 山东交通学院 | 一对线性约束控制分量下过驱动系统控制可达集确定方法 |
CN111158391A (zh) * | 2019-12-31 | 2020-05-15 | 航天时代飞鸿技术有限公司 | 一种基于离散系统直接控制分配的舵面控制方法 |
CN111240212B (zh) * | 2020-03-25 | 2021-05-04 | 北京航空航天大学 | 一种基于优化预测的倾转旋翼无人机控制分配方法 |
CN112198817B (zh) * | 2020-09-23 | 2022-07-12 | 峰飞航空科技(昆山)有限公司 | 无人机控制方法、装置、设备、无人机和介质 |
CN112894818B (zh) * | 2021-01-28 | 2022-08-05 | 西安交通大学 | 一种移动操作机器人的零空间运动分配方法 |
CN112817338B (zh) * | 2021-04-16 | 2021-07-09 | 北京三快在线科技有限公司 | 无人机的控制方法、装置、存储介质及电子设备 |
CN117608198A (zh) * | 2023-12-22 | 2024-02-27 | 广东智能无人系统研究院(南沙) | 一种推进器的加权伪逆推力分配方法、系统、装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104238565A (zh) * | 2014-09-30 | 2014-12-24 | 清华大学 | 一种应用于容错飞行控制系统的鲁棒控制分配方法 |
CN104932261A (zh) * | 2015-05-26 | 2015-09-23 | 南京航空航天大学 | 姿轨一体卫星的推力分配方法 |
CN108919827A (zh) * | 2018-06-27 | 2018-11-30 | 中国科学院数学与系统科学研究院 | 一种推力矢量飞行器控制的双次优化快速分配方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103869700B (zh) * | 2014-02-21 | 2017-02-22 | 南京航空航天大学 | 卫星执行机构在线重构的半物理平台以及控制方法 |
-
2019
- 2019-04-16 CN CN201910302183.5A patent/CN109976368B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104238565A (zh) * | 2014-09-30 | 2014-12-24 | 清华大学 | 一种应用于容错飞行控制系统的鲁棒控制分配方法 |
CN104932261A (zh) * | 2015-05-26 | 2015-09-23 | 南京航空航天大学 | 姿轨一体卫星的推力分配方法 |
CN108919827A (zh) * | 2018-06-27 | 2018-11-30 | 中国科学院数学与系统科学研究院 | 一种推力矢量飞行器控制的双次优化快速分配方法 |
Non-Patent Citations (6)
Title |
---|
Adaptive Fault-Tolerant Spacecraft Pose Tracking With Control Allocation;Haichao Gui 等;《IEEE Transactions on Control Systems Technology》;IEEE;20190331;第27卷(第2期);第479-494页 * |
北京航空航天大学,2011,第32卷(第7期),第1262-1263页. * |
基于零空间的改进直接分配法;徐明兴等;《航空计算技术》;中国航空工业第六三一研究所;20140131;第44卷(第1期);第28页 * |
执行机构故障的航天器姿态容错与控制分配;李波;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;中国学术期刊(光盘版)电子杂志社;20180115(第1期);第1-139页 * |
过驱动航天器推力器动态分配方法;陈寅昕;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;中国学术期刊(光盘版)电子杂志社;20110515(第5期);第1-69页 * |
过驱动轮控卫星的动态控制分配方法;张世杰等;《航空学报》;中国航空学会;北京航空航天大学;20110725;第32卷(第7期);第1262-1263页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109976368A (zh) | 2019-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109976368B (zh) | 一种基于直接分配法和零空间的飞行器控制分配方法 | |
CN108919827B (zh) | 一种推力矢量飞行器控制的双次优化快速分配方法 | |
Wu et al. | Adaptive terminal sliding mode control for hypersonic flight vehicles with strictly lower convex function based nonlinear disturbance observer | |
Ding et al. | Robust fixed-time sliding mode controller for flexible air-breathing hypersonic vehicle | |
Yao et al. | Stability analysis of random nonlinear systems with time-varying delay and its application | |
CN107765549A (zh) | 一种批次工业过程的新型迭代学习控制方法 | |
CN111123871B (zh) | 针对化工过程遗传算法优化的预测函数控制方法 | |
CN111486009A (zh) | 一种基于深强化学习的航空发动机控制方法、装置 | |
CN107643688B (zh) | 一种针对固体微推力器阵列的两步控制分配方法 | |
CN111045447B (zh) | 高精度的高超声速飞行器轨迹优化多尺度最优控制系统 | |
CN114296342B (zh) | 一种分布式动态事件触发多智能体系统的一致性控制方法 | |
CN103454921B (zh) | 飞行控制系统非线性跟踪控制器设计的正切线性化方法 | |
CN105700357B (zh) | 基于多变量pid-pfc的锅炉燃烧系统控制方法 | |
CN110399697A (zh) | 基于改进遗传学习粒子群算法的飞行器的控制分配方法 | |
CN112925203A (zh) | 一种基于加强学习的最优跟踪控制算法 | |
CN112231835A (zh) | 综合推力性能和偏转效率的矢量喷管出口面积优化方法 | |
CN102902201B (zh) | 一种化工多变量过程的解耦状态空间预测控制方法 | |
CN112859602A (zh) | 一种非最小相位系统输出重定义方法 | |
CN107179685B (zh) | 一种适用于多变量模型预测控制的分程控制实现方法 | |
CN110597055B (zh) | 抗不确定性的2d分段仿射间歇过程最小-最大优化的预测控制方法 | |
CN112394640A (zh) | 参数整定方法、装置、存储介质及参数整定单元 | |
CN114185276B (zh) | 一种基于多维泰勒网的非线性严格系统输出反馈控制方法 | |
CN110231822A (zh) | 一种舰船用变输出约束式无模型自适应航向控制方法 | |
CN113885325B (zh) | 基于阶跃响应的一阶惯性加纯延迟环节闭环辨识方法 | |
CN106647270B (zh) | 针对空间密频结构的稳定自适应模糊主动振动控制方法 |
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 |