CN102320378A - 多操纵面飞机的一种均衡操纵分配方法 - Google Patents

多操纵面飞机的一种均衡操纵分配方法 Download PDF

Info

Publication number
CN102320378A
CN102320378A CN201110165732A CN201110165732A CN102320378A CN 102320378 A CN102320378 A CN 102320378A CN 201110165732 A CN201110165732 A CN 201110165732A CN 201110165732 A CN201110165732 A CN 201110165732A CN 102320378 A CN102320378 A CN 102320378A
Authority
CN
China
Prior art keywords
msub
mover
msubsup
mrow
mtd
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
Application number
CN201110165732A
Other languages
English (en)
Other versions
CN102320378B (zh
Inventor
刘智
王勇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN 201110165732 priority Critical patent/CN102320378B/zh
Publication of CN102320378A publication Critical patent/CN102320378A/zh
Application granted granted Critical
Publication of CN102320378B publication Critical patent/CN102320378B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Feedback Control In General (AREA)

Abstract

本发明提出的多操纵面飞机的一种均衡操纵分配方法,主要包括:将多操纵面的控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题、确定对真实操纵面进行标陈化及控制效率均衡分配的基本方法、将真实操纵面分类、进行标陈化并按照标陈化控制效率的绝对值排序、确定虚拟操纵面的主导控制效率、将标陈化操纵面分级、计算分配系数等几个步骤。本发明将多操纵面的控制等效为特定控制效率及偏转范围限制的虚拟操纵面的控制,简化了控制律设计,避免了操纵面角速率超限的问题,加权均衡分配矩阵计算简便,综合考虑了操纵面的偏转范围、控制效率、控制级别、权限系数,充分利用了有效操纵面,有效避免了某些操纵面负担过多的控制效率而引起的饱和。

Description

多操纵面飞机的一种均衡操纵分配方法
技术领域
本发明属于飞行控制领域,具体涉及多操纵面飞机的一种均衡操纵分配方法。
背景技术
传统的飞机往往采用副翼产生滚转运动,方向舵产生偏航运动,升降舵产生俯仰运动。为了提高机动性能及可靠性,当今的飞机往往采用多操纵面布局。例如,美国先进战斗机YF-22有12个独立的操纵面(平尾、副翼、方向舵、襟副翼、前缘襟翼、俯仰推力矢量各两个操纵面)。由于产生滚转、偏航及俯仰力矩的操纵面不唯一,多操纵面布局提高了飞机操纵的灵活性及飞机的控制余度,从而增强了飞行的控制性能及安全性能。
多操纵面的冗余及不同操纵面间的耦合给飞行员的驾驶和飞机自动驾驶仪的控制律设计带来很大的难度,需要设计一种分配方法将控制指令分配到各个操纵面。当前许多操纵面的控制分配方法是将多操纵面的控制分配问题归结为等效期望力矩的概念,即在操纵面的偏转范围及角速率限制下,根据控制效率矩阵来求解所有操纵面的偏转角,使得操纵面在该偏转角下产生的力矩等于期望力矩。工程上对于多操纵面的控制分配往往采用串接链式分配方法,该方法是将操纵面进行分组,不同组的操纵面对应不同的优先级,优先级高的操纵面首先分担期望力矩,当该组中某些操纵面的偏转角达到门限值时依次启用下一优先级的操纵面。串接链式分配方法物理概念清晰,但是对于操纵面的分组及优先级的划分往往只是根据工程经验或者控制效率矩阵给出,由于不同操纵面的偏转范围不同,控制效率矩阵不能体现操纵面的饱和度,优先级高的操纵面往往导致较大的偏转甚至饱和,且没有充分利用优先级低的操纵面。加权伪逆方法基于操纵面的偏转范围及转动角速率限制设计加权矩阵,采用伪逆的方法由期望力矩解算所有操纵面的偏转角。加权矩阵选取要求设计者有比较丰富的经验,某些参数可能需要试凑与调整,增加了设计的复杂性。线性规划、直接几何分配及二次规划的方法是根据操纵面的偏转范围、角速率限制及期望力矩建立指标函数,利用寻优的方法通过复杂的计算得到满足期望指标的所有操纵面的偏转角。这些方法数学性强,实时性难以保证,物理概念不够清晰,在实际工程应用中应用有一定的限制。
可见,当前许多控制分配的方法是根据控制效率矩阵由期望力矩求解所有操纵面的偏转角,计算量大,需要考虑可能出现的偏转角速率超限的情况,驾驶员的驾驶指令或者飞机自动驾驶仪的控制指令需要转换成期望力矩指令,增加了控制律设计的复杂性,工程应用受到限制。
发明内容
针对现有技术中存在的问题,本发明提出多操纵面飞机的一种均衡操纵分配方法,从工程应用出发,将多操纵面的控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题,确定标称化操纵面及控制效率均衡分配的基本方法。根据操纵面的滚转、偏航、俯仰控制效率的大小,将真实操纵面划分为滚转操纵面、偏航操纵面与俯仰操纵面。分别对于滚转操纵面、偏航操纵面、俯仰操纵面进行标称化,并根据标称化控制效率设计虚拟操纵面的主导的控制效率,且将陈化操纵面划分为主、副、辅三级,根据设定的主、副权限系数确定主、副、辅各级中每个标称化操纵面期望分担的主导控制效率,进而求解虚拟操纵面向真实操纵面的分配系数,建立加权均衡分配矩阵,并得到虚拟操纵面矢量的非主导控制效率。本发明的加权均衡分配矩阵计算简便,综合考虑了操纵面的偏转范围、控制效率、控制级别、权限系数,充分利用了有效操纵面,有效避免了某些操纵面负担过多的控制效率而引起的饱和。
本发明提出的多操纵面飞机的一种均衡操纵分配方法,具体包括以下几个步骤:
步骤一:将多操纵面的控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题:
飞机的n个真实操纵面组成真实操纵面矢量U=[u1 u2 …ui …un-1 un]′,其中ui表示第i个真实操纵面,真实操纵面偏转角矢量为δ=[δ1 δ2 …δi …δn-1 δn]′,其中δi表示第i个真实操纵面的偏转角,且控制效率矩阵为 B = B ω δ 1 B ω δ 2 . . . B ω δ i . . . B ω δ n - 1 B ω δ n , 其中,
Figure BDA0000069552490000022
(i=1,2,…,n-1,n)表示第i个真实操纵面ui的控制效率矢量,且 B ω δ i = B ω x δ i B ω y δ i B ω z δ i ′ ,
Figure BDA0000069552490000024
分别表示第i个真实操纵面ui的滚转控制效率、偏航控制效率、俯仰控制效率,且第i个真实操纵面ui(i=1,2,…,n-1,n)的偏转角δi的偏转范围为[-Ri,Ri],角速率
Figure BDA0000069552490000025
限制为[-ρi,ρi];
建立虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z ′ , 其中,
Figure BDA0000069552490000027
表示虚拟副翼,虚拟副翼偏转范围为[-Rk Rk];
Figure BDA0000069552490000028
表示虚拟方向舵,虚拟方向舵偏转范围为[-Rl Rl];表示虚拟升降舵,虚拟升降舵偏转范围为[-Rm Rm];虚拟操纵面偏转角矢量 δ ~ = δ ~ x δ ~ y δ ~ z ′ , 其中
Figure BDA00000695524900000211
分别表示虚拟副翼偏转角、虚拟方向舵偏转角、虚拟升降舵偏转角;虚拟操纵面矢量的控制效率矩阵为:
B ~ = B ω x δ ~ x B ω x δ ~ y B ω x δ ~ z B ω y δ ~ x B ω y δ ~ y B ω y δ ~ z B ω z δ ~ x B ω z δ ~ y B ω z δ ~ z
其中,
Figure BDA00000695524900000213
为虚拟副翼的滚转控制效率,
Figure BDA00000695524900000214
为虚拟副翼的偏航控制效率,
Figure BDA00000695524900000215
为虚拟副翼的俯仰控制效率,
Figure BDA00000695524900000216
为虚拟方向舵的滚转控制效率,
Figure BDA00000695524900000217
为虚拟方向舵的偏航控制效率,
Figure BDA00000695524900000218
为虚拟方向舵的俯仰控制效率,
Figure BDA00000695524900000219
为虚拟升降舵的滚转控制效率,
Figure BDA00000695524900000220
为虚拟升降舵的偏航控制效率,
Figure BDA00000695524900000221
为虚拟升降舵的俯仰控制效率;
真实操纵面的偏转角矢量δ与虚拟操纵面偏转角矢量
Figure BDA0000069552490000031
满足关系
Figure BDA0000069552490000032
K为加权均衡分配矩阵,且虚拟操纵面矢量控制的效率矩阵满足
Figure BDA0000069552490000033
控制器根据驾驶员的驾驶指令或自动驾驶仪期望的轨迹、姿态指令Cmd及飞机当前状态矢量X计算虚拟操纵面偏转角矢量 δ ~ = δ ~ x δ ~ y δ ~ z ′ ; 根据加权均衡矩阵K计算真实操纵面偏转角矢量
Figure BDA0000069552490000035
真实操纵面偏转角矢量根据真实操纵面矢量的控制效率矩阵B,计算得到期望的力矩矢量
Figure BDA0000069552490000036
其中 V ‾ = v ‾ x v ‾ y v ‾ z ′ ; 虚拟操纵面矢量
Figure BDA0000069552490000038
根据虚拟操纵面矢量的控制效率矩阵
Figure BDA0000069552490000039
计算得到力矩矢量为
虚拟操纵面矢量产生与真实操纵面矢量相同的力矩矢量 V ‾ = v ‾ x v ‾ y v ‾ z ′ ; 其中
Figure BDA00000695524900000312
分别表示期望的滚转力矩、期望的偏航力矩、期望的俯仰力矩;
步骤二:确定对真实操纵面进行标称化及控制效率加权均衡分配的基本方法:
定义真实操纵面ui(i=1,2,…,n-1,n)的偏转角δi时对应的真实操纵面的饱和度Si为Si=fabs(δi/Ri),其中函数fabs(x)表示小数x的绝对值;
将控制效率矢量为
Figure BDA00000695524900000314
偏转范围为[-Ri Ri]的真实操纵面ui(i=1,2,…,n-1,n)对于偏转范围[-Rj Rj]进行标称化,得到标称化滚转控制效率的绝对值、标称化偏航控制效率的绝对值、标称化俯仰控制效率的绝对值分别为
Figure BDA00000695524900000315
Figure BDA00000695524900000316
其中函数fabs(x)表示小数x的绝对值;
设n个真实操纵面中有m个真实操纵面
Figure BDA00000695524900000317
是属于A转动方向的操纵面,其中tj∈[1,2,…,n-1,n],且
Figure BDA00000695524900000318
真实操纵面
Figure BDA00000695524900000319
(j=1,2,…,m-1,m)偏转角
Figure BDA00000695524900000320
偏转范围分别为 - R t j R t j , 控制效率矢量为
Figure BDA00000695524900000322
且在A转动方向的控制效率为
Figure BDA00000695524900000323
设某虚拟操纵面
Figure BDA00000695524900000324
与m个真实操纵面在A转动方向的控制等效,虚拟操纵面的偏转角为
Figure BDA00000695524900000325
虚拟操纵面在A转动方向的控制效率为
Figure BDA00000695524900000326
偏转角的偏转范围为[-Rh Rh];真实操纵面
Figure BDA00000695524900000327
(j=1,2,…,m-1,m)对于偏转范围[-Rh Rh]进行标称化,标称化操纵面
Figure BDA00000695524900000328
的标称化控制效率矢量:
B &omega; &delta; &OverBar; t j = B &omega; &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - B &omega; &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
在A转动方向的标称化控制效率:
B &omega; A &delta; &OverBar; t j = B &omega; A &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - B &omega; A &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
标称化偏转角:
&delta; &OverBar; t j = &delta; t j R h / R t j B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - &delta; t j R h / R t j B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1, 2,…,m-1,m)
控制效率均衡分配是将真实操纵面
Figure BDA00000695524900000332
(j=1,2,…,m-1,m)对于偏转范围[-Rh Rh]进行标称化得到标称化操纵面
Figure BDA0000069552490000041
对应标称化控制效率为
Figure BDA0000069552490000042
标称化操纵面
Figure BDA0000069552490000043
(j=1,2,…,m-1,m)在A转动方向期望分担的控制效率:
B &OverBar; &omega; A &delta; &OverBar; t j = B &omega; A &delta; &OverBar; t j &Sigma; i = 1 m B &omega; A &delta; &OverBar; t i B &omega; A &delta; &OverBar; h , (j=1,2…,m-1,m)
得到控制效率均衡分配下虚拟操纵面
Figure BDA0000069552490000045
的偏转角
Figure BDA0000069552490000046
到真实操纵面
Figure BDA0000069552490000047
(j=1,2,…,m-1,m)的偏转角的分配系数:
k t j = B &OverBar; &omega; A &delta; &OverBar; t j B &omega; A &delta; &OverBar; t j R t j R h = B &OverBar; &omega; A &delta; &OverBar; t j B &omega; A &delta; t j , (j=1,2,…,m-1,m)
步骤三:根据真实操纵面的滚转、偏航及俯仰控制效率的大小,将所有真实操纵面划分为滚转操纵面、偏航操纵面与俯仰操纵面:
若真实操纵面ui(i=1,2,…,n-1,n)满足滚转控制效率
Figure BDA00000695524900000410
大于偏航控制效率
Figure BDA00000695524900000411
及俯仰控制效率
Figure BDA00000695524900000412
则将其划分为滚转操纵面,其主导控制效率为滚转控制效率,该真实操纵面与虚拟副翼相对应;
若真实操纵面ui(i=1,2,…,n-1,n)满足偏航控制效率大于滚转控制效率
Figure BDA00000695524900000414
及俯仰控制效率
Figure BDA00000695524900000415
则将其划分为偏航操纵面,其主导控制效率为偏航控制效率,该真实操纵面与虚拟方向舵相对应;
若真实操纵面ui(i=1,2,…,n-1,n)满足俯仰控制效率大于滚转控制效率
Figure BDA00000695524900000417
及偏航控制效率
Figure BDA00000695524900000418
则将其划分为俯仰操纵面,其主导控制效率为俯仰控制效率,该真实操纵面与虚拟升降舵相对应;
滚转操纵面的数目计为n1,偏航操纵面的数目计为n2,俯仰操纵面的数目计为n3,n1+n2+n3=n;
步骤四:分别将滚转操纵面、偏航操纵面、俯仰操纵面对于所对应的虚拟操纵面的偏转范围进行标称化,并按照标称化控制效率的绝对值排序:
确定虚拟副翼的滚转控制效率与所有滚转操纵面中标称化滚转控制效率的绝对值最大的操纵面的滚转控制效率同号。将所有滚转操纵面对于虚拟副翼的偏转范围[-Rk Rk]进行标称化,并按照标称化滚转控制效率由大到小排序,排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面为
Figure BDA00000695524900000419
(pj∈[1,2,…,n-1,n]),其标称化控制效率矢量为:
B &omega; &delta; &OverBar; p j = B &omega; &delta; p j R p j / R k B &omega; x &delta; p j B &omega; x &delta; ~ x &GreaterEqual; 0 - B &omega; &delta; p j R p j / R k B &omega; x &delta; p j B &omega; x &delta; ~ x < 0 , (j=1,2,…,n1-1,n1)
Figure BDA00000695524900000422
分别表示标称化之前的滚转操纵面
Figure BDA00000695524900000423
的控制效率矢量及滚转控制效率,表示虚拟副翼的滚转控制效率,滚转操纵面的偏转范围为 - R p j R p j . B &omega; &delta; &OverBar; p j = B &omega; x &delta; &OverBar; p j B &omega; y &delta; &OverBar; p j B &omega; z &delta; &OverBar; p j &prime; ,
Figure BDA00000695524900000428
分别表示标称化滚转操纵面的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化滚转操纵面矢量 U &OverBar; P = u &OverBar; p 1 u &OverBar; p 2 . . . u &OverBar; p j . . . u &OverBar; p n 1 - 1 u &OverBar; p n 1 &prime; , 其中(pj∈[1,2,…,n-1,n])表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面,标称化滚转操纵面矢量的控制效率矩阵 B &omega; &delta; &OverBar; P = B &omega; &delta; &OverBar; p 1 B &omega; &delta; &OverBar; p 2 . . . B &omega; &delta; &OverBar; p j . . . B &omega; &delta; &OverBar; p n 1 - 1 B &omega; &delta; &OverBar; p n 1 , 其中
Figure BDA0000069552490000054
表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面
Figure BDA0000069552490000055
(pj∈[1,2,…,n-1,n])的标称化控制效率矢量;
确定虚拟方向舵的偏航控制效率与所有偏航操纵面中标称化偏航控制效率的绝对值最大的操纵面的偏航控制效率同号。将所有偏航操纵面对于虚拟方向舵的偏转范围[-Rl Rl]进行标称化,并按照标称化偏航控制效率的绝对值由大到小排序,排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面为
Figure BDA0000069552490000056
(qj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure BDA0000069552490000057
为:
B &omega; &delta; &OverBar; q j = B &omega; &delta; q j R q j / R l B &omega; y &delta; q j B &omega; y &delta; ~ y &GreaterEqual; 0 - B &omega; &delta; q j R q j / R l B &omega; y &delta; q j B &omega; y &delta; ~ y < 0 , (j=1,2,…,n2-1,n2)
Figure BDA0000069552490000059
分别表示标称化之前的偏航操纵面的控制效率矢量及偏航控制效率,
Figure BDA00000695524900000511
表示虚拟方向舵的偏航控制效率,偏航操纵面
Figure BDA00000695524900000512
的偏转范围为 - R q j R q j . B &omega; &delta; &OverBar; q j = B &omega; x &delta; &OverBar; q j B &omega; y &delta; &OverBar; q j B &omega; z &delta; &OverBar; q j &prime; ,
Figure BDA00000695524900000515
分别表示标称化偏航操纵面
Figure BDA00000695524900000516
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化偏航操纵面矢量 U &OverBar; Q = u &OverBar; q 1 u &OverBar; q 2 . . . u &OverBar; q j . . . u &OverBar; q n 2 - 1 u &OverBar; q n 2 &prime; , 其中
Figure BDA00000695524900000518
(qj∈[1,2,…,n-1,n])表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面,标称化偏航操纵面矢量的控制效率矩阵 B &omega; &delta; &OverBar; Q = B &omega; &delta; &OverBar; q 1 B &omega; &delta; &OverBar; q 2 . . . B &omega; &delta; &OverBar; q j . . . B &omega; &delta; &OverBar; q n 2 - 1 B &omega; &delta; &OverBar; q n 2 , 其中
Figure BDA00000695524900000520
表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,…n2-1,n2)个标称化偏航操纵面
Figure BDA00000695524900000521
(qj∈[1,2,…,n-1,n])的标称化控制效率矢量;
确定虚拟升降舵的俯仰控制效率与所有俯仰操纵面中标称化俯仰控制效率的绝对值最大的操纵面的俯仰控制效率同号。将所有俯仰操纵面对于虚拟升降舵的偏转范围[-Rm Rm]进行标称化,并按照标称化俯仰控制效率的绝对值由大到小排序,排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面为
Figure BDA00000695524900000522
(rj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure BDA00000695524900000523
为:
B &omega; &delta; &OverBar; r j = B &omega; &delta; r j R r j / R m B &omega; z &delta; r j B &omega; z &delta; ~ z &GreaterEqual; 0 - B &omega; &delta; r j R r j / R m B &omega; z &delta; r j B &omega; z &delta; ~ z < 0 , (j=1,2,…n3-1,n3)
Figure BDA00000695524900000525
分别表示标称化之前的俯仰操纵面的控制效率矢量及俯仰控制效率,
Figure BDA00000695524900000527
表示虚拟升降舵的俯仰控制效率,俯仰操纵面
Figure BDA00000695524900000528
的偏转范围为 - R r j R r j . B &omega; &delta; &OverBar; r j = B &omega; x &delta; &OverBar; r j B &omega; y &delta; &OverBar; r j B &omega; z &delta; &OverBar; r j &prime; ,
Figure BDA00000695524900000531
分别表示标称化俯仰操纵面的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率;则标称化俯仰操纵面矢量 U &OverBar; R = u &OverBar; r 1 u &OverBar; r 2 . . . u &OverBar; r j . . . u &OverBar; r n 3 - 1 u &OverBar; r n 3 &prime; , 其中
Figure BDA0000069552490000062
(rj∈[1,2,…,n-1,n])表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面,标称化俯仰操纵面矢量的控制效率矩阵为 B &omega; &delta; &OverBar; R = B &omega; &delta; &OverBar; r 1 B &omega; &delta; &OverBar; r 2 . . . B &omega; &delta; &OverBar; r j . . . B &omega; &delta; &OverBar; r n 3 - 1 B &omega; &delta; &OverBar; r n 3 , 其中,
Figure BDA0000069552490000064
表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面
Figure BDA0000069552490000065
(rj∈[1,2,…,n-1,n])的标称化控制效率矢量;
步骤五:确定虚拟操纵面的主导控制效率:
虚拟副翼的主导控制效率为滚转控制效率
Figure BDA0000069552490000067
Figure BDA0000069552490000068
为虚拟副翼的滚转控制效率比例系数,
Figure BDA0000069552490000069
表示标称化滚转操纵面矢量
Figure BDA00000695524900000610
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure BDA00000695524900000611
的标称化滚转控制效率;
虚拟方向舵的主导控制效率为偏航控制效率
Figure BDA00000695524900000612
Figure BDA00000695524900000613
Figure BDA00000695524900000614
为虚拟方向舵的偏航控制效率比例系数,表示标称化偏航操纵面矢量中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure BDA00000695524900000617
的标称化偏航控制效率;
虚拟升降舵的主导控制效率为俯仰控制效率
Figure BDA00000695524900000618
Figure BDA00000695524900000619
Figure BDA00000695524900000620
为虚拟升降舵的俯仰控制效率比例系数,表示标称化俯仰操纵面矢量中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面
Figure BDA00000695524900000623
的标称化俯仰控制效率;
步骤六:根据标称化控制效率将标称化操纵面划分成主、副、辅三级,设定标称化主操纵面与标称化副操纵面的权限系数,并计算主、副、辅各级标称化操纵面期望分担的主导控制效率:
(1)分别将标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的划分为主、副、辅三级:
Figure BDA00000695524900000624
表示标称化滚转操纵面矢量
Figure BDA00000695524900000625
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure BDA00000695524900000626
的标称化滚转控制效率,则确定标称化滚转主操纵面序号临界值nx1<n1,nx1是整数且满足:
&Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i &GreaterEqual; 0.5
确定标称化滚转副操纵面序号临界值nx2满足nx1<nx2≤n1,nx2是整数且满足:
&Sigma; j = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i )
将位于标称化滚转操纵面矢量
Figure BDA00000695524900000629
中前nx1个位置的操纵面划分为标称化滚转主操纵面;将位于标称化滚转操纵面矢量
Figure BDA00000695524900000630
中从(nx1+1)到nx2个位置的操纵面划分为标称化滚转副操纵面;将位于标称化滚转操纵面矢量中从(nx2+1)到n1个位置的操纵面划分为标称化滚转辅操纵面;
Figure BDA0000069552490000072
表示标称化偏航操纵面矢量
Figure BDA0000069552490000073
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面的标称化偏航控制效率,则标称化偏航主操纵面序号临界值ny1<n2,ny1是整数且满足:
&Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i &GreaterEqual; 0.5
则标称化偏航副操纵面序号临界值ny2满足ny1<ny2≤n2,ny2是整数且满足:
&Sigma; j = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i )
将位于标称化偏航操纵面矢量
Figure BDA0000069552490000077
中前ny1个位置的操纵面划分为标称化偏航主操纵面;将位于标称化偏航操纵面矢量
Figure BDA0000069552490000078
中从(ny1+1)到ny2个位置的操纵面划分为标称化偏航副操纵面;将位于标称化偏航操纵面矢量中从(ny2+1)到n2个位置的操纵面划分为标称化偏航辅操纵面;
Figure BDA00000695524900000710
表示标称化俯仰操纵面矢量
Figure BDA00000695524900000711
中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面
Figure BDA00000695524900000712
的标称化俯仰控制效率,则标称化俯仰主操纵面序号临界值nz1<n3,nz1是整数且满足:
&Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i &GreaterEqual; 0.5
则标称化俯仰副操纵面序号临界值nz2满足nz1<nz2≤n3,nz2是整数且满足:
&Sigma; j = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i )
将位于标称化俯仰操纵面矢量
Figure BDA00000695524900000715
中前nz1个位置的操纵面划分为标称化俯仰主操纵面;将位于标称化俯仰操纵面矢量
Figure BDA00000695524900000716
中从(nz1+1)到nz2个位置的操纵面划分为标称化俯仰副操纵面;将位于标称化俯仰操纵面矢量中从(nz2+1)到n3个位置的操纵面划分为标称化俯仰辅操纵面;
(2)分别对标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面设定主、副权限系数,并计算标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的主、副、辅各级标称化操纵面期望分担的主导控制效率:
按照控制效率均衡分配的方法得到所有的标称化滚转主操纵面所分担的虚拟副翼的滚转控制效率的比率Cxm为:
C xm = &Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i
所有的标称化滚转副操纵面所分担的虚拟副翼的滚转控制效率的比率Cxs为:
C xs = &Sigma; j = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i
所有的标称化滚转辅操纵面所分担的虚拟副翼的滚转控制效率的比率Cxf为:
Cxf=1-Cxm-Cxs
标称化滚转主操纵面的权限系数为Qxm及标称化滚转副操纵面的权限系数为Qxs,则所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure BDA0000069552490000083
则所有的标称化滚转副操纵面期望分担的滚转控制效率
Figure BDA0000069552490000084
所有的标称化滚转辅操纵面期望分担的滚转控制效率 B &OverBar; &omega; x &delta; &OverBar; xf = B &omega; x &delta; ~ x ( 1 - Q xm C xm - Q xs C xs ) ;
按照控制效率均衡分配的方法,得到所有的标称化偏航主操纵面所分担的虚拟方向舵的偏航控制效率的比率Cym为:
C ym = &Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i
所有的标称化偏航副操纵面所分担的虚拟方向舵的偏航控制效率的比率Cys为:
C ys = &Sigma; j = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i
所有的标称化偏航辅操纵面所分担的虚拟方向舵的偏航控制效率的比率Cyf为:
Cyf=1-Cym-Cys
标称化偏航主操纵面的权限系数为Qym及标称化偏航副操纵面的权限系数为Qys,则所有的标称化偏航主操纵面期望分担的偏航控制效率所有的标称化偏航副操纵面期望分担的偏航控制效率
Figure BDA0000069552490000089
所有的标称化偏航辅操纵面期望分担的偏航控制效率 B &OverBar; &omega; y &delta; &OverBar; yf = B &omega; y &delta; ~ y ( 1 - Q ym C ym - Q ys C ys ) ;
按照控制效率均衡分配的方法,得到所有的标称化俯仰主操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czm为:
C zm = &Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i
所有的标称化俯仰副操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czs为:
C zs = &Sigma; j = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i
所有的标称化俯仰辅操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czf为:
Czf=1-Czm-Czs
标称化俯仰主操纵面的权限系数为Qzm,标称化俯仰副操纵面的权限系数为Qzs,所有的标称化俯仰主操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000093
所有的标称化俯仰副操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000094
所有的标称化俯仰辅操纵面期望分担的俯仰控制效率 B &OverBar; &omega; z &delta; &OverBar; zf = B &omega; z &delta; ~ z ( 1 - Q zm C zm - Q zs C zs ) ;
步骤七:采用控制效率均衡分配的方法计算每个标称化操纵面期望分担的主导控制效率:
(1)计算每个标称化滚转操纵面期望分担的滚转控制效率:
采用控制效率均衡分配的方法将所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure BDA0000069552490000096
分配给每个标称化滚转主操纵面,则第j(j=1,2,…,nx1-1,nx1)个标称化滚转主操纵面期望分担的滚转控制效率
Figure BDA0000069552490000098
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xm B &omega; x &delta; &OverBar; p j &Sigma; i = 1 nx 1 B &omega; x &delta; &OverBar; p i , (j=1,2,…,nx1-1,nx1)
采用控制效率均衡分配的方法将所有的标称化滚转副操纵面期望分担的滚转控制效率分配给每个标称化滚转副操纵面,则第j(j=nx1+1,nx1+2,…,nx2-1,nx2)个标称化滚转副操纵面
Figure BDA00000695524900000911
期望分担的滚转控制效率
Figure BDA00000695524900000912
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xs B &omega; x &delta; &OverBar; p j &Sigma; i = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p i , (j=nx1+1,nx1+2,…,nx2-1,nx2)
采用控制效率均衡分配的方法将所有的标称化滚转辅操纵面期望分担的滚转控制效率
Figure BDA00000695524900000914
分配每个标称化滚转辅操纵面,则第j(j=nx2+1,nx2+2,…,n1-1,n1)个标称化滚转辅操纵面期望分担的滚转控制效率
Figure BDA00000695524900000916
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xf B &omega; x &delta; &OverBar; p j &Sigma; i = nx 2 + 1 n 1 B &omega; x &delta; &OverBar; p i , (j=nx2+1,nx2+2,…,n1-1,n1)
(2)计算每个标称化偏航操纵面期望分担的偏航控制效率:
采用控制效率均衡分配的方法将所有的标称化偏航主操纵面期望分担的偏航控制效率
Figure BDA0000069552490000101
分配给每个标称化偏航主操纵面,则第j(j=1,2,…,ny1-1,ny1)个标称化偏航主操纵面
Figure BDA0000069552490000102
期望分担的偏航控制效率
Figure BDA0000069552490000103
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; ym B &omega; y &delta; &OverBar; q j &Sigma; i = 1 ny 1 B &omega; y &delta; &OverBar; q i , (j=1,2,…,ny1-1,ny1)
采用控制效率均衡分配的方法将所有的标称化偏航副操纵面期望分担的偏航控制效率
Figure BDA0000069552490000105
分配给每个标称化偏航副操纵面,则第j(j=ny1+1,ny1+2,…,ny2-1,ny2)个标称化偏航副操纵面
Figure BDA0000069552490000106
期望分担的偏航控制效率
Figure BDA0000069552490000107
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; ys B &omega; y &delta; &OverBar; q j &Sigma; i = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q i , (j=ny1+1,ny1+2,…,ny2-1,ny2)
采用控制效率均衡分配的方法将所有的陈化偏航辅操纵面期望分担的偏航控制效率分配给每个标称化偏航辅操纵面,则第j(j=ny2+1,ny2+2,…,n2-1,n2)个标称化偏航辅操纵面
Figure BDA00000695524900001010
期望分担的偏航控制效率
Figure BDA00000695524900001011
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; yf B &omega; y &delta; &OverBar; q j &Sigma; i = ny 2 + 1 n 2 B &omega; y &delta; &OverBar; q i , (j=ny2+1,ny2+2,…,n2-1,n2)
(3)计算每个标称化俯仰操纵面期望分担的俯仰控制效率:
采用均衡分配的方法将所有的标称化俯仰主操纵面期望分担的俯仰控制效率
Figure BDA00000695524900001013
分配给每个标称化俯仰主操纵面,则第j(j=1,2,…,nz1-1,nz1)个标称化俯仰主操纵面
Figure BDA00000695524900001014
期望分担的俯仰控制效率
Figure BDA00000695524900001015
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zm B &omega; z &delta; &OverBar; r j &Sigma; i = 1 nz 1 B &omega; z &delta; &OverBar; r i , (j=1,2,…,nz1-1,nz1)
采用控制效率均衡分配的方法将所有的标称化俯仰副操纵面期望分担的俯仰控制效率
Figure BDA00000695524900001017
分配给每个标称化俯仰副操纵面,则第j(j=nz1+1,nz1+2,…,nz2-1,nz2)个标称化俯仰副操纵面
Figure BDA00000695524900001018
期望分担的俯仰控制效率
Figure BDA00000695524900001019
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zs B &omega; z &delta; &OverBar; r j &Sigma; i = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r i , (j=nz1+1,nz1+2,…,nz2-1,nz2)
采用控制效率均衡分配的方法将所有的标称化俯仰辅操纵面期望分担的俯仰控制效率分配给每个标称化俯仰辅操纵面,则第j(j=nz2+1,nz2+2,…,n3-1,n3)个标称化俯仰辅操纵面
Figure BDA0000069552490000111
期望分担的俯仰控制效率
Figure BDA0000069552490000112
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zf B &omega; z &delta; &OverBar; r j &Sigma; i = nz 2 + 1 n 3 B &omega; z &delta; &OverBar; r i , (j=nz2+1,nz2+2,…,n3-1,n3)
步骤八:计算所有真实操纵面的分配系数,建立加权均衡分配矩阵,求解虚拟操纵面矢量的控制效率矩阵中的非主导控制效率:
(1)计算所有真实操纵面的分配系数:
①计算每个滚转操纵面的分配系数:
由于第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面
Figure BDA0000069552490000114
与标称化之前的滚转操纵面
Figure BDA0000069552490000115
对应,标称化滚转操纵面
Figure BDA0000069552490000116
期望分担的滚转控制效率为
Figure BDA0000069552490000117
滚转操纵面
Figure BDA0000069552490000118
的偏转范围为
Figure BDA0000069552490000119
滚转控制效率为则虚拟副翼
Figure BDA00000695524900001111
的偏转角
Figure BDA00000695524900001112
到滚转操纵面
Figure BDA00000695524900001113
的偏转角
Figure BDA00000695524900001114
的分配系数
Figure BDA00000695524900001115
为:
k p j = B &OverBar; &omega; x &delta; &OverBar; p j B &omega; x &delta; p j , (j=1,2,…,n1-1,n1)
从而得到滚转操纵面的分配系数矢量 K ^ x = k p 1 k p 2 . . . k p j . . . k p n 1 - 1 k p n 1 &prime; , 其中
Figure BDA00000695524900001118
(j=1,2,…,n1-1,n1)表示虚拟副翼的偏转角
Figure BDA00000695524900001120
到滚转操纵面
Figure BDA00000695524900001121
的偏转角
Figure BDA00000695524900001122
的分配系数;
②计算每个偏航操纵面的分配系数:
由于第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面与标称化之前的偏航操纵面
Figure BDA00000695524900001124
对应,标称化偏航操纵面
Figure BDA00000695524900001125
期望分担的偏航控制效率为偏航操纵面
Figure BDA00000695524900001127
的偏转范围为 - R q j R q j , 偏航控制效率为
Figure BDA00000695524900001129
则虚拟方向舵
Figure BDA00000695524900001130
的偏转角
Figure BDA00000695524900001131
到偏航操纵面
Figure BDA00000695524900001132
的偏转角
Figure BDA00000695524900001133
的分配系数为:
k q j = B &OverBar; &omega; y &delta; &OverBar; q j B &omega; y &delta; q j , (j=1,2,…,n2-1,n2)
从而得到偏航操纵面的分配系数矢量 K ^ y = k q 1 k q 2 . . . k q j . . . k q n 2 - 1 k q n 2 &prime; , 其中,
Figure BDA00000695524900001136
(j=1,2,…,n2-1,n2)表示虚拟方向舵的偏转角
Figure BDA00000695524900001138
到偏航操纵面
Figure BDA00000695524900001139
的偏转角
Figure BDA00000695524900001140
的分配系数;
③计算每个俯仰操纵面的分配系数:
由于第j(j=1,2,…,n3-1,n3)个标称化俯仰操纵面与标称化之前的俯仰操纵面
Figure BDA00000695524900001142
对应,标称化俯仰操纵面
Figure BDA00000695524900001143
期望分担的俯仰控制效率为
Figure BDA00000695524900001144
俯仰操纵面
Figure BDA00000695524900001145
的偏转范围为 - R r j R r j , 俯仰控制效率为
Figure BDA00000695524900001147
则虚拟升降舵的偏转角
Figure BDA00000695524900001149
到俯仰操纵面
Figure BDA00000695524900001150
的偏转角
Figure BDA00000695524900001151
的分配系数为:
k r j = B &OverBar; &omega; z &delta; &OverBar; r j B &omega; z &delta; r j , (j=1,2,…,n3-1,n3)
从而得到俯仰操纵面的分配系数矢量 K ^ z = k r 1 k r 2 . . . k r j . . . k r n 3 - 1 k r n 3 &prime; , 其中
Figure BDA0000069552490000123
(j=1,2,…,n3-1,n3)表示虚拟升降舵
Figure BDA0000069552490000124
的偏转角
Figure BDA0000069552490000125
到俯仰操纵面
Figure BDA0000069552490000126
的偏转角的分配系数;
(2)建立加权均衡分配矩阵,求解虚拟操纵面矢量的控制效率矩阵中的非主导控制效率,从而确定虚拟操纵面矢量的控制效率矩阵:
①虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵:
建立过渡操纵面矢量 U ^ = u p 1 . . . u p i . . . u p n 1 u q 1 . . . u q j . . . u q n 2 u r 1 . . . u r t . . . u r n 3 &prime; , 过渡操纵面的偏转角矢量 &delta; ^ = &delta; p 1 . . . &delta; p i . . . &delta; p n 1 &delta; q 1 . . . &delta; q j . . . &delta; q n 2 &delta; r 1 . . . &delta; r t . . . &delta; r n 3 &prime; , 过渡操纵面矢量的控制效率矩阵
B ^ = B &omega; &delta; p 1 . . . B &omega; &delta; p i . . . B &omega; &delta; p n 1 B &omega; &delta; q 1 . . . B &omega; &delta; q j . . . B &omega; &delta; q n 2 B &omega; &delta; r 1 . . . B &omega; &delta; r t . . . B &omega; &delta; r n 3
其中,(i=1,2,…,n1-1,n1)分别表示滚转操纵面的偏转角及控制效率矢量,
Figure BDA00000695524900001213
(j=1,2,…,n2-1,n2)分别表示偏航操纵面
Figure BDA00000695524900001214
的偏转角及控制效率矢量,
Figure BDA00000695524900001215
(t=1,2,…,n3-1,n3)分别表示滚转操纵面
Figure BDA00000695524900001216
的偏转角及控制效率矢量,虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z &prime; 对应的虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; , 虚拟操纵面矢量的控制效率矩阵 B ~ = B &omega; &delta; ~ x B &omega; &delta; ~ y B &omega; &delta; ~ z &prime; , 其中,
Figure BDA00000695524900001220
表示虚拟副翼的偏转角及控制效率矢量,
Figure BDA00000695524900001221
Figure BDA00000695524900001222
表示虚拟方向舵的偏转角及控制效率矢量,
Figure BDA00000695524900001223
分别表示虚拟升降舵的偏转角及控制效率矢量;则虚拟操纵面偏转角矢量到过渡操纵面偏转角矢量的传递关系为
Figure BDA00000695524900001224
其中,表示虚拟操纵面矢量到过渡操纵面矢量的加权均衡分配矩阵:
K ^ = K ^ x 0 n 1 &times; 1 0 n 1 &times; 1 0 n 2 &times; 1 K ^ y 0 n 2 &times; 1 0 n 3 &times; 1 0 n 3 &times; 1 K ^ z
其中,
Figure BDA00000695524900001227
表示n1行1列的全零向量,表示n2行1列的全零向量,
Figure BDA00000695524900001229
表示n3行1列的全零向量;
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure BDA00000695524900001230
真实操纵面矢量U=[u1 u2 …ui …un-1 un]′;
对应的真实操纵面的偏转角矢量δ=[δ1 δ2 …δi…δn-1 δn]′,真实操纵面的控制效率矩阵 B = B &omega; &delta; 1 B &omega; &delta; 2 . . . B &omega; &delta; i . . . B &omega; &delta; n - 1 B &omega; &delta; n &prime; , 其中δi
Figure BDA00000695524900001232
分别表示真实操纵面ui的偏转角、控制效率矢量,过渡操纵面矢量
Figure BDA00000695524900001233
的偏转角矢量
Figure BDA00000695524900001234
通过n行n列的转换矩阵T转化为真实操纵面矢量U的偏转角矢量δ,即
Figure BDA00000695524900001235
且过渡操纵面矢量控制效率矩阵
Figure BDA00000695524900001236
转换矩阵T的第a行b列表示为T(a,b),对于所有的j=1,2,…,n1-1,n1,T(pj,j)=1;对于所有的j=1,2,…,n2-1,n2,T(qj,j+n1)=1;对于所有的j=1,2,…,n3-1,n3,T(rj,j+n1+n2)=1;矩阵T的所有其他元素都为0;
由于
Figure BDA0000069552490000131
从而得到真实操纵面偏转角矢量
Figure BDA0000069552490000132
虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure BDA0000069552490000134
过渡操纵面矢量控制效率矩阵与真实操纵面的控制效率矩阵满足
Figure BDA0000069552490000135
虚拟操纵面控制效率矩阵
Figure BDA0000069552490000136
与真实操纵面的控制效率矩阵B满足
Figure BDA0000069552490000137
②由加权均衡分配矩阵计算虚拟操纵面的非主导控制效率,得到虚拟操纵面矢量的控制效率矩阵;
虚拟操纵面的控制效率矩阵
Figure BDA0000069552490000138
与过渡操纵面控制效率矩阵满足
Figure BDA00000695524900001310
其中过渡操纵面矢量的控制效率矩阵为:
B ^ = B &omega; x &delta; p 1 . . . B &omega; x &delta; p i . . . B &omega; x &delta; p n 1 B &omega; x &delta; q 1 . . . B &omega; x &delta; q j . . . B &omega; x &delta; q n 2 B &omega; x &delta; r 1 . . . B &omega; x &delta; r t . . . B &omega; x &delta; r n 3 B &omega; y &delta; p 1 . . . B &omega; y &delta; p i . . . B &omega; y &delta; p n 1 B &omega; y &delta; q 1 . . . B &omega; y &delta; q j . . . B &omega; y &delta; q n 2 B &omega; y &delta; r 1 . . . B &omega; y &delta; r t . . . B &omega; y &delta; r n 3 B &omega; z &delta; p 1 . . . B &omega; z &delta; p i . . . B &omega; z &delta; p n 1 B &omega; z &delta; q 1 . . . B &omega; z &delta; q j . . . B &omega; z &delta; q n 2 B &omega; z &delta; r 1 . . . B &omega; z &delta; r t . . . B &omega; z &delta; r n 3
其中,
Figure BDA00000695524900001312
分别表示滚转操纵面
Figure BDA00000695524900001313
(i=1,2,…,n1-1,n1)的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure BDA00000695524900001314
分别表示偏航操纵面
Figure BDA00000695524900001315
(j=1,2,…,n2-1,n2)的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure BDA00000695524900001316
分别表示俯仰操纵面
Figure BDA00000695524900001317
(t=1,2,…,n3-1,n3)的滚转控制效率、偏航控制效率及俯仰控制效率;
虚拟操纵面矢量的控制效率矩阵为:
B ~ = B &omega; x &delta; ~ x B &omega; x &delta; ~ y B &omega; x &delta; ~ z B &omega; y &delta; ~ x B &omega; y &delta; ~ y B &omega; y &delta; ~ z B &omega; z &delta; ~ x B &omega; z &delta; ~ y B &omega; z &delta; ~ z
其中,虚拟副翼的滚转控制效率
Figure BDA00000695524900001319
虚拟方向舵的偏航控制效率
Figure BDA00000695524900001320
虚拟升降舵的俯仰控制效率为主导控制效率,均由步骤五得出。进而确定虚拟操纵面的非主导控制效率:虚拟副翼的偏航控制效率
Figure BDA00000695524900001322
Figure BDA00000695524900001323
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900001324
的偏转角到滚转操纵面
Figure BDA00000695524900001326
的偏转角的分配系数;虚拟副翼的俯仰控制效率
Figure BDA00000695524900001328
Figure BDA00000695524900001329
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900001330
的偏转角
Figure BDA00000695524900001331
到滚转操纵面的偏转角的分配系数;虚拟方向舵的滚转控制效率
Figure BDA00000695524900001334
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900001336
的偏转角到偏航操纵面
Figure BDA00000695524900001338
的偏转角的分配系数;虚拟方向舵的俯仰控制效率
Figure BDA00000695524900001340
Figure BDA00000695524900001341
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900001342
的偏转角
Figure BDA00000695524900001343
到偏航操纵面
Figure BDA00000695524900001344
的偏转角
Figure BDA00000695524900001345
的分配系数;虚拟升降舵的滚转控制效率
Figure BDA00000695524900001346
Figure BDA00000695524900001347
(i=1,2,…,n3-1,n3)表示虚拟升降舵的偏转角
Figure BDA0000069552490000141
到俯仰操纵面
Figure BDA0000069552490000142
的偏转角
Figure BDA0000069552490000143
的分配系数;虚拟升降舵的偏航控制效率
Figure BDA0000069552490000144
Figure BDA0000069552490000145
(i=1,2,…,n3-1,n3)表示虚拟升降舵
Figure BDA0000069552490000146
的偏转角
Figure BDA0000069552490000147
到俯仰操纵面的偏转角
Figure BDA0000069552490000149
的分配系数。
本发明具有的优点在于:
1、本发明提出的多操纵面飞机的一种均衡操纵分配方法,从操纵面提供控制效率的物理机理出发,将多操纵面的控制等效为特定控制效率及偏转范围限制的虚拟副翼、虚拟方向舵、虚拟升降舵的控制,物理概念清晰,简化了控制律设计。
2、本发明提出的多操纵面飞机的一种均衡操纵分配方法,由控制律计算得到虚拟操纵面偏转角,并通过加权均衡分配矩阵运算得到真实操纵面的偏转角,计算简便,便于工程实现,也避免了操纵面角速率超限的问题。
3、本发明提出的多操纵面飞机的一种均衡操纵分配方法,对操纵面引入标称化的概念,将操纵面的控制效率与操纵面的饱和度联系起来,从而为控制效率的均衡分配提供指导。
4、本发明提出的多操纵面飞机的一种均衡操纵分配方法,根据标称化控制效率及所设计的主、副权限系数对于主、副、辅三级分配控制效率,综合考虑了操纵面的偏转范围、控制效率、控制级别、权限系数,并充分利用了有效操纵面。
5、本发明提出的多操纵面飞机的一种均衡操纵分配方法,采用均衡分配的方法将陈化主、副、辅操纵面期望标称化主导控制效率分配给各个标称化操纵面,防止因某些操纵面分担过多的控制效率而引起操纵面饱和。
6、本发明提出的多操纵面飞机的一种均衡操纵分配方法,加权均衡分配矩阵的计算简便,概念清晰。
附图说明
图1本发明中虚拟操纵面与真实操纵面的等效控制图;
图2本发明中真实操纵面的分类、标称化及分级过程图;
图3本发明中滚转操纵面的分配系数矢量的计算过程图。
具体实施方式
下面结合附图对本发明进一步详细说明:
本发明提出的多操纵面飞机的一种均衡操纵分配方法,具体包括以下几个步骤:
步骤一:将多操纵面的控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题。
设某飞机的n个真实操纵面组成真实操纵面矢量U=[u1 u2 …ui …un-1 un]′,其中ui表示第i个真实操纵面,真实操纵面偏转角矢量为δ=[δ1 δ2 …δi …δn-1 δn]′,其中δi表示第i个真实操纵面的偏转角,且控制效率矩阵为 B = B &omega; &delta; 1 B &omega; &delta; 2 . . . B &omega; &delta; i . . . B &omega; &delta; n - 1 B &omega; &delta; n . 其中,
Figure BDA0000069552490000151
(i=1,2,…,n-1,n)表示第i个真实操纵面ui的控制效率矢量,且 B &omega; &delta; i = B &omega; x &delta; i B &omega; y &delta; i B &omega; z &delta; i &prime; ,
Figure BDA0000069552490000153
分别表示第i个真实操纵面ui的滚转控制效率、偏航控制效率及俯仰控制效率,且第i个真实操纵面ui(i=1,2,…,n-1,n)的偏转角δi的偏转范围为[-Ri,Ri],角速率
Figure BDA0000069552490000154
限制为[-ρi,ρi]。
传统的控制分配问题往往是给出期望力矩矢量 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; , 其中
Figure BDA0000069552490000156
分别表示期望的滚转力矩、期望的偏航力矩、期望的俯仰力矩,求解真实操纵面偏转角矢量δ,使得满足并满足约束-Ri≤δi≤Ri
Figure BDA0000069552490000158
(i=1,2,…,n-1,n)。要求控制律输出期望力矩矢量指令,增加了控制律设计的复杂性,并且由期望力矩解算真实操纵面偏转角矢量往往采用复杂的优化过程,计算量大,且需要考虑可能出现的偏转角速率过大的问题。
本发明将多操纵面的控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题。建立虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z &prime; , 其中,
Figure BDA00000695524900001510
表示虚拟副翼,且虚拟副翼偏转范围为[-Rk Rk];表示虚拟方向舵,且虚拟方向舵偏转范围为[-Rl Rl];
Figure BDA00000695524900001512
表示虚拟升降舵,且虚拟升降舵偏转范围为[-Rm Rm]。虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; , 其中 分别表示虚拟副翼偏转角、虚拟方向舵偏转角、虚拟升降舵偏转角;虚拟操纵面矢量的控制效率矩阵定义为:
B ~ = B &omega; x &delta; ~ x B &omega; x &delta; ~ y B &omega; x &delta; ~ z B &omega; y &delta; ~ x B &omega; y &delta; ~ y B &omega; y &delta; ~ z B &omega; z &delta; ~ x B &omega; z &delta; ~ y B &omega; z &delta; ~ z
其中,
Figure BDA00000695524900001517
为虚拟副翼的滚转控制效率,为虚拟副翼的偏航控制效率,
Figure BDA00000695524900001519
为虚拟副翼的俯仰控制效率,
Figure BDA00000695524900001520
为虚拟方向舵的滚转控制效率,
Figure BDA00000695524900001521
为虚拟方向舵的偏航控制效率,为虚拟方向舵的俯仰控制效率,
Figure BDA00000695524900001523
为虚拟升降舵的滚转控制效率,
Figure BDA00000695524900001524
为虚拟升降舵的偏航控制效率,
Figure BDA00000695524900001525
为虚拟升降舵的俯仰控制效率。
控制分配目的是综合考虑操纵面偏转范围、控制效率、控制级别、权限系数来设计加权均衡分配矩阵K,使得真实操纵面的偏转角矢量δ与虚拟操纵面偏转角矢量
Figure BDA00000695524900001526
满足关系
Figure BDA00000695524900001527
且虚拟操纵面矢量控制的效率矩阵满足
Figure BDA00000695524900001528
图1表明了虚拟操纵面与真实操纵面等效控制的物理意义,控制器根据驾驶员的驾驶指令或者是自动驾驶仪期望的轨迹、姿态指令Cmd及飞机当前状态矢量X计算虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; . 从真实操纵面矢量U来看,根据加权均衡矩阵K计算真实操纵面偏转角矢量真实操纵面偏转角矢量根据真实操纵面矢量的控制效率矩阵B,计算得到期望的力矩矢量
Figure BDA00000695524900001531
其中 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; ,
Figure BDA00000695524900001533
分别表示期望的滚转力矩、期望的偏航力矩及期望的俯仰力矩。从虚拟操纵面矢量来看,图1中的虚线框内的加权均衡矩阵K与真实操纵面矢量的控制效率矩阵B组合成虚拟操纵面矢量的控制效率矩阵因而,虚拟操纵面矢量
Figure BDA00000695524900001536
根据虚线框的虚拟操纵面矢量的控制效率矩阵计算得到力矩矢量为
Figure BDA00000695524900001538
即虚拟操纵面矢量产生与真实操纵面矢量相同的力矩矢量 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; , 从而将控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题。
步骤二:确定对真实操纵面进行标称化及控制效率加权均衡分配的基本方法。
定义真实操纵面ui(i=1,2,…,n-1,n)的偏转角δi时对应的真实操纵面的饱和度为Si=fabs(δi/Ri)。其中,函数fabs(x)表示小数x的绝对值。真实操纵面的控制效率矢量体现了单位偏转角所产生的滚转控制效率、偏航控制效率及俯仰控制效率的大小,而不同真实操纵面的偏转范围不同,因此控制效率不能体现该真实操纵面提供控制效率所产生的饱和度,需要将真实操纵面的控制效率按照其偏转范围进行统一。
将控制效率矢量为
Figure BDA0000069552490000162
偏转范围为[-Ri Ri]的真实操纵面ui(i=1,2,…,n-1,n)对于偏转范围[-Rj  Rj]进行标称化,得到标称化滚转控制效率的绝对值、标称化偏航控制效率的绝对值、标称化俯仰控制效率的绝对值分别为
Figure BDA0000069552490000163
Figure BDA0000069552490000164
其中函数fabs(x)表示小数x的绝对值。
设n个真实操纵面中有m个真实操纵面
Figure BDA0000069552490000165
是属于A转动方向(代表滚转转动方向、偏航转动方向或者俯仰转动方向)的操纵面,其中tj∈[1,2,…,n-1,n],且j=1,2,…,m-1,m。真实操纵面
Figure BDA0000069552490000166
(j=1,2,…,m-1,m)偏转角偏转范围分别为
Figure BDA0000069552490000168
控制效率矢量为
Figure BDA0000069552490000169
且在A转动方向的控制效率为
Figure BDA00000695524900001610
设某虚拟操纵面
Figure BDA00000695524900001611
与m个真实操纵面在A转动方向的控制等效,虚拟操纵面的偏转角为
Figure BDA00000695524900001612
虚拟操纵面在A转动方向的控制效率为偏转角的偏转范围为[-Rh Rh]。由于不同的真实操纵面在A转动方向的控制效率可能与虚拟操纵面在A转动方向的控制效率同号或者反号,因此,真实操纵面(j=1,2,…,m-1,m)对于偏转范围[-Rh Rh]进行标称化,需要考虑真实操纵面与虚拟操纵面在A转动方向的控制效率符号的一致性,即标称化操纵面
Figure BDA00000695524900001615
的标称化控制效率矢量:
B &omega; &delta; &OverBar; t j = B &omega; &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - B &omega; &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
在A转动方向的标称化控制效率:
B &omega; A &delta; &OverBar; t j = B &omega; A &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - B &omega; A &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
标称化偏转角:
&delta; &OverBar; t j = &delta; t j R h / R t j B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - &delta; t j R h / R t j B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1, 2,…,m-1,m)
控制效率均衡分配是将真实操纵面
Figure BDA00000695524900001619
(j=1,2,…,m-1,m)对于偏转范围[-Rh Rh]进行标称化得到标称化操纵面
Figure BDA00000695524900001620
对应标称化控制效率为
Figure BDA00000695524900001621
要求标称化操纵面按照标称化操纵面的控制效率来分担虚拟操纵面
Figure BDA00000695524900001623
在A转动方向的控制效率
Figure BDA00000695524900001624
即标称化操纵面
Figure BDA00000695524900001625
(j=1,2,…,m-1,m)在A转动方向期望分担的控制效率:
B &OverBar; &omega; A &delta; &OverBar; t j = B &omega; A &delta; &OverBar; t j &Sigma; i = 1 m B &omega; A &delta; &OverBar; t i B &omega; A &delta; &OverBar; h , (j=1,2,…,m-1, m)
由此,可以得到控制效率均衡分配下虚拟操纵面
Figure BDA0000069552490000172
的偏转角到真实操纵面
Figure BDA0000069552490000174
(j=1,2,…,m-1,m)的偏转角
Figure BDA0000069552490000175
的分配系数:
k t j = B &OverBar; &omega; A &delta; &OverBar; t j B &omega; A &delta; &OverBar; t j R t j R h = B &OverBar; &omega; A &delta; &OverBar; t j B &omega; A &delta; t j , (j=1,2,…,m-1,m)
可见,采用均衡分配的方法保证了所有真实操纵面按照标称化操纵面的控制效率来分担虚拟操纵面的控制效率,真实操纵面在负担期望的控制效率时对应的标称化偏转角相同,避免了某些真实操纵面分担过大的控制效率而出现饱和。
步骤三:根据真实操纵面的滚转、偏航及俯仰控制效率的大小,将所有真实操纵面划分为滚转操纵面、偏航操纵面与俯仰操纵面三类。
如果某真实操纵面ui(i=1,2,…,n-1,n)满足滚转控制效率
Figure BDA0000069552490000177
大于偏航控制效率
Figure BDA0000069552490000178
及俯仰控制效率
Figure BDA0000069552490000179
则将其划分为滚转操纵面,其主导控制效率为滚转控制效率,该真实操纵面与虚拟副翼相对应。
如果某个真实操纵面ui(i=1,2,…,n-1,n)满足偏航控制效率
Figure BDA00000695524900001710
大于滚转控制效率及俯仰控制效率则将其划分为偏航操纵面,其主导控制效率为偏航控制效率,该真实操纵面与虚拟方向舵相对应。
如果某个真实操纵面ui(i=1,2,…,n-1,n)满足俯仰控制效率
Figure BDA00000695524900001713
大于滚转控制效率
Figure BDA00000695524900001714
及偏航控制效率
Figure BDA00000695524900001715
则将其划分为俯仰操纵面,其主导控制效率为俯仰控制效率,该真实操纵面与虚拟升降舵相对应。
其中,滚转操纵面的数目计为n1,偏航操纵面的数目计为n2,俯仰操纵面的数目计为n3。则有n1+n2+n3=n。图2给出了将真实操纵面划分为滚转操纵面、偏航操纵面及俯仰操纵面的分类结构。
步骤四:分别将滚转操纵面、偏航操纵面、俯仰操纵面对于所对应的虚拟操纵面的偏转范围进行标称化,并按照标称化控制效率的绝对值排序。
确定虚拟副翼的滚转控制效率与所有滚转操纵面中标称化滚转控制效率的绝对值最大的操纵面的滚转控制效率同号。将所有滚转操纵面对于虚拟副翼的偏转范围[-Rk Rk]进行标称化,并按照标称化滚转控制效率的绝对值由大到小排序,假设排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面为
Figure BDA00000695524900001716
(pj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure BDA00000695524900001717
为:
B &omega; &delta; &OverBar; p j = B &omega; &delta; p j R p j / R k B &omega; x &delta; p j B &omega; x &delta; ~ x &GreaterEqual; 0 - B &omega; &delta; p j R p j / R k B &omega; x &delta; p j B &omega; x &delta; ~ x < 0 , (j=1,2,…,n1-1,n1)
Figure BDA00000695524900001719
分别表示标称化之前的滚转操纵面
Figure BDA00000695524900001720
的控制效率矢量及滚转控制效率,
Figure BDA00000695524900001721
表示虚拟副翼的滚转控制效率,滚转操纵面的偏转范围为 - R p j R p j . B &omega; &delta; &OverBar; p j = B &omega; x &delta; &OverBar; p j B &omega; y &delta; &OverBar; p j B &omega; z &delta; &OverBar; p j &prime; ,
Figure BDA00000695524900001725
分别表示标称化滚转操纵面
Figure BDA00000695524900001726
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率。其中,标称化滚转操纵面
Figure BDA0000069552490000181
与真实操纵面对应。则可以建立标称化滚转操纵面矢量 U &OverBar; P = u &OverBar; p 1 u &OverBar; p 2 . . . u &OverBar; p j . . . u &OverBar; p n 1 - 1 u &OverBar; p n 1 &prime; , 其中
Figure BDA0000069552490000184
(pj∈[1,2,…,n-1,n])表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面,标称化滚转操纵面矢量的控制效率矩阵 B &omega; &delta; &OverBar; P = B &omega; &delta; &OverBar; p 1 B &omega; &delta; &OverBar; p 2 . . . B &omega; &delta; &OverBar; p j . . . B &omega; &delta; &OverBar; p n 1 - 1 B &omega; &delta; &OverBar; p n 1 , 其中表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面
Figure BDA0000069552490000187
(pj∈[1,2,…,n-1,n])的标称化控制效率矢量。
确定虚拟方向舵的偏航控制效率与所有偏航操纵面中标称化偏航控制效率的绝对值最大的操纵面的偏航控制效率同号。将所有偏航操纵面对于虚拟方向舵的偏转范围[-Rl Rl]进行标称化,并按照标称化偏航控制效率的绝对值由大到小排序,假设排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面为
Figure BDA0000069552490000188
(qj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure BDA0000069552490000189
为:
B &omega; &delta; &OverBar; q j = B &omega; &delta; q j R q j / R l B &omega; y &delta; q j B &omega; y &delta; ~ y &GreaterEqual; 0 - B &omega; &delta; q j R q j / R l B &omega; y &delta; q j B &omega; y &delta; ~ y < 0 , (j=1,2,…,n2-1,n2)
Figure BDA00000695524900001811
分别表示标称化之前的偏航操纵面
Figure BDA00000695524900001812
的控制效率矢量及偏航控制效率,
Figure BDA00000695524900001813
表示虚拟方向舵的偏航控制效率,偏航操纵面
Figure BDA00000695524900001814
的偏转范围为 - R q j R q j . B &omega; &delta; &OverBar; q j = B &omega; x &delta; &OverBar; q j B &omega; y &delta; &OverBar; q j B &omega; z &delta; &OverBar; q j &prime; ,
Figure BDA00000695524900001817
分别表示标称化偏航操纵面
Figure BDA00000695524900001818
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率。其中,标称化偏航操纵面
Figure BDA00000695524900001819
与真实操纵面对应。则可以建立标称化偏航操纵面矢量 U &OverBar; Q = u &OverBar; q 1 u &OverBar; q 2 . . . u &OverBar; q j . . . u &OverBar; q n 2 - 1 u &OverBar; q n 2 &prime; , 其中
Figure BDA00000695524900001822
(qj∈[1,2,…,n-1,n])表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面,标称化偏航操纵面矢量的控制效率矩阵 B &omega; &delta; &OverBar; Q = B &omega; &delta; &OverBar; q 1 B &omega; &delta; &OverBar; q 2 . . . B &omega; &delta; &OverBar; q j . . . B &omega; &delta; &OverBar; q n 2 - 1 B &omega; &delta; &OverBar; q n 2 , 其中
Figure BDA00000695524900001824
表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,…n2-1,n2)个标称化偏航操纵面
Figure BDA00000695524900001825
(qj∈[1,2,…,n-1,n])的标称化控制效率矢量。
确定虚拟升降舵的俯仰控制效率与所有俯仰操纵面中标称化俯仰控制效率的绝对值最大的操纵面的俯仰控制效率同号。将所有俯仰操纵面对于虚拟升降舵的偏转范围[-Rm Rm]进行标称化,并按照标称化俯仰控制效率的绝对值由大到小排序,假设排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面为
Figure BDA00000695524900001826
(rj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure BDA00000695524900001827
为:
B &omega; &delta; &OverBar; r j = B &omega; &delta; r j R r j / R m B &omega; z &delta; r j B &omega; z &delta; ~ z &GreaterEqual; 0 - B &omega; &delta; r j R r j / R m B &omega; z &delta; r j B &omega; z &delta; ~ z < 0 , (j=1,2,…n3-1,n3)
Figure BDA0000069552490000191
分别表示标称化之前的俯仰操纵面的控制效率矢量及俯仰控制效率,
Figure BDA0000069552490000193
表示虚拟升降舵的俯仰控制效率,俯仰操纵面的偏转范围为 - R r j R r j . B &omega; &delta; &OverBar; r j = B &omega; x &delta; &OverBar; r j B &omega; y &delta; &OverBar; r j B &omega; z &delta; &OverBar; r j &prime; ,
Figure BDA0000069552490000197
分别表示标称化俯仰操纵面
Figure BDA0000069552490000198
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率。其中,标称化俯仰操纵面与真实操纵面
Figure BDA00000695524900001910
对应。则标称化俯仰操纵面矢量 U &OverBar; R = u &OverBar; r 1 u &OverBar; r 2 . . . u &OverBar; r j . . . u &OverBar; r n 3 - 1 u &OverBar; r n 3 &prime; ,
其中
Figure BDA00000695524900001912
(rj∈[1,2,…,n-1,n])
表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面,标称化俯仰操纵面矢量的控制效率矩阵为 B &omega; &delta; &OverBar; R = B &omega; &delta; &OverBar; r 1 B &omega; &delta; &OverBar; r 2 . . . B &omega; &delta; &OverBar; r j . . . B &omega; &delta; &OverBar; r n 3 - 1 B &omega; &delta; &OverBar; r n 3 , 其中,
Figure BDA00000695524900001914
表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面
Figure BDA00000695524900001915
(rj∈[1,2,…,n-1,n])的标称化控制效率矢量。
步骤五:确定虚拟操纵面的主导控制效率。
虚拟副翼的主导控制效率为滚转控制效率
Figure BDA00000695524900001918
为虚拟副翼的滚转控制效率比例系数,考虑到飞行控制系统的稳定性,一般选取
Figure BDA00000695524900001919
在0.8~2.0之间,
Figure BDA00000695524900001920
表示标称化滚转操纵面矢量
Figure BDA00000695524900001921
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure BDA00000695524900001922
的标称化滚转控制效率。虚拟副翼的滚转控制效率等于所有的标称化滚转操纵面期望分担的滚转控制效率。虚拟方向舵的主导控制效率为偏航控制效率
Figure BDA00000695524900001923
Figure BDA00000695524900001924
Figure BDA00000695524900001925
为虚拟方向舵的偏航控制效率比例系数,考虑到飞行控制系统的稳定性,一般选取
Figure BDA00000695524900001926
在0.8~2.0之间,
Figure BDA00000695524900001927
表示标称化偏航操纵面矢量
Figure BDA00000695524900001928
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面的标称化偏航控制效率。虚拟方向舵的偏航控制效率等于所有的标称化偏航操纵面期望分担的偏航控制效率。
虚拟升降舵的主导控制效率为俯仰控制效率
Figure BDA00000695524900001931
Figure BDA00000695524900001932
为虚拟升降舵的俯仰控制效率比例系数,考虑到飞行控制系统的稳定性,一般选取
Figure BDA00000695524900001933
在0.8~2.0之间,表示标称化俯仰操纵面矢量
Figure BDA00000695524900001935
中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面的标称化俯仰控制效率。虚拟升降舵的俯仰控制效率等于所有的标称化俯仰操纵面期望分担的俯仰控制效率。
步骤六:根据标称化控制效率将标称化操纵面划分成主、副、辅三级,设定标称化主操纵面与标称化副操纵面的权限系数,并计算主、副、辅各级标称化操纵面期望分担的主导控制效率。
(1)分别将标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的划分为主、副、辅三级。
Figure BDA00000695524900001937
表示标称化滚转操纵面矢量
Figure BDA00000695524900001938
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure BDA00000695524900001939
的标称化滚转控制效率。则确定标称化滚转主操纵面序号临界值nx1<n1,nx1是整数且满足:
&Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i &GreaterEqual; 0.5
确定标称化滚转副操纵面序号临界值nx2满足nx1<nx2≤n1,nx2是整数且满足:
&Sigma; j = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i )
将位于标称化滚转操纵面矢量
Figure BDA0000069552490000203
中前nx1个位置的操纵面划分为标称化滚转主操纵面;将位于标称化滚转操纵面矢量
Figure BDA0000069552490000204
中从(nx1+1)到nx2个位置的操纵面划分为标称化滚转副操纵面;将位于标称化滚转操纵面矢量
Figure BDA0000069552490000205
中从(nx2+1)到n1个位置的操纵面划分为标称化滚转辅操纵面。
Figure BDA0000069552490000206
表示标称化偏航操纵面矢量
Figure BDA0000069552490000207
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure BDA0000069552490000208
的标称化偏航控制效率。则标称化偏航主操纵面序号临界值ny1<n2,ny1是整数且满足:
&Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i &GreaterEqual; 0.5
则标称化偏航副操纵面序号临界值ny2满足ny1<ny2≤n2,ny2是整数且满足:
&Sigma; j = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i )
将位于标称化偏航操纵面矢量
Figure BDA00000695524900002011
中前ny1个位置的操纵面划分为标称化偏航主操纵面;将位于标称化偏航操纵面矢量
Figure BDA00000695524900002012
中从(ny1+1)到ny2个位置的操纵面划分为标称化偏航副操纵面;将位于标称化偏航操纵面矢量
Figure BDA00000695524900002013
中从(ny2+1)到n2个位置的操纵面划分为标称化偏航辅操纵面。
Figure BDA00000695524900002014
表示标称化俯仰操纵面矢量
Figure BDA00000695524900002015
中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面
Figure BDA00000695524900002016
的标称化俯仰控制效率。则标称化俯仰主操纵面序号临界值nz1<n3,nz1是整数且满足:
&Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i &GreaterEqual; 0.5
则标称化俯仰副操纵面序号临界值nz2满足nz1<nz2≤n3,nz2是整数且满足:
&Sigma; j = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i )
将位于标称化俯仰操纵面矢量
Figure BDA0000069552490000212
中前nz1个位置的操纵面划分为标称化俯仰主操纵面;将位于标称化俯仰操纵面矢量中从(nz1+1)到nz2个位置的操纵面划分为标称化俯仰副操纵面;将位于标称化俯仰操纵面矢量
Figure BDA0000069552490000214
中从(nz2+1)到n3个位置的操纵面划分为标称化俯仰辅操纵面。
图2给出了将滚转操纵面、偏航操纵面及俯仰操纵面进行标称化得到标称化滚转操纵面、标称化偏航操纵面及标称化俯仰操纵面,并分别将标称化滚转操纵面、标称化偏航操纵面及标称化俯仰操纵面划分为主、副、辅三级的划分结构图。
(2)分别对标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面设定主、副权限系数,并计算标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的主、副、辅各级标称化操纵面期望分担的主导控制效率。
虚拟副翼的滚转控制效率由所有的标称化滚转操纵面来分担。按照控制效率均衡分配的方法得到所有的标称化滚转主操纵面所分担的虚拟副翼的滚转控制效率的比率Cxm为:
C xm = &Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i
所有的标称化滚转副操纵面所分担的虚拟副翼的滚转控制效率的比率Cxs为:
C xs = &Sigma; j = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i
所有的标称化滚转辅操纵面所分担的虚拟副翼的滚转控制效率的比率Cxf为:
Cxf=1-Cxm-Cxs
图3给出了虚拟副翼的滚转控制效率的分配过程,根据飞行控制的要求及飞机的配置情况,设定标称化滚转主操纵面的权限系数为Qxm及标称化滚转副操纵面的权限系数为Qxs。一般选取Qxm在0.8~1.5之间,Qxs在0.5~2.0之间。则所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure BDA0000069552490000217
则所有的标称化滚转副操纵面期望分担的滚转控制效率
Figure BDA0000069552490000218
所有的标称化滚转辅操纵面期望分担的滚转控制效率
B &OverBar; &omega; x &delta; &OverBar; xf = B &omega; x &delta; ~ x ( 1 - Q xm C xm - Q xs C xs ) .
虚拟方向舵的偏航控制效率由所有的标称化偏航操纵面来分担。按照控制效率均衡分配的方法,得到所有的标称化偏航主操纵面所分担的虚拟方向舵的偏航控制效率的比率Cym为:
C ym = &Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i
所有的标称化偏航副操纵面所分担的虚拟方向舵的偏航控制效率的比率Cys为:
C ys = &Sigma; j = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i
所有的标称化偏航辅操纵面所分担的虚拟方向舵的偏航控制效率的比率Cyf为:
Cyf=1-Cym-Cys
根据飞行控制的要求及飞机的配置情况,设计标称化偏航主操纵面的权限系数为Qym及标称化偏航副操纵面的权限系数为Qys,一般选取Qym在0.8~1.5之间,Qys在0.5~2.0之间。则所有的标称化偏航主操纵面期望分担的偏航控制效率
Figure BDA0000069552490000223
所有的标称化偏航副操纵面期望分担的偏航控制效率
Figure BDA0000069552490000224
所有的标称化偏航辅操纵面期望分担的偏航控制效率 B &OverBar; &omega; y &delta; &OverBar; yf = B &omega; y &delta; ~ y ( 1 - Q ym C ym - Q ys C ys ) ;
虚拟升降舵的俯仰控制效率由所有的标称化俯仰操纵面来分担。按照控制效率均衡分配的方法,得到所有的标称化俯仰主操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czm为:
C zm = &Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i
所有的标称化俯仰副操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czs为:
C zs = &Sigma; j = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i
所有的标称化俯仰辅操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czf为:
Czf=1-Czm-Czs
根据飞行控制的要求及飞机的配置情况,设计标称化俯仰主操纵面的权限系数为Qzm及标称化俯仰副操纵面的权限系数Qzs,一般选取Qzm在0.8~1.5之间,Qzs在0.5~2.0之间。则所有的标称化俯仰主操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000228
所有的标称化俯仰副操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000229
所有的标称化俯仰辅操纵面期望分担的俯仰控制效率 B &OverBar; &omega; z &delta; &OverBar; zf = B &omega; z &delta; ~ z ( 1 - Q zm C zm - Q zs C zs ) .
步骤七:采用控制效率均衡分配的方法计算每个标称化操纵面期望分担的主导控制效率。
(1)计算每个标称化滚转操纵面期望分担的滚转控制效率:
如图3所示,采用控制效率均衡分配的方法将所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure BDA0000069552490000231
分配给每个标称化滚转主操纵面,则第j(j=1,2,…,nx1-1,nx1)个标称化滚转主操纵面
Figure BDA0000069552490000232
期望分担的滚转控制效率
Figure BDA0000069552490000233
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xm B &omega; x &delta; &OverBar; p j &Sigma; i = 1 nx 1 B &omega; x &delta; &OverBar; p i , (j=1,2,…,nx1-1,nx1)
如图3所示,采用控制效率均衡分配的方法将所有的标称化滚转副操纵面期望分担的滚转控制效率分配给每个标称化滚转副操纵面,则第j(j=nx1+1,nx1+2,…,nx2-1,nx2)个标称化滚转副操纵面
Figure BDA0000069552490000236
期望分担的滚转控制效率
Figure BDA0000069552490000237
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xs B &omega; x &delta; &OverBar; p j &Sigma; i = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p i , (j=nx1+1,nx1+2,…,nx2-1,nx2)
如图3所示,采用控制效率均衡分配的方法将所有的标称化滚转辅操纵面期望分担的滚转控制效率
Figure BDA0000069552490000239
分配每个标称化滚转辅操纵面,则第j(j=nx2+1,nx2+2,…,n1-1,n1)个标称化滚转辅操纵面
Figure BDA00000695524900002310
期望分担的滚转控制效率
Figure BDA00000695524900002311
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xf B &omega; x &delta; &OverBar; p j &Sigma; i = nx 2 + 1 n 1 B &omega; x &delta; &OverBar; p i , (j=nx2+1,nx2+2,…,n1-1,n1)
(2)计算每个标称化偏航操纵面期望分担的偏航控制效率:
采用控制效率均衡分配的方法将所有的标称化偏航主操纵面期望分担的偏航控制效率
Figure BDA00000695524900002313
分配给每个标称化偏航主操纵面,则第j(j=1,2,…,ny1-1,ny1)个标称化偏航主操纵面
Figure BDA00000695524900002314
期望分担的偏航控制效率为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; ym B &omega; y &delta; &OverBar; q j &Sigma; i = 1 ny 1 B &omega; y &delta; &OverBar; q i , (j=1,2,…,ny1-1,ny1)
采用控制效率均衡分配的方法将所有的标称化偏航副操纵面期望分担的偏航控制效率
Figure BDA00000695524900002317
分配给每个标称化偏航副操纵面,则第j(j=ny1+1,ny1+2,…,ny2-1,ny2)个标称化偏航副操纵面
Figure BDA00000695524900002318
期望分担的偏航控制效率
Figure BDA00000695524900002319
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; ys B &omega; y &delta; &OverBar; q j &Sigma; i = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q i , (j=ny1+1,ny1+2,…,ny2-1,ny2)
采用控制效率均衡分配的方法将所有的陈化偏航辅操纵面期望分担的偏航控制效率
Figure BDA00000695524900002321
分配给每个标称化偏航辅操纵面,则第j(j=ny2+1,ny2+2,…,n2-1,n2)个标称化偏航辅操纵面
Figure BDA00000695524900002322
期望分担的偏航控制效率为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; yf B &omega; y &delta; &OverBar; q j &Sigma; i = ny 2 + 1 n 2 B &omega; y &delta; &OverBar; q i , (j=ny2+1,ny2+2,…,n2-1,n2)
(3)计算每个标称化俯仰操纵面期望分担的俯仰控制效率:
采用控制效率均衡分配的方法将所有的标称化俯仰主操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000242
分配给每个标称化俯仰主操纵面,则第j(j=1,2,…,nz1-1,nz1)个标称化俯仰主操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000244
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zm B &omega; z &delta; &OverBar; r j &Sigma; i = 1 nz 1 B &omega; z &delta; &OverBar; r i , (j=1,2,…,nz1-1,nz1)
采用控制效率均衡分配的方法将所有的标称化俯仰副操纵面期望分担的俯仰控制效率
Figure BDA0000069552490000246
分配给每个标称化俯仰副操纵面,则第j(j=nz1+1,nz1+2,…,nz2-1,nz2)个标称化俯仰副操纵面
Figure BDA0000069552490000247
期望分担的俯仰控制效率
Figure BDA0000069552490000248
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zs B &omega; z &delta; &OverBar; r j &Sigma; i = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r i , (j=nz1+1,nz1+2,…,nz2-1,nz2)
采用控制效率均衡分配的方法将所有的标称化俯仰辅操纵面期望分担的俯仰控制效率
Figure BDA00000695524900002410
分配给每个标称化俯仰辅操纵面,则第j(j=nz2+1,nz2+2,…,n3-1,n3)个标称化俯仰辅操纵面
Figure BDA00000695524900002411
期望分担的俯仰控制效率
Figure BDA00000695524900002412
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zf B &omega; z &delta; &OverBar; r j &Sigma; i = nz 2 + 1 n 3 B &omega; z &delta; &OverBar; r i , (j=nz2+1,nz2+2,…,n3-1,n3)
步骤八:计算所有真实操纵面的分配系数,建立加权均衡分配矩阵,求解虚拟操纵面矢量的控制效率矩阵中的非主导控制效率。
(1)计算所有真实操纵面的分配系数:
①计算每个滚转操纵面的分配系数:
由于第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面与标称化之前的滚转操纵面对应,标称化滚转操纵面
Figure BDA00000695524900002416
期望分担的滚转控制效率为滚转操纵面
Figure BDA00000695524900002418
的偏转范围为
Figure BDA00000695524900002419
滚转控制效率为
Figure BDA00000695524900002420
则虚拟副翼
Figure BDA00000695524900002421
的偏转角到滚转操纵面
Figure BDA00000695524900002423
的偏转角
Figure BDA00000695524900002424
的分配系数
Figure BDA00000695524900002425
为:
k p j = B &OverBar; &omega; x &delta; &OverBar; p j B &omega; x &delta; p j , (j=1,2,…,n1-1,n1)
从而得到滚转操纵面的分配系数矢量 K ^ x = k p 1 k p 2 . . . k p j . . . k p n 1 - 1 k p n 1 &prime; , 其中
Figure BDA00000695524900002428
(j=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900002429
的偏转角
Figure BDA00000695524900002430
到滚转操纵面的偏转角的分配系数。图3给出了根据虚拟副翼的滚转控制效率比例系数
Figure BDA0000069552490000251
按照控制效率均衡分配的方法得到所有的标称化滚转主操纵面所分担的虚拟副翼的滚转控制效率的比率Cxm、按照控制效率均衡分配的方法得到的所有的标称化滚转副操纵面所分担的虚拟副翼的滚转控制效率的比率Cxs、标称化滚转主操纵面的权限系数Qxm、标称化滚转副操纵面的权限系数Qxs计算滚转操纵面的分配系数矢量的过程。
②计算每个偏航操纵面的分配系数:
由于第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面
Figure BDA0000069552490000252
与标称化之前的偏航操纵面对应,标称化偏航操纵面
Figure BDA0000069552490000254
期望分担的偏航控制效率为
Figure BDA0000069552490000255
偏航操纵面
Figure BDA0000069552490000256
的偏转范围为 - R q j R q j , 偏航控制效率为
Figure BDA0000069552490000258
则虚拟方向舵
Figure BDA0000069552490000259
的偏转角
Figure BDA00000695524900002510
到偏航操纵面的偏转角
Figure BDA00000695524900002512
的分配系数为:
k q j = B &OverBar; &omega; y &delta; &OverBar; q j B &omega; y &delta; q j , (j=1,2,…,n2-1,n2)
从而得到偏航操纵面的分配系数矢量 K ^ y = k q 1 k q 2 . . . k q j . . . k q n 2 - 1 k q n 2 &prime; . 其中,
Figure BDA00000695524900002515
(j=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900002516
的偏转角
Figure BDA00000695524900002517
到偏航操纵面
Figure BDA00000695524900002518
的偏转角
Figure BDA00000695524900002519
的分配系数。
③计算每个俯仰操纵面的分配系数:
由于第j(j=1,2,…,n3-1,n3)个标称化俯仰操纵面
Figure BDA00000695524900002520
与标称化之前的俯仰操纵面对应,标称化俯仰操纵面
Figure BDA00000695524900002522
期望分担的俯仰控制效率为
Figure BDA00000695524900002523
俯仰操纵面的偏转范围为
Figure BDA00000695524900002525
俯仰控制效率为
Figure BDA00000695524900002526
则虚拟升降舵
Figure BDA00000695524900002527
的偏转角到俯仰操纵面
Figure BDA00000695524900002529
的偏转角
Figure BDA00000695524900002530
的分配系数为:
k r j = B &OverBar; &omega; z &delta; &OverBar; r j B &omega; z &delta; r j , (j=1,2,…,n3-1,n3)
从而得到俯仰操纵面的分配系数矢量 K ^ z = k r 1 k r 2 . . . k r j . . . k r n 3 - 1 k r n 3 &prime; , 其中
Figure BDA00000695524900002533
(j=1,2,…,n3-1,n3)表示虚拟升降舵
Figure BDA00000695524900002534
的偏转角到俯仰操纵面
Figure BDA00000695524900002536
的偏转角的分配系数。
(2)建立加权均衡分配矩阵,求解虚拟操纵面矢量的控制效率矩阵中的非主导控制效率,从而确定虚拟操纵面矢量的控制效率矩阵。
①虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵:
建立过渡操纵面矢量 U ^ = u p 1 . . . u p i . . . u p n 1 u q 1 . . . u q j . . . u q n 2 u r 1 . . . u r t . . . u r n 3 &prime; , 过渡操纵面的偏转角矢量 &delta; ^ = &delta; p 1 . . . &delta; p i . . . &delta; p n 1 &delta; q 1 . . . &delta; q j . . . &delta; q n 2 &delta; r 1 . . . &delta; r t . . . &delta; r n 3 &prime; , 过渡操纵面矢量的控制效率矩阵
B ^ = B &omega; &delta; p 1 . . . B &omega; &delta; p i . . . B &omega; &delta; p n 1 B &omega; &delta; q 1 . . . B &omega; &delta; q j . . . B &omega; &delta; q n 2 B &omega; &delta; r 1 . . . B &omega; &delta; r t . . . B &omega; &delta; r n 3
其中,
Figure BDA00000695524900002541
(i=1,2,…,n1-1,n1)分别表示滚转操纵面
Figure BDA00000695524900002542
的偏转角及控制效率矢量,(j=1,2,…,n2-1,n2)分别表示偏航操纵面
Figure BDA0000069552490000262
的偏转角及控制效率矢量,
Figure BDA0000069552490000263
(t=1,2,…,n3-1,n3)分别表示滚转操纵面
Figure BDA0000069552490000264
的偏转角及控制效率矢量。虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z &prime; 对应的虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; , 虚拟操纵面矢量的控制效率矩阵 B ~ = B &omega; &delta; ~ x B &omega; &delta; ~ y B &omega; &delta; ~ z &prime; , 其中,
Figure BDA0000069552490000268
表示虚拟副翼的偏转角及控制效率矢量,
Figure BDA0000069552490000269
Figure BDA00000695524900002610
表示虚拟方向舵的偏转角及控制效率矢量,
Figure BDA00000695524900002611
分别表示虚拟升降舵的偏转角及控制效率矢量。则虚拟操纵面偏转角矢量到过渡操纵面偏转角矢量的传递关系为
Figure BDA00000695524900002612
其中,
Figure BDA00000695524900002613
表示虚拟操纵面矢量到过渡操纵面矢量的加权均衡分配矩阵:
K ^ = K ^ x 0 n 1 &times; 1 0 n 1 &times; 1 0 n 2 &times; 1 K ^ y 0 n 2 &times; 1 0 n 3 &times; 1 0 n 3 &times; 1 K ^ z
其中,
Figure BDA00000695524900002615
表示n1行1列的全零向量,
Figure BDA00000695524900002616
表示n2行1列的全零向量,
Figure BDA00000695524900002617
表示n3行1列的全零向量。
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure BDA00000695524900002618
真实操纵面矢量U=[u1 u2 …ui …un-1 un]′,
对应的真实操纵面的偏转角矢量δ=[δ1 δ2 …δi …δn-1 δn]′,真实操纵面的控制效率矩阵 B = B &omega; &delta; 1 B &omega; &delta; 2 . . . B &omega; &delta; i . . . B &omega; &delta; n - 1 B &omega; &delta; n &prime; , 其中δi分别表示真实操纵面ui的偏转角、控制效率矢量。过渡操纵面矢量
Figure BDA00000695524900002621
的偏转角矢量可以通过n行n列的转换矩阵T转化为真实操纵面矢量U的偏转角矢量δ,即
Figure BDA00000695524900002623
且过渡操纵面矢量控制效率矩阵
Figure BDA00000695524900002624
转换矩阵T的第a行b列表示为T(a,b),对于所有的j=1,2,…,n1-1,n1,T(pj,j)=1;对于所有的j=1,2,…,n2-1,n2,T(qj,j+n1)=1;对于所有的j=1,2,…,n3-1,n3,T(rj,j+n1+n2)=1;矩阵T的所有其他元素都为0。
由于
Figure BDA00000695524900002625
从而得到真实操纵面偏转角矢量
Figure BDA00000695524900002626
因此,虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵
Figure BDA00000695524900002627
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure BDA00000695524900002628
过渡操纵面矢量控制效率矩阵与真实操纵面的控制效率矩阵满足可知虚拟操纵面的控制效率矩阵
Figure BDA00000695524900002630
与真实操纵面的控制矩阵B满足
可见,通过求解加权均衡分配矩阵K实现了多操纵面的控制分配,该计算过程简单,物理概念清晰,便于工程实现。
②由加权均衡分配矩阵计算虚拟操纵面的非主导控制效率,得到虚拟操纵面矢量的控制效率矩阵。
虚拟操纵面的控制效率矩阵
Figure BDA00000695524900002632
与过渡操纵面控制效率矩阵
Figure BDA00000695524900002633
满足
Figure BDA00000695524900002634
其中过渡操纵面矢量的控制效率矩阵已知:
B ^ = B &omega; x &delta; p 1 . . . B &omega; x &delta; p i . . . B &omega; x &delta; p n 1 B &omega; x &delta; q 1 . . . B &omega; x &delta; q j . . . B &omega; x &delta; q n 2 B &omega; x &delta; r 1 . . . B &omega; x &delta; r t . . . B &omega; x &delta; r n 3 B &omega; y &delta; p 1 . . . B &omega; y &delta; p i . . . B &omega; y &delta; p n 1 B &omega; y &delta; q 1 . . . B &omega; y &delta; q j . . . B &omega; y &delta; q n 2 B &omega; y &delta; r 1 . . . B &omega; y &delta; r t . . . B &omega; y &delta; r n 3 B &omega; z &delta; p 1 . . . B &omega; z &delta; p i . . . B &omega; z &delta; p n 1 B &omega; z &delta; q 1 . . . B &omega; z &delta; q j . . . B &omega; z &delta; q n 2 B &omega; z &delta; r 1 . . . B &omega; z &delta; r t . . . B &omega; z &delta; r n 3
其中,
Figure BDA0000069552490000272
分别表示滚转操纵面
Figure BDA0000069552490000273
(i=1,2,…,n1-1,n1)的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure BDA0000069552490000274
分别表示偏航操纵面
Figure BDA0000069552490000275
(j=1,2,…,n2-1,n2)的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure BDA0000069552490000276
分别表示俯仰操纵面
Figure BDA0000069552490000277
(t=1,2,…,n3-1,n3)的滚转控制效率、偏航控制效率及俯仰控制效率。
虚拟操纵面矢量的控制效率矩阵为:
B ~ = B &omega; x &delta; ~ x B &omega; x &delta; ~ y B &omega; x &delta; ~ z B &omega; y &delta; ~ x B &omega; y &delta; ~ y B &omega; y &delta; ~ z B &omega; z &delta; ~ x B &omega; z &delta; ~ y B &omega; z &delta; ~ z
其中,虚拟副翼的滚转控制效率虚拟方向舵的偏航控制效率
Figure BDA00000695524900002710
虚拟升降舵的俯仰控制效率
Figure BDA00000695524900002711
为主导控制效率,均由步骤五确定。可以确定虚拟操纵面的非主导控制效率:虚拟副翼的偏航控制效率
Figure BDA00000695524900002712
Figure BDA00000695524900002713
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900002714
的偏转角
Figure BDA00000695524900002715
到滚转操纵面
Figure BDA00000695524900002716
的偏转角
Figure BDA00000695524900002717
的分配系数;虚拟副翼的俯仰控制效率
Figure BDA00000695524900002718
Figure BDA00000695524900002719
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900002720
的偏转角到滚转操纵面
Figure BDA00000695524900002722
的偏转角
Figure BDA00000695524900002723
的分配系数;虚拟方向舵的滚转控制效率
Figure BDA00000695524900002725
(i=1,2,…,n2-1,n2)表示虚拟方向舵的偏转角
Figure BDA00000695524900002727
到偏航操纵面
Figure BDA00000695524900002728
的偏转角
Figure BDA00000695524900002729
的分配系数;虚拟方向舵的俯仰控制效率
Figure BDA00000695524900002730
Figure BDA00000695524900002731
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900002732
的偏转角
Figure BDA00000695524900002733
到偏航操纵面
Figure BDA00000695524900002734
的偏转角
Figure BDA00000695524900002735
的分配系数;虚拟升降舵的滚转控制效率
Figure BDA00000695524900002736
Figure BDA00000695524900002737
(i=1,2,…,n3-1,n3)表示虚拟升降舵
Figure BDA00000695524900002738
的偏转角
Figure BDA00000695524900002739
到俯仰操纵面的偏转角
Figure BDA00000695524900002741
的分配系数;虚拟升降舵的偏航控制效率
Figure BDA00000695524900002742
Figure BDA00000695524900002743
(i=1,2,…,n3-1,n3)表示虚拟升降舵的偏转角
Figure BDA00000695524900002745
到俯仰操纵面
Figure BDA00000695524900002746
的偏转角的分配系数。
根据虚拟操纵面矢量的控制效率矩阵来设计控制律,且控制律输出平稳变化的虚拟操纵面偏转角指令,避免了控制律输出期望力矩、复杂优化及偏转角速率过大的问题。

Claims (7)

1.多操纵面飞机的一种均衡操纵分配方法,其特征在于:包括以下几个步骤:
步骤一:将多操纵面的控制分配问题转化为虚拟操纵面与真实操纵面的等效控制问题:
飞机的n个真实操纵面组成真实操纵面矢量U=[u1 u2 …ui …un-1 un]′,其中ui表示第i个真实操纵面,真实操纵面偏转角矢量为δ=[δ1 δ2 …δi …δn-1 δn]′,其中δi表示第i个真实操纵面的偏转角,且控制效率矩阵为 B = B &omega; &delta; 1 B &omega; &delta; 2 . . . B &omega; &delta; i . . . B &omega; &delta; n - 1 B &omega; &delta; n , 其中,
Figure FDA0000069552480000012
(i=1,2,…,n-1,n)表示第i个真实操纵面ui的控制效率矢量,且 B &omega; &delta; i = B &omega; x &delta; i B &omega; y &delta; i B &omega; z &delta; i &prime; ,
Figure FDA0000069552480000014
分别表示第i个真实操纵面ui的滚转控制效率、偏航控制效率、俯仰控制效率,且第i个真实操纵面ui(i=1,2,…,n-1,n)的偏转角δi的偏转范围为[-Ri,Ri],角速率
Figure FDA0000069552480000015
限制为[-ρi,ρi];
建立虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z &prime; , 其中,
Figure FDA0000069552480000017
表示虚拟副翼,虚拟副翼偏转范围为[-Rk Rk];
Figure FDA0000069552480000018
表示虚拟方向舵,虚拟方向舵偏转范围为[-Rl Rl];
Figure FDA0000069552480000019
表示虚拟升降舵,虚拟升降舵偏转范围为[-Rm Rm];虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; , 其中分别表示虚拟副翼偏转角、虚拟方向舵偏转角、虚拟升降舵偏转角;虚拟操纵面矢量的控制效率矩阵为:
B ~ = B &omega; x &delta; ~ x B &omega; x &delta; ~ y B &omega; x &delta; ~ z B &omega; y &delta; ~ x B &omega; y &delta; ~ y B &omega; y &delta; ~ z B &omega; z &delta; ~ x B &omega; z &delta; ~ y B &omega; z &delta; ~ z
其中,
Figure FDA00000695524800000113
为虚拟副翼的滚转控制效率,
Figure FDA00000695524800000114
为虚拟副翼的偏航控制效率,为虚拟副翼的俯仰控制效率,为虚拟方向舵的滚转控制效率,
Figure FDA00000695524800000117
为虚拟方向舵的偏航控制效率,为虚拟方向舵的俯仰控制效率,为虚拟升降舵的滚转控制效率,
Figure FDA00000695524800000120
为虚拟升降舵的偏航控制效率,为虚拟升降舵的俯仰控制效率;
真实操纵面的偏转角矢量δ与虚拟操纵面偏转角矢量
Figure FDA00000695524800000122
满足关系
Figure FDA00000695524800000123
K为加权均衡分配矩阵,且虚拟操纵面矢量控制的效率矩阵满足
Figure FDA00000695524800000124
控制器根据驾驶员的驾驶指令或自动驾驶仪期望的轨迹、姿态指令Cmd及飞机当前状态矢量X计算虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; ; 根据加权均衡矩阵K计算真实操纵面偏转角矢量
Figure FDA00000695524800000126
真实操纵面偏转角矢量根据真实操纵面矢量的控制效率矩阵B,计算得到期望的力矩矢量其中 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; ; 虚拟操纵面矢量
Figure FDA00000695524800000129
根据虚拟操纵面矢量的控制效率矩阵
Figure FDA00000695524800000130
计算得到力矩矢量为
Figure FDA00000695524800000131
虚拟操纵面矢量产生与真实操纵面矢量相同的力矩矢量 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; ; 其中 分别表示期望的滚转力矩、期望的偏航力矩、期望的俯仰力矩;
步骤二:确定对真实操纵面进行标称化及控制效率加权均衡分配的基本方法:
定义真实操纵面ui(i=1,2,…,n-1,n)的偏转角δi时对应的真实操纵面的饱和度Si为Si=fabs(δi/Ri),其中函数fabs(x)表示小数x的绝对值;
将控制效率矢量为偏转范围为[-Ri Ri]的真实操纵面ui(i=1,2,…,n-1,n)对于偏转范围[-Rj Rj]进行标称化,得到标称化滚转控制效率的绝对值、标称化偏航控制效率的绝对值、标称化俯仰控制效率矢量为的绝对值分别为
Figure FDA0000069552480000022
Figure FDA0000069552480000023
其中函数fabs(x)表示小数x的绝对值;
设n个真实操纵面中有m个真实操纵面
Figure FDA0000069552480000024
是属于A转动方向的操纵面,其中tj∈[1,2,…,n-1,n],且
Figure FDA0000069552480000025
真实操纵面(j=1,2,…,n-1,m)偏转角
Figure FDA0000069552480000027
偏转范围分别为 - R t j R t j , 控制效率矢量为
Figure FDA0000069552480000029
且在A转动方向的控制效率为
Figure FDA00000695524800000210
设某虚拟操纵面
Figure FDA00000695524800000211
与m个真实操纵面在A转动方向的控制等效,虚拟操纵面的偏转角为
Figure FDA00000695524800000212
虚拟操纵面在A转动方向的控制效率为
Figure FDA00000695524800000213
偏转角的偏转范围为[-Rh Rh];真实操纵面
Figure FDA00000695524800000214
(j=1,2,…,m-1,m)对于偏转范围[-Rh Rh]进行标称化,标称化操纵面
Figure FDA00000695524800000215
的标称化控制效率矢量:
B &omega; &delta; &OverBar; t j = B &omega; &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - B &omega; &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
在A转动方向的标称化控制效率:
B &omega; A &delta; &OverBar; t j = B &omega; A &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - B &omega; A &delta; t j R t j / R h B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
标称化偏转角:
&delta; &OverBar; t j = &delta; t j R h / R t j B &omega; A &delta; t j B &omega; A &delta; ~ h &GreaterEqual; 0 - &delta; t j R h / R t j B &omega; A &delta; t j B &omega; A &delta; ~ h < 0 , (j=1,2,…,m-1,m)
控制效率均衡分配是将真实操纵面
Figure FDA00000695524800000219
(j=1,2,…,m-1,m)对于偏转范围[-Rh Rh]进行标称化得到标称化操纵面
Figure FDA00000695524800000220
对应标称化控制效率为
Figure FDA00000695524800000221
标称化操纵面
Figure FDA00000695524800000222
(j=1,2,…,m-1,m)在A转动方向期望分担的控制效率:
B &OverBar; &omega; A &delta; &OverBar; t j = B &omega; A &delta; &OverBar; t j &Sigma; i = 1 m B &omega; A &delta; &OverBar; t i B &omega; A &delta; &OverBar; h , (j=1,2…,m-1,m)
得到控制效率均衡分配下虚拟操纵面
Figure FDA00000695524800000224
的偏转角
Figure FDA00000695524800000225
到真实操纵面
Figure FDA00000695524800000226
(j=1,2,…,m-1,m)的偏转角
Figure FDA00000695524800000227
的分配系数:
k t j = B &OverBar; &omega; A &delta; &OverBar; t j B &omega; A &delta; &OverBar; t j R t j R h = B &OverBar; &omega; A &delta; &OverBar; t j B &omega; A &delta; t j , (j=1,2,…,m-1,m)
步骤三:根据真实操纵面的滚转、偏航及俯仰控制效率的大小,将所有真实操纵面划分为滚转操纵面、偏航操纵面与俯仰操纵面:
若真实操纵面ui(i=1,2,…,n-1,n)满足滚转控制效率
Figure FDA0000069552480000031
大于偏航控制效率
Figure FDA0000069552480000032
及俯仰控制效率则将其划分为滚转操纵面,其主导控制效率为滚转控制效率,该真实操纵面与虚拟副翼相对应;
若真实操纵面ui(i=1,2,…,n-1,n)满足偏航控制效率
Figure FDA0000069552480000034
大于滚转控制效率
Figure FDA0000069552480000035
及俯仰控制效率
Figure FDA0000069552480000036
则将其划分为偏航操纵面,其主导控制效率为偏航控制效率,该真实操纵面与虚拟方向舵相对应;
若真实操纵面ui(i=1,2,…,n-1,n)满足俯仰控制效率
Figure FDA0000069552480000037
大于滚转控制效率
Figure FDA0000069552480000038
及偏航控制效率
Figure FDA0000069552480000039
则将其划分为俯仰操纵面,其主导控制效率为俯仰控制效率,该真实操纵面与虚拟升降舵相对应;
滚转操纵面的数目计为n1,偏航操纵面的数目计为n2,俯仰操纵面的数目计为n3,n1+n2+n3=n;
步骤四:分别将滚转操纵面、偏航操纵面、俯仰操纵面对于所对应的虚拟操纵面的偏转范围进行标称化,并按照标称化控制效率的绝对值排序:
确定虚拟副翼的滚转控制效率与所有滚转操纵面中标称化滚转控制效率的绝对值最大的操纵面的滚转控制效率同号,将所有滚转操纵面对于虚拟副翼的偏转范围[-Rk Rk]进行标称化,并按照标称化滚转控制效率由大到小排序,排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面为
Figure FDA00000695524800000310
(pj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure FDA00000695524800000311
为:
B &omega; &delta; &OverBar; p j = B &omega; &delta; p j R p j / R k B &omega; x &delta; p j B &omega; x &delta; ~ x &GreaterEqual; 0 - B &omega; &delta; p j R p j / R k B &omega; x &delta; p j B &omega; x &delta; ~ x < 0 , (j=1,2,…,n1-1,n1)
Figure FDA00000695524800000313
分别表示标称化之前的滚转操纵面
Figure FDA00000695524800000314
的控制效率矢量及滚转控制效率,表示虚拟副翼的滚转控制效率,滚转操纵面
Figure FDA00000695524800000316
的偏转范围为 - R p j R p j , B &omega; &delta; &OverBar; p j = B &omega; x &delta; &OverBar; p j B &omega; y &delta; &OverBar; p j B &omega; z &delta; &OverBar; p j &prime; ,
Figure FDA00000695524800000319
分别表示标称化滚转操纵面
Figure FDA00000695524800000320
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化滚转操纵面矢量 U &OverBar; P = u &OverBar; p 1 u &OverBar; p 2 . . . u &OverBar; p j . . . u &OverBar; p n 1 - 1 u &OverBar; p n 1 &prime; , 其中
Figure FDA00000695524800000322
(pj∈[1,2,…,n-1,n])表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面,标称化滚转操纵面矢量的控制效率矩阵 B &omega; &delta; &OverBar; P = B &omega; &delta; &OverBar; p 1 B &omega; &delta; &OverBar; p 2 . . . B &omega; &delta; &OverBar; p j . . . B &omega; &delta; &OverBar; p n 1 - 1 B &omega; &delta; &OverBar; p n 1 , 其中
Figure FDA00000695524800000324
表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面
Figure FDA00000695524800000325
(pj∈[1,2,…,n-1,n])的标称化控制效率矢量;
确定虚拟方向舵的偏航控制效率与所有偏航操纵面中标称化偏航控制效率的绝对值最大的操纵面的偏航控制效率同号,将所有偏航操纵面对于虚拟方向舵的偏转范围[-Rl Rl]进行标称化,并按照标称化偏航控制效率的绝对值由大到小排序,排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面为
Figure FDA00000695524800000326
(qj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure FDA00000695524800000327
为:
B &omega; &delta; &OverBar; q j = B &omega; &delta; q j R q j / R l B &omega; y &delta; q j B &omega; y &delta; ~ y &GreaterEqual; 0 - B &omega; &delta; q j R q j / R l B &omega; y &delta; q j B &omega; y &delta; ~ y < 0 , (j=1,2,…,n2-1,n2)
Figure FDA0000069552480000041
分别表示标称化之前的偏航操纵面
Figure FDA0000069552480000042
的控制效率矢量及偏航控制效率,表示虚拟方向舵的偏航控制效率,偏航操纵面
Figure FDA0000069552480000044
的偏转范围为 - R q j R q j , B &omega; &delta; &OverBar; q j = B &omega; x &delta; &OverBar; q j B &omega; y &delta; &OverBar; q j B &omega; z &delta; &OverBar; q j &prime; ,
Figure FDA0000069552480000047
分别表示标称化偏航操纵面
Figure FDA0000069552480000048
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化偏航操纵面矢量 U &OverBar; Q = u &OverBar; q 1 u &OverBar; q 2 . . . u &OverBar; q j . . . u &OverBar; q n 2 - 1 u &OverBar; q n 2 &prime; , 其中
Figure FDA00000695524800000410
(qj∈[1,2,…,n-1,n])表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面,标称化偏航操纵面矢量的控制效率矩阵 B &omega; &delta; &OverBar; Q = B &omega; &delta; &OverBar; q 1 B &omega; &delta; &OverBar; q 2 . . . B &omega; &delta; &OverBar; q j . . . B &omega; &delta; &OverBar; q n 2 - 1 B &omega; &delta; &OverBar; q n 2 , 其中
Figure FDA00000695524800000412
表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,…n2-1,n2)个标称化偏航操纵面
Figure FDA00000695524800000413
(qj∈[1,2,…,n-1,n])的标称化控制效率矢量;
确定虚拟升降舵的俯仰控制效率与所有俯仰操纵面中标称化俯仰控制效率的绝对值最大的操纵面的俯仰控制效率同号,将所有俯仰操纵面对于虚拟升降舵的偏转范围[-Rm Rm]进行标称化,并按照标称化俯仰控制效率的绝对值由大到小排序,排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面为
Figure FDA00000695524800000414
(rj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure FDA00000695524800000415
为:
B &omega; &delta; &OverBar; r j = B &omega; &delta; r j R r j / R m B &omega; z &delta; r j B &omega; z &delta; ~ z &GreaterEqual; 0 - B &omega; &delta; r j R r j / R m B &omega; z &delta; r j B &omega; z &delta; ~ z < 0 , (j=1,2,…n3-1,n3)
Figure FDA00000695524800000417
分别表示标称化之前的俯仰操纵面
Figure FDA00000695524800000418
的控制效率矢量及俯仰控制效率,
Figure FDA00000695524800000419
表示虚拟升降舵的俯仰控制效率,俯仰操纵面
Figure FDA00000695524800000420
的偏转范围为 - R r j R r j , B &omega; &delta; &OverBar; r j = B &omega; x &delta; &OverBar; r j B &omega; y &delta; &OverBar; r j B &omega; z &delta; &OverBar; r j &prime; ,
Figure FDA00000695524800000423
分别表示标称化俯仰操纵面
Figure FDA00000695524800000424
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率;则标称化俯仰操纵面矢量 U &OverBar; R = u &OverBar; r 1 u &OverBar; r 2 . . . u &OverBar; r j . . . u &OverBar; r n 3 - 1 u &OverBar; r n 3 &prime; , 其中
Figure FDA00000695524800000426
(rj∈[1,2,…,n-1,n])表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面,标称化俯仰操纵面矢量的控制效率矩阵为 B &omega; &delta; &OverBar; R = B &omega; &delta; &OverBar; r 1 B &omega; &delta; &OverBar; r 2 . . . B &omega; &delta; &OverBar; r j . . . B &omega; &delta; &OverBar; r n 3 - 1 B &omega; &delta; &OverBar; r n 3 , 其中,表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,…n3-1,n3)个标称化俯仰操纵面
Figure FDA00000695524800000429
(rj∈[1,2,…,n-1,n])的标称化控制效率矢量;
步骤五:确定虚拟操纵面的主导控制效率:
虚拟副翼的主导控制效率为滚转控制效率
Figure FDA00000695524800000430
Figure FDA00000695524800000431
Figure FDA00000695524800000432
为虚拟副翼的滚转控制效率比例系数,
Figure FDA00000695524800000433
表示标称化滚转操纵面矢量
Figure FDA00000695524800000434
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure FDA00000695524800000435
的标称化滚转控制效率;
虚拟方向舵的主导控制效率为偏航控制效率
Figure FDA00000695524800000436
Figure FDA00000695524800000437
为虚拟方向舵的偏航控制效率比例系数,
Figure FDA00000695524800000439
表示标称化偏航操纵面矢量
Figure FDA00000695524800000440
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure FDA0000069552480000051
的标称化偏航控制效率;
虚拟升降舵的主导控制效率为俯仰控制效率
Figure FDA0000069552480000052
Figure FDA0000069552480000053
Figure FDA0000069552480000054
为虚拟升降舵的俯仰控制效率比例系数,
Figure FDA0000069552480000055
表示标称化俯仰操纵面矢量
Figure FDA0000069552480000056
中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面
Figure FDA0000069552480000057
的标称化俯仰控制效率;
步骤六:根据标称化控制效率将标称化操纵面划分成主、副、辅三级,设定标称化主操纵面与标称化副操纵面的权限系数,并计算主、副、辅各级标称化操纵面期望分担的主导控制效率:
(1)分别将标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的划分为主、副、辅三级:
Figure FDA0000069552480000058
表示标称化滚转操纵面矢量
Figure FDA0000069552480000059
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure FDA00000695524800000510
的标称化滚转控制效率,则确定标称化滚转主操纵面序号临界值nx1<n1,nx1是整数且满足:
&Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i &GreaterEqual; 0.5
确定标称化滚转副操纵面序号临界值nx2满足nx1<nx2≤n1,nx2是整数且满足:
&Sigma; j = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i )
将位于标称化滚转操纵面矢量
Figure FDA00000695524800000513
中前nx1个位置的操纵面划分为标称化滚转主操纵面;将位于标称化滚转操纵面矢量
Figure FDA00000695524800000514
中从(nx1+1)到nx2个位置的操纵面划分为标称化滚转副操纵面;将位于标称化滚转操纵面矢量
Figure FDA00000695524800000515
中从(nx2+1)到n1个位置的操纵面划分为标称化滚转辅操纵面;
Figure FDA00000695524800000516
表示标称化偏航操纵面矢量
Figure FDA00000695524800000517
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure FDA00000695524800000518
的标称化偏航控制效率,则标称化偏航主操纵面序号临界值ny1<n2,ny1是整数且满足:
&Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i &GreaterEqual; 0.5
则标称化偏航副操纵面序号临界值ny2满足ny1<ny2≤n2,ny2是整数且满足:
&Sigma; j = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i )
将位于标称化偏航操纵面矢量
Figure FDA00000695524800000521
中前ny1个位置的操纵面划分为标称化偏航主操纵面;将位于标称化偏航操纵面矢量
Figure FDA00000695524800000522
中从(ny1+1)到ny2个位置的操纵面划分为标称化偏航副操纵面;将位于标称化偏航操纵面矢量
Figure FDA00000695524800000523
中从(ny2+1)到n2个位置的操纵面划分为标称化偏航辅操纵面;
Figure FDA0000069552480000061
表示标称化俯仰操纵面矢量
Figure FDA0000069552480000062
中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面
Figure FDA0000069552480000063
的标称化俯仰控制效率,则标称化俯仰主操纵面序号临界值nz1<n3,nz1是整数且满足:
&Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i &GreaterEqual; 0.5
则标称化俯仰副操纵面序号临界值nz2满足nz1<nz2≤n3,nz2是整数且满足:
&Sigma; j = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i &GreaterEqual; 0.5 ( 1 - &Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i )
将位于标称化俯仰操纵面矢量
Figure FDA0000069552480000066
中前nz1个位置的操纵面划分为标称化俯仰主操纵面;将位于标称化俯仰操纵面矢量中从(nz1+1)到nz2个位置的操纵面划分为标称化俯仰副操纵面;将位于标称化俯仰操纵面矢量
Figure FDA0000069552480000068
中从(nz2+1)到n3个位置的操纵面划分为标称化俯仰辅操纵面;
(2)分别对标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面设定主、副权限系数,并计算标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的主、副、辅各级标称化操纵面期望分担的主导控制效率:
按照控制效率均衡分配的方法得到所有的标称化滚转主操纵面所分担的虚拟副翼的滚转控制效率的比率Cxm为:
C xm = &Sigma; j = 1 nx 1 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i
所有的标称化滚转副操纵面所分担的虚拟副翼的滚转控制效率的比率Cxs为:
C xs = &Sigma; j = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p j &Sigma; i = 1 n 1 B &omega; x &delta; &OverBar; p i
所有的标称化滚转辅操纵面所分担的虚拟副翼的滚转控制效率的比率Cxf为:
Cxf=1-Cxm-Cxs
标称化滚转主操纵面的权限系数为Qxm及标称化滚转副操纵面的权限系数为Qxs,则所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure FDA00000695524800000611
则所有的标称化滚转副操纵面期望分担的滚转控制效率
Figure FDA00000695524800000612
所有的标称化滚转辅操纵面期望分担的滚转控制效率 B &OverBar; &omega; x &delta; &OverBar; xf = B &omega; x &delta; ~ x ( 1 - Q xm C xm - Q xs C xs ) ;
按照控制效率均衡分配的方法,得到所有的标称化偏航主操纵面所分担的虚拟方向舵的偏航控制效率的比率Cym为:
C ym = &Sigma; j = 1 ny 1 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i
所有的标称化偏航副操纵面所分担的虚拟方向舵的偏航控制效率的比率Cys为:
C ys = &Sigma; j = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q j &Sigma; i = 1 n 2 B &omega; y &delta; &OverBar; q i
所有的标称化偏航辅操纵面所分担的虚拟方向舵的偏航控制效率的比率Cyf为:
Cyf=1-Cym-Cys
标称化偏航主操纵面的权限系数为Qym及标称化偏航副操纵面的权限系数为Qys,则所有的标称化偏航主操纵面期望分担的偏航控制效率
Figure FDA0000069552480000073
所有的标称化偏航副操纵面期望分担的偏航控制效率
Figure FDA0000069552480000074
所有的标称化偏航辅操纵面期望分担的偏航控制效率 B &OverBar; &omega; y &delta; &OverBar; yf = B &omega; y &delta; ~ y ( 1 - Q ym C ym - Q ys C ys ) ;
按照控制效率均衡分配的方法,得到所有的标称化俯仰主操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czm为:
C zm = &Sigma; j = 1 nz 1 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i
所有的标称化俯仰副操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czs为:
C zs = &Sigma; j = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r j &Sigma; i = 1 n 3 B &omega; z &delta; &OverBar; r i
所有的标称化俯仰辅操纵面所分担的虚拟升降舵的俯仰控制效率的比率Czf为:
Czf=1-Czm-Czs
标称化俯仰主操纵面的权限系数为Qzm,标称化俯仰副操纵面的权限系数为Qzs,所有的标称化俯仰主操纵面期望分担的俯仰控制效率
Figure FDA0000069552480000078
所有的标称化俯仰副操纵面期望分担的俯仰控制效率所有的标称化俯仰辅操纵面期望分担的俯仰控制效率 B &OverBar; &omega; z &delta; &OverBar; zf = B &omega; z &delta; ~ z ( 1 - Q zm C zm - Q zs C zs ) ;
步骤七:采用控制效率均衡分配的方法计算每个标称化操纵面期望分担的主导控制效率:
(1)计算每个标称化滚转操纵面期望分担的滚转控制效率:
采用控制效率均衡分配的方法将所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure FDA00000695524800000711
分配给每个标称化滚转主操纵面,则第j(j=1,2,…,nx1-1,nx1)个标称化滚转主操纵面
Figure FDA00000695524800000712
期望分担的滚转控制效率
Figure FDA00000695524800000713
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xm B &omega; x &delta; &OverBar; p j &Sigma; i = 1 nx 1 B &omega; x &delta; &OverBar; p i , (j=1,2,…,nx1-1,nx1)
采用控制效率均衡分配的方法将所有的标称化滚转副操纵面期望分担的滚转控制效率
Figure FDA0000069552480000082
分配给每个标称化滚转副操纵面,则第j(j=nx1+1,nx1+2,…,nx2-1,nx2)个标称化滚转副操纵面
Figure FDA0000069552480000083
期望分担的滚转控制效率
Figure FDA0000069552480000084
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xs B &omega; x &delta; &OverBar; p j &Sigma; i = nx 1 + 1 nx 2 B &omega; x &delta; &OverBar; p i , (j=nx1+1,nx1+2,…,nx2-1,nx2)
采用控制效率均衡分配的方法将所有的标称化滚转辅操纵面期望分担的滚转控制效率
Figure FDA0000069552480000086
分配每个标称化滚转辅操纵面,则第j(j=nx2+1,nx2+2,…,n1-1,n1)个标称化滚转辅操纵面期望分担的滚转控制效率
Figure FDA0000069552480000088
为:
B &OverBar; &omega; x &delta; &OverBar; p j = B &OverBar; &omega; x &delta; &OverBar; xf B &omega; x &delta; &OverBar; p j &Sigma; i = nx 2 + 1 n 1 B &omega; x &delta; &OverBar; p i , (j=nx2+1,nx2+2,…,n1-1,n1)
(2)计算每个标称化偏航操纵面期望分担的偏航控制效率:
采用控制效率均衡分配的方法将所有的标称化偏航主操纵面期望分担的偏航控制效率
Figure FDA00000695524800000810
分配给每个标称化偏航主操纵面,则第j(j=1,2,…,ny1-1,ny1)个标称化偏航主操纵面期望分担的偏航控制效率
Figure FDA00000695524800000812
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; ym B &omega; y &delta; &OverBar; q j &Sigma; i = 1 ny 1 B &omega; y &delta; &OverBar; q i , (j=1,2,…,ny1-1,ny1)
采用控制效率均衡分配的方法将所有的标称化偏航副操纵面期望分担的偏航控制效率
Figure FDA00000695524800000814
分配给每个标称化偏航副操纵面,则第j(j=ny1+1,ny1+2,…,ny2-1,ny2)个标称化偏航副操纵面
Figure FDA00000695524800000815
期望分担的偏航控制效率
Figure FDA00000695524800000816
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; ys B &omega; y &delta; &OverBar; q j &Sigma; i = ny 1 + 1 ny 2 B &omega; y &delta; &OverBar; q i , (j=ny1+1,ny1+2,…,ny2-1,ny2)
采用控制效率均衡分配的方法将所有的陈化偏航辅操纵面期望分担的偏航控制效率
Figure FDA00000695524800000818
分配给每个标称化偏航辅操纵面,则第j(j=ny2+1,ny2+2,…,n2-1,n2)个标称化偏航辅操纵面
Figure FDA00000695524800000819
期望分担的偏航控制效率
Figure FDA00000695524800000820
为:
B &OverBar; &omega; y &delta; &OverBar; q j = B &OverBar; &omega; y &delta; &OverBar; yf B &omega; y &delta; &OverBar; q j &Sigma; i = ny 2 + 1 n 2 B &omega; y &delta; &OverBar; q i , (j=ny2+1,ny2+2,…,n2-1,n2)
(3)计算每个标称化俯仰操纵面期望分担的俯仰控制效率:
采用均衡分配的方法将所有的标称化俯仰主操纵面期望分担的俯仰控制效率分配给每个标称化俯仰主操纵面,则第j(j=1,2,…,nz1-1,nz1)个标称化俯仰主操纵面
Figure FDA0000069552480000091
期望分担的俯仰控制效率
Figure FDA0000069552480000092
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zm B &omega; z &delta; &OverBar; r j &Sigma; i = 1 nz 1 B &omega; z &delta; &OverBar; r i , (j=1,2,…,nz1-1,nz1)
采用控制效率均衡分配的方法将所有的标称化俯仰副操纵面期望分担的俯仰控制效率分配给每个标称化俯仰副操纵面,则第j(j=nz1+1,nz1+2,…,nz2-1,nz2)个标称化俯仰副操纵面
Figure FDA0000069552480000095
期望分担的俯仰控制效率
Figure FDA0000069552480000096
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zs B &omega; z &delta; &OverBar; r j &Sigma; i = nz 1 + 1 nz 2 B &omega; z &delta; &OverBar; r i , (j=nz1+1,nz1+2,…,nz2-1,nz2)
采用控制效率均衡分配的方法将所有的标称化俯仰辅操纵面期望分担的俯仰控制效率
Figure FDA0000069552480000098
分配给每个标称化俯仰辅操纵面,则第j(j=nz2+1,nz2+2,…,n3-1,n3)个标称化俯仰辅操纵面
Figure FDA0000069552480000099
期望分担的俯仰控制效率
Figure FDA00000695524800000910
为:
B &OverBar; &omega; z &delta; &OverBar; r j = B &OverBar; &omega; z &delta; &OverBar; zf B &omega; z &delta; &OverBar; r j &Sigma; i = nz 2 + 1 n 3 B &omega; z &delta; &OverBar; r i , (j=nz2+1,nz2+2,…,n3-1,n3)
步骤八:计算所有真实操纵面的分配系数,建立加权均衡分配矩阵,求解虚拟操纵面矢量的控制效率矩阵中的非主导控制效率:
(1)计算所有真实操纵面的分配系数:
①计算每个滚转操纵面的分配系数:
由于第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面
Figure FDA00000695524800000912
与标称化之前的滚转操纵面
Figure FDA00000695524800000913
对应,标称化滚转操纵面期望分担的滚转控制效率为
Figure FDA00000695524800000915
滚转操纵面
Figure FDA00000695524800000916
的偏转范围为
Figure FDA00000695524800000917
滚转控制效率为
Figure FDA00000695524800000918
则虚拟副翼的偏转角
Figure FDA00000695524800000920
到滚转操纵面
Figure FDA00000695524800000921
的偏转角
Figure FDA00000695524800000922
的分配系数
Figure FDA00000695524800000923
为:
k p j = B &OverBar; &omega; x &delta; &OverBar; p j B &omega; x &delta; p j , (j=1,2,…,n1-1,n1)
从而得到滚转操纵面的分配系数矢量 K ^ x = k p 1 k p 2 . . . k p j . . . k p n 1 - 1 k p n 1 &prime; , 其中(j=1,2,…,n1-1,n1)表示虚拟副翼
Figure FDA00000695524800000927
的偏转角
Figure FDA00000695524800000928
到滚转操纵面
Figure FDA00000695524800000929
的偏转角
Figure FDA00000695524800000930
的分配系数;
②计算每个偏航操纵面的分配系数:
由于第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面
Figure FDA00000695524800000931
与标称化之前的偏航操纵面
Figure FDA00000695524800000932
对应,标称化偏航操纵面
Figure FDA00000695524800000933
期望分担的偏航控制效率为
Figure FDA00000695524800000934
偏航操纵面
Figure FDA00000695524800000935
的偏转范围为 - R q j R q j , 偏航控制效率为
Figure FDA00000695524800000937
则虚拟方向舵
Figure FDA00000695524800000938
的偏转角
Figure FDA00000695524800000939
到偏航操纵面
Figure FDA00000695524800000940
的偏转角
Figure FDA00000695524800000941
的分配系数为:
k q j = B &OverBar; &omega; y &delta; &OverBar; q j B &omega; y &delta; q j , (j=1,2,…,n2-1,n2)
从而得到偏航操纵面的分配系数矢量 K ^ y = k q 1 k q 2 . . . k q j . . . k q n 2 - 1 k q n 2 &prime; ; 其中,
Figure FDA0000069552480000103
(j=1,2,…,n2-1,n2)表示虚拟方向舵
Figure FDA0000069552480000104
的偏转角
Figure FDA0000069552480000105
到偏航操纵面
Figure FDA0000069552480000106
的偏转角
Figure FDA0000069552480000107
的分配系数;
③计算每个俯仰操纵面的分配系数:
由于第j(j=1,2,…,n3-1,n3)个标称化俯仰操纵面与标称化之前的俯仰操纵面
Figure FDA0000069552480000109
对应,标称化俯仰操纵面
Figure FDA00000695524800001010
期望分担的俯仰控制效率为
Figure FDA00000695524800001011
俯仰操纵面
Figure FDA00000695524800001012
的偏转范围为 - R r j R r j , 俯仰控制效率为
Figure FDA00000695524800001014
则虚拟升降舵
Figure FDA00000695524800001015
的偏转角
Figure FDA00000695524800001016
到俯仰操纵面
Figure FDA00000695524800001017
的偏转角
Figure FDA00000695524800001018
的分配系数为:
k r j = B &OverBar; &omega; z &delta; &OverBar; r j B &omega; z &delta; r j , (j=1,2,…,n3-1,n3)
从而得到俯仰操纵面的分配系数矢量 K ^ z = k r 1 k r 2 . . . k r j . . . k r n 3 - 1 k r n 3 &prime; , 其中
Figure FDA00000695524800001021
(j=1,2,…,n3-1,n3)表示虚拟升降舵
Figure FDA00000695524800001022
的偏转角
Figure FDA00000695524800001023
到俯仰操纵面
Figure FDA00000695524800001024
的偏转角
Figure FDA00000695524800001025
的分配系数;
(2)建立加权均衡分配矩阵,求解虚拟操纵面矢量的控制效率矩阵中的非主导控制效率,从而确定虚拟操纵面矢量的控制效率矩阵:
①虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵:
建立过渡操纵面矢量 U ^ = u p 1 . . . u p i . . . u p n 1 u q 1 . . . u q j . . . u q n 2 u r 1 . . . u r t . . . u r n 3 &prime; , 过渡操纵面的偏转角矢量 &delta; ^ = &delta; p 1 . . . &delta; p i . . . &delta; p n 1 &delta; q 1 . . . &delta; q j . . . &delta; q n 2 &delta; r 1 . . . &delta; r t . . . &delta; r n 3 &prime; , 过渡操纵面矢量的控制效率矩阵
B ^ = B &omega; &delta; p 1 . . . B &omega; &delta; p i . . . B &omega; &delta; p n 1 B &omega; &delta; q 1 . . . B &omega; &delta; q j . . . B &omega; &delta; q n 2 B &omega; &delta; r 1 . . . B &omega; &delta; r t . . . B &omega; &delta; r n 3
其中,
Figure FDA00000695524800001029
(i=1,2,…,n1-1,n1)分别表示滚转操纵面
Figure FDA00000695524800001030
的偏转角及控制效率矢量,
Figure FDA00000695524800001031
(j=1,2,…,n2-1,n2)分别表示偏航操纵面的偏转角及控制效率矢量,
Figure FDA00000695524800001033
(t=1,2,…,n3-1,n3)分别表示滚转操纵面
Figure FDA00000695524800001034
的偏转角及控制效率矢量,虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z &prime; 对应的虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; , 虚拟操纵面矢量的控制效率矩阵 B ~ = B &omega; &delta; ~ x B &omega; &delta; ~ y B &omega; &delta; ~ z &prime; , 其中,表示虚拟副翼的偏转角及控制效率矢量,
Figure FDA00000695524800001039
Figure FDA00000695524800001040
表示虚拟方向舵的偏转角及控制效率矢量,
Figure FDA00000695524800001041
分别表示虚拟升降舵的偏转角及控制效率矢量;则虚拟操纵面偏转角矢量到过渡操纵面偏转角矢量的传递关系为
Figure FDA00000695524800001042
其中,
Figure FDA00000695524800001043
表示虚拟操纵面矢量到过渡操纵面矢量的加权均衡分配矩阵:
K ^ = K ^ x 0 n 1 &times; 1 0 n 1 &times; 1 0 n 2 &times; 1 K ^ y 0 n 2 &times; 1 0 n 3 &times; 1 0 n 3 &times; 1 K ^ z
其中,
Figure FDA0000069552480000112
表示n1行1列的全零向量,
Figure FDA0000069552480000113
表示n2行1列的全零向量,
Figure FDA0000069552480000114
表示n3行1列的全零向量;
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足真实操纵面矢量U=[u1 u2 …ui …un-1 un]′,对应的真实操纵面的偏转角矢量δ=[δ1 δ2 …δi …δn-1 δn]′,真实操纵面的控制效率矩阵 B = B &omega; &delta; 1 B &omega; &delta; 2 . . . B &omega; &delta; i . . . B &omega; &delta; n - 1 B &omega; &delta; n &prime; , 其中δi
Figure FDA0000069552480000117
分别表示真实操纵面ui的偏转角、控制效率矢量,过渡操纵面矢量
Figure FDA0000069552480000118
的偏转角矢量
Figure FDA0000069552480000119
通过n行n列的转换矩阵T转化为真实操纵面矢量U的偏转角矢量δ,即
Figure FDA00000695524800001110
且过渡操纵面矢量控制效率矩阵转换矩阵T的第a行b列表示为T(a,b),对于所有的j=1,2,…,n1-1,n1,T(pj,j)=1;对于所有的j=1,2,…,n2-1,n2,T(qj,j+n1)=1;对于所有的j=1,2,…,n3-1,n3,T(rj,j+n1+n2)=1;矩阵T的所有其他元素都为0;
由于
Figure FDA00000695524800001112
从而得到真实操纵面偏转角矢量虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵
Figure FDA00000695524800001114
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure FDA00000695524800001115
过渡操纵面矢量控制效率矩阵与真实操纵面的控制效率矩阵满足虚拟操纵面控制效率矩阵
Figure FDA00000695524800001117
与真实操纵面的控制效率矩阵B满足
Figure FDA00000695524800001118
②由加权均衡分配矩阵计算虚拟操纵面的非主导控制效率,得到虚拟操纵面矢量的控制效率矩阵;
虚拟操纵面的控制效率矩阵
Figure FDA00000695524800001119
与过渡操纵面控制效率矩阵满足
Figure FDA00000695524800001121
其中过渡操纵面矢量的控制效率矩阵为:
B ^ = B &omega; x &delta; p 1 . . . B &omega; x &delta; p i . . . B &omega; x &delta; p n 1 B &omega; x &delta; q 1 . . . B &omega; x &delta; q j . . . B &omega; x &delta; q n 2 B &omega; x &delta; r 1 . . . B &omega; x &delta; r t . . . B &omega; x &delta; r n 3 B &omega; y &delta; p 1 . . . B &omega; y &delta; p i . . . B &omega; y &delta; p n 1 B &omega; y &delta; q 1 . . . B &omega; y &delta; q j . . . B &omega; y &delta; q n 2 B &omega; y &delta; r 1 . . . B &omega; y &delta; r t . . . B &omega; y &delta; r n 3 B &omega; z &delta; p 1 . . . B &omega; z &delta; p i . . . B &omega; z &delta; p n 1 B &omega; z &delta; q 1 . . . B &omega; z &delta; q j . . . B &omega; z &delta; q n 2 B &omega; z &delta; r 1 . . . B &omega; z &delta; r t . . . B &omega; z &delta; r n 3
其中,
Figure FDA00000695524800001123
分别表示滚转操纵面
Figure FDA00000695524800001124
(i=1,2,…,n1-1,n1)的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure FDA00000695524800001125
分别表示偏航操纵面
Figure FDA00000695524800001126
(j=1,2,…,n2-1,n2)的滚转控制效率、偏航控制效率及俯仰控制效率,分别表示俯仰操纵面
Figure FDA00000695524800001128
(t=1,2,…,n3-1,n3)的滚转控制效率、偏航控制效率及俯仰控制效率;
虚拟操纵面矢量的控制效率矩阵为:
B ~ = B &omega; x &delta; ~ x B &omega; x &delta; ~ y B &omega; x &delta; ~ z B &omega; y &delta; ~ x B &omega; y &delta; ~ y B &omega; y &delta; ~ z B &omega; z &delta; ~ x B &omega; z &delta; ~ y B &omega; z &delta; ~ z
其中,虚拟副翼的滚转控制效率虚拟方向舵的偏航控制效率
Figure FDA0000069552480000123
虚拟升降舵的俯仰控制效率
Figure FDA0000069552480000124
为主导控制效率,均由步骤五得出,进而确定虚拟操纵面的非主导控制效率:虚拟副翼的偏航控制效率
Figure FDA0000069552480000126
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure FDA0000069552480000127
的偏转角
Figure FDA0000069552480000128
到滚转操纵面的偏转角
Figure FDA00000695524800001210
的分配系数;虚拟副翼的俯仰控制效率
Figure FDA00000695524800001211
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure FDA00000695524800001213
的偏转角
Figure FDA00000695524800001214
到滚转操纵面
Figure FDA00000695524800001215
的偏转角
Figure FDA00000695524800001216
的分配系数;虚拟方向舵的滚转控制效率
Figure FDA00000695524800001217
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure FDA00000695524800001219
的偏转角到偏航操纵面
Figure FDA00000695524800001221
的偏转角
Figure FDA00000695524800001222
的分配系数;虚拟方向舵的俯仰控制效率
Figure FDA00000695524800001223
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure FDA00000695524800001225
的偏转角
Figure FDA00000695524800001226
到偏航操纵面
Figure FDA00000695524800001227
的偏转角
Figure FDA00000695524800001228
的分配系数;虚拟升降舵的滚转控制效率
Figure FDA00000695524800001229
Figure FDA00000695524800001230
(i=1,2,…,n3-1,n3)表示虚拟升降舵
Figure FDA00000695524800001231
的偏转角
Figure FDA00000695524800001232
到俯仰操纵面
Figure FDA00000695524800001233
的偏转角
Figure FDA00000695524800001234
的分配系数;虚拟升降舵的偏航控制效率
Figure FDA00000695524800001235
Figure FDA00000695524800001236
(i=1,2,…,n3-1,n3)表示虚拟升降舵
Figure FDA00000695524800001237
的偏转角
Figure FDA00000695524800001238
到俯仰操纵面的偏转角的分配系数。
2.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤五中的虚拟副翼的滚转控制效率比例系数
Figure FDA00000695524800001241
的取值为0.8~2.0。
3.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤五中的虚拟方向舵的偏航控制效率比例系数
Figure FDA00000695524800001242
的取值为0.8~2.0。
4.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤五中的虚拟升降舵的俯仰控制效率比例系数
Figure FDA00000695524800001243
的取值为0.8~2.0。
5.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤六中的标称化滚转主操纵面的权限系数为Qxm的取值为0.8~1.5,标称化滚转副操纵面的权限系数Qxs的取值为0.5~2.0之间。
6.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤六中的标称化偏航主操纵面的权限系数为Qym的取值为0.8~1.5,标称化偏航副操纵面的权限系数Qys的取值为0.5~2.0。
7.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤六中的标称化俯仰主操纵面的权限系数Qzm的取值为0.8~1.5,标称化俯仰副操纵面的权限系数Qzs的取值为0.5~2.0。
CN 201110165732 2011-06-20 2011-06-20 多操纵面飞机的一种均衡操纵分配方法 Expired - Fee Related CN102320378B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201110165732 CN102320378B (zh) 2011-06-20 2011-06-20 多操纵面飞机的一种均衡操纵分配方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201110165732 CN102320378B (zh) 2011-06-20 2011-06-20 多操纵面飞机的一种均衡操纵分配方法

Publications (2)

Publication Number Publication Date
CN102320378A true CN102320378A (zh) 2012-01-18
CN102320378B CN102320378B (zh) 2013-07-24

Family

ID=45448264

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201110165732 Expired - Fee Related CN102320378B (zh) 2011-06-20 2011-06-20 多操纵面飞机的一种均衡操纵分配方法

Country Status (1)

Country Link
CN (1) CN102320378B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104216417A (zh) * 2014-09-22 2014-12-17 北京航空航天大学 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法
CN104331084B (zh) * 2014-09-30 2017-05-03 中国运载火箭技术研究院 一种基于方向舵控滚转策略的气动舵偏范围计算方法
CN109270947A (zh) * 2018-12-13 2019-01-25 北京航空航天大学 倾转旋翼无人机飞行控制系统
CN110187634A (zh) * 2018-02-23 2019-08-30 北京京东尚科信息技术有限公司 飞行器的控制方法、装置和计算机可读存储介质
CN110398961A (zh) * 2019-07-09 2019-11-01 哈尔滨工程大学 一种气垫船航迹保持舵桨协同控制与分配方法
CN110411289A (zh) * 2019-06-13 2019-11-05 上海航天控制技术研究所 一种抑制强机弹干扰的分离稳定控制方法
CN112198817A (zh) * 2020-09-23 2021-01-08 深圳市领峰电动智能科技有限公司 无人机控制方法、装置、设备、无人机和介质

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106598056B (zh) * 2016-11-23 2019-05-17 中国人民解放军空军工程大学 一种提升固定翼飞机隐身性能的舵面优先级调节方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5791598A (en) * 1996-01-16 1998-08-11 Globalstar L.P. and Daimler-Benz Aerospace AG Dynamic bias for orbital yaw steering
CN101804862A (zh) * 2010-04-07 2010-08-18 南京航空航天大学 一种无人机推力变向装置及其控制方法
CN101833761A (zh) * 2010-04-20 2010-09-15 南京航空航天大学 基于合作目标特征线的无人机位姿估计方法
CN102073755A (zh) * 2010-11-10 2011-05-25 南京航空航天大学 近空间高超声速飞行器运动控制仿真方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5791598A (en) * 1996-01-16 1998-08-11 Globalstar L.P. and Daimler-Benz Aerospace AG Dynamic bias for orbital yaw steering
CN101804862A (zh) * 2010-04-07 2010-08-18 南京航空航天大学 一种无人机推力变向装置及其控制方法
CN101833761A (zh) * 2010-04-20 2010-09-15 南京航空航天大学 基于合作目标特征线的无人机位姿估计方法
CN102073755A (zh) * 2010-11-10 2011-05-25 南京航空航天大学 近空间高超声速飞行器运动控制仿真方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
余晓艇等: "无人机轮式着陆横侧向控制", 《系统仿真学报》 *

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104216417A (zh) * 2014-09-22 2014-12-17 北京航空航天大学 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法
CN104216417B (zh) * 2014-09-22 2017-09-12 北京航空航天大学 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法
CN104331084B (zh) * 2014-09-30 2017-05-03 中国运载火箭技术研究院 一种基于方向舵控滚转策略的气动舵偏范围计算方法
CN110187634A (zh) * 2018-02-23 2019-08-30 北京京东尚科信息技术有限公司 飞行器的控制方法、装置和计算机可读存储介质
CN109270947A (zh) * 2018-12-13 2019-01-25 北京航空航天大学 倾转旋翼无人机飞行控制系统
CN109270947B (zh) * 2018-12-13 2020-07-10 北京航空航天大学 倾转旋翼无人机飞行控制系统
CN110411289A (zh) * 2019-06-13 2019-11-05 上海航天控制技术研究所 一种抑制强机弹干扰的分离稳定控制方法
CN110411289B (zh) * 2019-06-13 2021-10-15 上海航天控制技术研究所 一种抑制强机弹干扰的分离稳定控制方法
CN110398961A (zh) * 2019-07-09 2019-11-01 哈尔滨工程大学 一种气垫船航迹保持舵桨协同控制与分配方法
CN112198817A (zh) * 2020-09-23 2021-01-08 深圳市领峰电动智能科技有限公司 无人机控制方法、装置、设备、无人机和介质
CN112198817B (zh) * 2020-09-23 2022-07-12 峰飞航空科技(昆山)有限公司 无人机控制方法、装置、设备、无人机和介质

Also Published As

Publication number Publication date
CN102320378B (zh) 2013-07-24

Similar Documents

Publication Publication Date Title
CN102320378B (zh) 多操纵面飞机的一种均衡操纵分配方法
CN103488814B (zh) 一种适用于再入飞行器姿态控制的闭环仿真系统
Usta et al. Aircraft roll control system using LQR and fuzzy logic controller
CN104635741B (zh) 可重复使用运载器再入姿态控制方法
CN106874617B (zh) 一种高效的直升机机动飞行品质等级评估方法
CN104216417A (zh) 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法
CN104331084B (zh) 一种基于方向舵控滚转策略的气动舵偏范围计算方法
CN110347170A (zh) 可重复使用运载器再入段鲁棒容错制导系统及工作方法
CN114942649B (zh) 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法
Akyazı et al. A self-tuning fuzzy logic controller for aircraft roll control system
CN112487551A (zh) 一种飞翼无人机多舵面链式直接控制分配与重构方法
CN105173051A (zh) 一种平流层飞艇的制导控制一体化及控制分配方法
Acheson et al. Examination of unified control incorporating generalized control allocation
CN108919827A (zh) 一种推力矢量飞行器控制的双次优化快速分配方法
CN102692928B (zh) 基于飞行器四元数模型的控制器区域设计方法
CN111897219A (zh) 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法
Sadien et al. A detailed comparison of control allocation techniques on a realistic on-ground aircraft benchmark
Yu et al. Predefined-time fault-tolerant attitude control for tailless aircraft considering actuator input saturation
Movahhed et al. Output tracking of a 6-DOF flying wing UAV in longitudinal motion using LQR optimized sliding mode control with integral action
CN112009669A (zh) 一种基于空气舵的飞行器的减速方法及装置
Reinhardt et al. Nonlinear model predictive attitude control for fixed-wing unmanned aerial vehicle based on a wind frame formulation
McIntosh et al. A Switching-Free Control Architecture for Transition Maneuvers of a Quadrotor Biplane Tailsitter
CN114771807A (zh) 一种飞机多操纵面协调控制管理系统
Zhang et al. Fault tolerant tracking control for quad-rotor helicopter via robust adaptive technique
Timchenko et al. Robust-optimal control system of quadrocopter for maritime traffic's monitoring

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: 20130724

Termination date: 20140620

EXPY Termination of patent right or utility model