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

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

Info

Publication number
CN102320378B
CN102320378B CN 201110165732 CN201110165732A CN102320378B CN 102320378 B CN102320378 B CN 102320378B CN 201110165732 CN201110165732 CN 201110165732 CN 201110165732 A CN201110165732 A CN 201110165732A CN 102320378 B CN102320378 B CN 102320378B
Authority
CN
China
Prior art keywords
delta
omega
nominal
overbar
controlsurface
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.)
Expired - Fee Related
Application number
CN 201110165732
Other languages
English (en)
Other versions
CN102320378A (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];
Figure BDA0000069552490000029
表示虚拟升降舵,虚拟升降舵偏转范围为[-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,计算得到期望的力矩矢量其中 V ‾ = v ‾ x v ‾ y v ‾ z ′ ; 虚拟操纵面矢量
Figure BDA0000069552490000038
根据虚拟操纵面矢量的控制效率矩阵
Figure BDA0000069552490000039
计算得到力矩矢量为
Figure BDA00000695524900000310
虚拟操纵面矢量产生与真实操纵面矢量相同的力矩矢量 V ‾ = v ‾ x v ‾ y v ‾ z ′ ; 其中
Figure BDA00000695524900000312
Figure BDA00000695524900000313
分别表示期望的滚转力矩、期望的偏航力矩、期望的俯仰力矩;
步骤二:确定对真实操纵面进行标称化及控制效率加权均衡分配的基本方法:
定义真实操纵面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转动方向的控制等效,虚拟操纵面的偏转角为虚拟操纵面在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
标称化操纵面(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
到真实操纵面(j=1,2,…,m-1,m)的偏转角
Figure BDA0000069552490000048
的分配系数:
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 BDA00000695524900000411
及俯仰控制效率
Figure BDA00000695524900000412
则将其划分为滚转操纵面,其主导控制效率为滚转控制效率,该真实操纵面与虚拟副翼相对应;
若真实操纵面ui(i=1,2,…,n-1,n)满足偏航控制效率
Figure BDA00000695524900000413
大于滚转控制效率
Figure BDA00000695524900000414
及俯仰控制效率
Figure BDA00000695524900000415
则将其划分为偏航操纵面,其主导控制效率为偏航控制效率,该真实操纵面与虚拟方向舵相对应;
若真实操纵面ui(i=1,2,…,n-1,n)满足俯仰控制效率
Figure BDA00000695524900000416
大于滚转控制效率
Figure BDA00000695524900000417
及偏航控制效率
Figure BDA00000695524900000418
则将其划分为俯仰操纵面,其主导控制效率为俯仰控制效率,该真实操纵面与虚拟升降舵相对应;
滚转操纵面的数目计为n1,偏航操纵面的数目计为n2,俯仰操纵面的数目计为n3,n1+n2+n3=n;
步骤四:分别将滚转操纵面、偏航操纵面、俯仰操纵面对于所对应的虚拟操纵面的偏转范围进行标称化,并按照标称化控制效率的绝对值排序:
确定虚拟副翼的滚转控制效率与所有滚转操纵面中标称化滚转控制效率的绝对值最大的操纵面的滚转控制效率同号。将所有滚转操纵面对于虚拟副翼的偏转范围[-Rk Rk]进行标称化,并按照标称化滚转控制效率由大到小排序,排序中第j(j=1,2,…,n1-1,n1)个标称化滚转操纵面为(pj∈[1,2,…,n-1,n]),其标称化控制效率矢量
Figure BDA00000695524900000420
为:
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
的控制效率矢量及滚转控制效率,
Figure BDA00000695524900000424
表示虚拟副翼的滚转控制效率,滚转操纵面
Figure BDA00000695524900000425
的偏转范围为 - 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
分别表示标称化滚转操纵面
Figure BDA00000695524900000429
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化滚转操纵面矢量 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 BDA0000069552490000052
(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 BDA0000069552490000055
(pj∈[1,2,…,n-1,n])的标称化控制效率矢量;
确定虚拟方向舵的偏航控制效率与所有偏航操纵面中标称化偏航控制效率的绝对值最大的操纵面的偏航控制效率同号。将所有偏航操纵面对于虚拟方向舵的偏转范围[-Rl Rl]进行标称化,并按照标称化偏航控制效率的绝对值由大到小排序,排序中第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面为(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)个标称化偏航操纵面(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 BDA0000069552490000066
Figure BDA0000069552490000067
Figure BDA0000069552490000068
为虚拟副翼的滚转控制效率比例系数,表示标称化滚转操纵面矢量
Figure BDA00000695524900000610
中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面
Figure BDA00000695524900000611
的标称化滚转控制效率;
虚拟方向舵的主导控制效率为偏航控制效率
Figure BDA00000695524900000613
Figure BDA00000695524900000614
为虚拟方向舵的偏航控制效率比例系数,
Figure BDA00000695524900000615
表示标称化偏航操纵面矢量
Figure BDA00000695524900000616
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure BDA00000695524900000617
的标称化偏航控制效率;
虚拟升降舵的主导控制效率为俯仰控制效率
Figure BDA00000695524900000618
Figure BDA00000695524900000619
Figure BDA00000695524900000620
为虚拟升降舵的俯仰控制效率比例系数,表示标称化俯仰操纵面矢量
Figure BDA00000695524900000622
中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面的标称化俯仰控制效率;
步骤六:根据标称化控制效率将标称化操纵面划分成主、副、辅三级,设定标称化主操纵面与标称化副操纵面的权限系数,并计算主、副、辅各级标称化操纵面期望分担的主导控制效率:
(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个位置的操纵面划分为标称化滚转副操纵面;将位于标称化滚转操纵面矢量
Figure BDA0000069552490000071
中从(nx2+1)到n1个位置的操纵面划分为标称化滚转辅操纵面;
Figure BDA0000069552490000072
表示标称化偏航操纵面矢量
Figure BDA0000069552490000073
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure BDA0000069552490000074
的标称化偏航控制效率,则标称化偏航主操纵面序号临界值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个位置的操纵面划分为标称化偏航副操纵面;将位于标称化偏航操纵面矢量
Figure BDA0000069552490000079
中从(ny2+1)到n2个位置的操纵面划分为标称化偏航辅操纵面;
表示标称化俯仰操纵面矢量
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个位置的操纵面划分为标称化俯仰主操纵面;将位于标称化俯仰操纵面矢量中从(nz1+1)到nz2个位置的操纵面划分为标称化俯仰副操纵面;将位于标称化俯仰操纵面矢量
Figure BDA00000695524900000717
中从(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 BDA0000069552490000088
所有的标称化偏航副操纵面期望分担的偏航控制效率
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
所有的标称化俯仰副操纵面期望分担的俯仰控制效率所有的标称化俯仰辅操纵面期望分担的俯仰控制效率 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 BDA0000069552490000097
期望分担的滚转控制效率
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)
采用控制效率均衡分配的方法将所有的标称化滚转副操纵面期望分担的滚转控制效率
Figure BDA00000695524900000910
分配给每个标称化滚转副操纵面,则第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 BDA00000695524900000915
期望分担的滚转控制效率
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
期望分担的偏航控制效率为:
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
期望分担的偏航控制效率为:
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 BDA0000069552490000109
分配给每个标称化偏航辅操纵面,则第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 BDA00000695524900001110
则虚拟副翼
Figure BDA00000695524900001111
的偏转角
Figure BDA00000695524900001112
到滚转操纵面
Figure BDA00000695524900001113
的偏转角
Figure BDA00000695524900001114
的分配系数为:
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 BDA00000695524900001119
的偏转角
Figure BDA00000695524900001120
到滚转操纵面
Figure BDA00000695524900001121
的偏转角
Figure BDA00000695524900001122
的分配系数;
②计算每个偏航操纵面的分配系数:
由于第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面与标称化之前的偏航操纵面
Figure BDA00000695524900001124
对应,标称化偏航操纵面
Figure BDA00000695524900001125
期望分担的偏航控制效率为
Figure BDA00000695524900001126
偏航操纵面
Figure BDA00000695524900001127
的偏转范围为 - R q j R q j , 偏航控制效率为
Figure BDA00000695524900001129
则虚拟方向舵的偏转角
Figure BDA00000695524900001131
到偏航操纵面
Figure BDA00000695524900001132
的偏转角的分配系数为:
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 BDA00000695524900001137
的偏转角
Figure BDA00000695524900001138
到偏航操纵面
Figure BDA00000695524900001139
的偏转角的分配系数;
③计算每个俯仰操纵面的分配系数:
由于第j(j=1,2,…,n3-1,n3)个标称化俯仰操纵面
Figure BDA00000695524900001141
与标称化之前的俯仰操纵面
Figure BDA00000695524900001142
对应,标称化俯仰操纵面
Figure BDA00000695524900001143
期望分担的俯仰控制效率为
Figure BDA00000695524900001144
俯仰操纵面
Figure BDA00000695524900001145
的偏转范围为 - R r j R r j , 俯仰控制效率为
Figure BDA00000695524900001147
则虚拟升降舵
Figure BDA00000695524900001148
的偏转角
Figure BDA00000695524900001149
到俯仰操纵面的偏转角的分配系数为:
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
的偏转角
Figure BDA0000069552490000127
的分配系数;
(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 BDA00000695524900001211
(i=1,2,…,n1-1,n1)分别表示滚转操纵面
Figure BDA00000695524900001212
的偏转角及控制效率矢量,
Figure BDA00000695524900001213
(j=1,2,…,n2-1,n2)分别表示偏航操纵面
Figure BDA00000695524900001214
的偏转角及控制效率矢量,
Figure BDA00000695524900001215
(t=1,2,…,n3-1,n3)分别表示滚转操纵面的偏转角及控制效率矢量,虚拟操纵面矢量 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 BDA00000695524900001223
分别表示虚拟升降舵的偏转角及控制效率矢量;则虚拟操纵面偏转角矢量到过渡操纵面偏转角矢量的传递关系为
Figure BDA00000695524900001224
其中,
Figure BDA00000695524900001225
表示虚拟操纵面矢量到过渡操纵面矢量的加权均衡分配矩阵:
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列的全零向量,
Figure BDA00000695524900001228
表示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 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 BDA0000069552490000133
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure BDA0000069552490000134
过渡操纵面矢量控制效率矩阵与真实操纵面的控制效率矩阵满足
Figure BDA0000069552490000135
虚拟操纵面控制效率矩阵
Figure BDA0000069552490000136
与真实操纵面的控制效率矩阵B满足
Figure BDA0000069552490000137
②由加权均衡分配矩阵计算虚拟操纵面的非主导控制效率,得到虚拟操纵面矢量的控制效率矩阵;
虚拟操纵面的控制效率矩阵
Figure BDA0000069552490000138
与过渡操纵面控制效率矩阵
Figure BDA0000069552490000139
满足
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 BDA00000695524900001321
为主导控制效率,均由步骤五得出。进而确定虚拟操纵面的非主导控制效率:虚拟副翼的偏航控制效率
Figure BDA00000695524900001322
Figure BDA00000695524900001323
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900001324
的偏转角
Figure BDA00000695524900001325
到滚转操纵面
Figure BDA00000695524900001326
的偏转角
Figure BDA00000695524900001327
的分配系数;虚拟副翼的俯仰控制效率
Figure BDA00000695524900001328
Figure BDA00000695524900001329
(i=1,2,…,n1-1,n1)表示虚拟副翼的偏转角
Figure BDA00000695524900001331
到滚转操纵面
Figure BDA00000695524900001332
的偏转角
Figure BDA00000695524900001333
的分配系数;虚拟方向舵的滚转控制效率
Figure BDA00000695524900001334
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900001336
的偏转角
Figure BDA00000695524900001337
到偏航操纵面
Figure BDA00000695524900001338
的偏转角
Figure BDA00000695524900001339
的分配系数;虚拟方向舵的俯仰控制效率
Figure BDA00000695524900001340
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900001342
的偏转角
Figure BDA00000695524900001343
到偏航操纵面
Figure BDA00000695524900001344
的偏转角
Figure BDA00000695524900001345
的分配系数;虚拟升降舵的滚转控制效率
Figure BDA00000695524900001346
(i=1,2,…,n3-1,n3)表示虚拟升降舵的偏转角
Figure BDA0000069552490000141
到俯仰操纵面
Figure BDA0000069552490000142
的偏转角的分配系数;虚拟升降舵的偏航控制效率
Figure BDA0000069552490000144
Figure BDA0000069552490000145
(i=1,2,…,n3-1,n3)表示虚拟升降舵
Figure BDA0000069552490000146
的偏转角
Figure BDA0000069552490000147
到俯仰操纵面
Figure BDA0000069552490000148
的偏转角的分配系数。
本发明具有的优点在于:
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
分别表示期望的滚转力矩、期望的偏航力矩、期望的俯仰力矩,求解真实操纵面偏转角矢量δ,使得满足
Figure BDA0000069552490000157
并满足约束-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 BDA00000695524900001518
为虚拟副翼的偏航控制效率,
Figure BDA00000695524900001519
为虚拟副翼的俯仰控制效率,
Figure BDA00000695524900001520
为虚拟方向舵的滚转控制效率,
Figure BDA00000695524900001521
为虚拟方向舵的偏航控制效率,
Figure BDA00000695524900001522
为虚拟方向舵的俯仰控制效率,
Figure BDA00000695524900001523
为虚拟升降舵的滚转控制效率,
Figure BDA00000695524900001524
为虚拟升降舵的偏航控制效率,
Figure BDA00000695524900001525
为虚拟升降舵的俯仰控制效率。
控制分配目的是综合考虑操纵面偏转范围、控制效率、控制级别、权限系数来设计加权均衡分配矩阵K,使得真实操纵面的偏转角矢量δ与虚拟操纵面偏转角矢量满足关系
Figure BDA00000695524900001527
且虚拟操纵面矢量控制的效率矩阵满足
Figure BDA00000695524900001528
图1表明了虚拟操纵面与真实操纵面等效控制的物理意义,控制器根据驾驶员的驾驶指令或者是自动驾驶仪期望的轨迹、姿态指令Cmd及飞机当前状态矢量X计算虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; . 从真实操纵面矢量U来看,根据加权均衡矩阵K计算真实操纵面偏转角矢量
Figure BDA00000695524900001530
真实操纵面偏转角矢量根据真实操纵面矢量的控制效率矩阵B,计算得到期望的力矩矢量
Figure BDA00000695524900001531
其中 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; ,
Figure BDA00000695524900001533
分别表示期望的滚转力矩、期望的偏航力矩及期望的俯仰力矩。从虚拟操纵面矢量
Figure BDA00000695524900001534
来看,图1中的虚线框内的加权均衡矩阵K与真实操纵面矢量的控制效率矩阵B组合成虚拟操纵面矢量的控制效率矩阵因而,虚拟操纵面矢量
Figure BDA00000695524900001536
根据虚线框的虚拟操纵面矢量的控制效率矩阵
Figure BDA00000695524900001537
计算得到力矩矢量为即虚拟操纵面矢量产生与真实操纵面矢量相同的力矩矢量 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的绝对值。真实操纵面的控制效率矢量体现了单位偏转角所产生的滚转控制效率、偏航控制效率及俯仰控制效率的大小,而不同真实操纵面的偏转范围不同,因此控制效率不能体现该真实操纵面提供控制效率所产生的饱和度,需要将真实操纵面的控制效率按照其偏转范围进行统一。
将控制效率矢量为偏转范围为[-Ri Ri]的真实操纵面ui(i=1,2,…,n-1,n)对于偏转范围[-Rj  Rj]进行标称化,得到标称化滚转控制效率的绝对值、标称化偏航控制效率的绝对值、标称化俯仰控制效率的绝对值分别为
Figure BDA0000069552490000164
其中函数fabs(x)表示小数x的绝对值。
设n个真实操纵面中有m个真实操纵面
Figure BDA0000069552490000165
是属于A转动方向(代表滚转转动方向、偏航转动方向或者俯仰转动方向)的操纵面,其中tj∈[1,2,…,n-1,n],且j=1,2,…,m-1,m。真实操纵面(j=1,2,…,m-1,m)偏转角
Figure BDA0000069552490000167
偏转范围分别为
Figure BDA0000069552490000168
控制效率矢量为
Figure BDA0000069552490000169
且在A转动方向的控制效率为设某虚拟操纵面
Figure BDA00000695524900001611
与m个真实操纵面在A转动方向的控制等效,虚拟操纵面的偏转角为
Figure BDA00000695524900001612
虚拟操纵面在A转动方向的控制效率为
Figure BDA00000695524900001613
偏转角的偏转范围为[-Rh Rh]。由于不同的真实操纵面在A转动方向的控制效率可能与虚拟操纵面在A转动方向的控制效率同号或者反号,因此,真实操纵面
Figure BDA00000695524900001614
(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 BDA00000695524900001622
按照标称化操纵面的控制效率来分担虚拟操纵面在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 BDA0000069552490000173
到真实操纵面
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
大于滚转控制效率
Figure BDA00000695524900001711
及俯仰控制效率
Figure BDA00000695524900001712
则将其划分为偏航操纵面,其主导控制效率为偏航控制效率,该真实操纵面与虚拟方向舵相对应。
如果某个真实操纵面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
表示虚拟副翼的滚转控制效率,滚转操纵面
Figure BDA00000695524900001722
的偏转范围为 - 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 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 , 其中
Figure BDA0000069552490000186
表示按照标称化滚转控制效率的绝对值排序中第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 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 BDA0000069552490000192
的控制效率矢量及俯仰控制效率,
Figure BDA0000069552490000193
表示虚拟升降舵的俯仰控制效率,俯仰操纵面
Figure BDA0000069552490000194
的偏转范围为 - 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 BDA0000069552490000199
与真实操纵面对应。则标称化俯仰操纵面矢量 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; ,
其中(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 BDA00000695524900001915
(rj∈[1,2,…,n-1,n])的标称化控制效率矢量。
步骤五:确定虚拟操纵面的主导控制效率。
虚拟副翼的主导控制效率为滚转控制效率
Figure BDA00000695524900001916
Figure BDA00000695524900001917
为虚拟副翼的滚转控制效率比例系数,考虑到飞行控制系统的稳定性,一般选取
Figure BDA00000695524900001919
在0.8~2.0之间,
Figure BDA00000695524900001920
表示标称化滚转操纵面矢量中第j(j=1,2,…,n1-1,n1)的标称化滚转操纵面的标称化滚转控制效率。虚拟副翼的滚转控制效率等于所有的标称化滚转操纵面期望分担的滚转控制效率。虚拟方向舵的主导控制效率为偏航控制效率
Figure BDA00000695524900001923
Figure BDA00000695524900001924
Figure BDA00000695524900001925
为虚拟方向舵的偏航控制效率比例系数,考虑到飞行控制系统的稳定性,一般选取
Figure BDA00000695524900001926
在0.8~2.0之间,表示标称化偏航操纵面矢量
Figure BDA00000695524900001928
中第j(j=1,2,…,n2-1,n2)的标称化偏航操纵面
Figure BDA00000695524900001929
的标称化偏航控制效率。虚拟方向舵的偏航控制效率等于所有的标称化偏航操纵面期望分担的偏航控制效率。
虚拟升降舵的主导控制效率为俯仰控制效率
Figure BDA00000695524900001930
Figure BDA00000695524900001931
Figure BDA00000695524900001932
为虚拟升降舵的俯仰控制效率比例系数,考虑到飞行控制系统的稳定性,一般选取
Figure BDA00000695524900001933
在0.8~2.0之间,
Figure BDA00000695524900001934
表示标称化俯仰操纵面矢量中第j(j=1,2,…,n3-1,n3)的标称化俯仰操纵面
Figure BDA00000695524900001936
的标称化俯仰控制效率。虚拟升降舵的俯仰控制效率等于所有的标称化俯仰操纵面期望分担的俯仰控制效率。
步骤六:根据标称化控制效率将标称化操纵面划分成主、副、辅三级,设定标称化主操纵面与标称化副操纵面的权限系数,并计算主、副、辅各级标称化操纵面期望分担的主导控制效率。
(1)分别将标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的划分为主、副、辅三级。
Figure BDA00000695524900001937
表示标称化滚转操纵面矢量中第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
表示标称化俯仰操纵面矢量中第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之间。则所有的标称化滚转主操纵面期望分担的滚转控制效率则所有的标称化滚转副操纵面期望分担的滚转控制效率所有的标称化滚转辅操纵面期望分担的滚转控制效率
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 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所示,采用控制效率均衡分配的方法将所有的标称化滚转副操纵面期望分担的滚转控制效率
Figure BDA0000069552490000235
分配给每个标称化滚转副操纵面,则第j(j=nx1+1,nx1+2,…,nx2-1,nx2)个标称化滚转副操纵面
Figure BDA0000069552490000236
期望分担的滚转控制效率为:
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 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 BDA00000695524900002315
为:
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 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
期望分担的偏航控制效率
Figure BDA00000695524900002323
为:
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 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)
采用控制效率均衡分配的方法将所有的标称化俯仰副操纵面期望分担的俯仰控制效率分配给每个标称化俯仰副操纵面,则第j(j=nz1+1,nz1+2,…,nz2-1,nz2)个标称化俯仰副操纵面
Figure BDA0000069552490000247
期望分担的俯仰控制效率为:
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 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 BDA00000695524900002415
对应,标称化滚转操纵面
Figure BDA00000695524900002416
期望分担的滚转控制效率为
Figure BDA00000695524900002417
滚转操纵面
Figure BDA00000695524900002418
的偏转范围为
Figure BDA00000695524900002419
滚转控制效率为
Figure BDA00000695524900002420
则虚拟副翼
Figure BDA00000695524900002421
的偏转角
Figure BDA00000695524900002422
到滚转操纵面的偏转角的分配系数
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; , 其中(j=1,2,…,n1-1,n1)表示虚拟副翼的偏转角
Figure BDA00000695524900002430
到滚转操纵面
Figure BDA00000695524900002431
的偏转角的分配系数。图3给出了根据虚拟副翼的滚转控制效率比例系数
Figure BDA0000069552490000251
按照控制效率均衡分配的方法得到所有的标称化滚转主操纵面所分担的虚拟副翼的滚转控制效率的比率Cxm、按照控制效率均衡分配的方法得到的所有的标称化滚转副操纵面所分担的虚拟副翼的滚转控制效率的比率Cxs、标称化滚转主操纵面的权限系数Qxm、标称化滚转副操纵面的权限系数Qxs计算滚转操纵面的分配系数矢量的过程。
②计算每个偏航操纵面的分配系数:
由于第j(j=1,2,…,n2-1,n2)个标称化偏航操纵面
Figure BDA0000069552490000252
与标称化之前的偏航操纵面
Figure BDA0000069552490000253
对应,标称化偏航操纵面
Figure BDA0000069552490000254
期望分担的偏航控制效率为
Figure BDA0000069552490000255
偏航操纵面的偏转范围为 - R q j R q j , 偏航控制效率为
Figure BDA0000069552490000258
则虚拟方向舵
Figure BDA0000069552490000259
的偏转角
Figure BDA00000695524900002510
到偏航操纵面
Figure BDA00000695524900002511
的偏转角
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 BDA00000695524900002521
对应,标称化俯仰操纵面
Figure BDA00000695524900002522
期望分担的俯仰控制效率为俯仰操纵面
Figure BDA00000695524900002524
的偏转范围为
Figure BDA00000695524900002525
俯仰控制效率为
Figure BDA00000695524900002526
则虚拟升降舵
Figure BDA00000695524900002527
的偏转角
Figure BDA00000695524900002528
到俯仰操纵面的偏转角
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 BDA00000695524900002535
到俯仰操纵面
Figure BDA00000695524900002536
的偏转角
Figure BDA00000695524900002537
的分配系数。
(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
的偏转角及控制效率矢量,
Figure BDA0000069552490000261
(j=1,2,…,n2-1,n2)分别表示偏航操纵面
Figure BDA0000069552490000262
的偏转角及控制效率矢量,(t=1,2,…,n3-1,n3)分别表示滚转操纵面的偏转角及控制效率矢量。虚拟操纵面矢量 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列的全零向量,表示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
Figure BDA00000695524900002620
分别表示真实操纵面ui的偏转角、控制效率矢量。过渡操纵面矢量的偏转角矢量
Figure BDA00000695524900002622
可以通过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 BDA00000695524900002627
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure BDA00000695524900002628
过渡操纵面矢量控制效率矩阵与真实操纵面的控制效率矩阵满足可知虚拟操纵面的控制效率矩阵
Figure BDA00000695524900002630
与真实操纵面的控制矩阵B满足
Figure BDA00000695524900002631
可见,通过求解加权均衡分配矩阵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 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 BDA0000069552490000279
虚拟方向舵的偏航控制效率
Figure BDA00000695524900002710
虚拟升降舵的俯仰控制效率
Figure BDA00000695524900002711
为主导控制效率,均由步骤五确定。可以确定虚拟操纵面的非主导控制效率:虚拟副翼的偏航控制效率
Figure BDA00000695524900002712
Figure BDA00000695524900002713
(i=1,2,…,n1-1,n1)表示虚拟副翼的偏转角
Figure BDA00000695524900002715
到滚转操纵面的偏转角
Figure BDA00000695524900002717
的分配系数;虚拟副翼的俯仰控制效率
Figure BDA00000695524900002719
(i=1,2,…,n1-1,n1)表示虚拟副翼
Figure BDA00000695524900002720
的偏转角
Figure BDA00000695524900002721
到滚转操纵面的偏转角
Figure BDA00000695524900002723
的分配系数;虚拟方向舵的滚转控制效率
Figure BDA00000695524900002724
Figure BDA00000695524900002725
(i=1,2,…,n2-1,n2)表示虚拟方向舵
Figure BDA00000695524900002726
的偏转角到偏航操纵面
Figure BDA00000695524900002728
的偏转角
Figure BDA00000695524900002729
的分配系数;虚拟方向舵的俯仰控制效率
Figure BDA00000695524900002731
(i=1,2,…,n2-1,n2)表示虚拟方向舵的偏转角
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 BDA00000695524900002744
的偏转角
Figure BDA00000695524900002745
到俯仰操纵面
Figure BDA00000695524900002746
的偏转角
Figure BDA00000695524900002747
的分配系数。
根据虚拟操纵面矢量的控制效率矩阵来设计控制律,且控制律输出平稳变化的虚拟操纵面偏转角指令,避免了控制律输出期望力矩、复杂优化及偏转角速率过大的问题。

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 , 其中, B &omega; &delta; i ( 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; , 分别表示第i个真实操纵面ui的滚转控制效率、偏航控制效率、俯仰控制效率,且第i个真实操纵面ui(i=1,2,...,n-1,n)的偏转角δi的偏转范围为[-Ri,Ri],角速率
Figure FDA00002921133700015
限制为[-ρii];
建立虚拟操纵面矢量 U ~ = u ~ x u ~ y u ~ z &prime; , 其中,表示虚拟副翼,虚拟副翼偏转范围为[-Rk Rk];
Figure FDA00002921133700018
表示虚拟方向舵,虚拟方向舵偏转范围为[-Rl Rl];表示虚拟升降舵,虚拟升降舵偏转范围为[-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 FDA000029211337000113
为虚拟副翼的滚转控制效率,
Figure FDA000029211337000114
为虚拟副翼的偏航控制效率,为虚拟副翼的俯仰控制效率,
Figure FDA000029211337000116
为虚拟方向舵的滚转控制效率,
Figure FDA000029211337000117
为虚拟方向舵的偏航控制效率,
Figure FDA000029211337000118
为虚拟方向舵的俯仰控制效率,
Figure FDA000029211337000119
为虚拟升降舵的滚转控制效率,
Figure FDA000029211337000120
为虚拟升降舵的偏航控制效率,为虚拟升降舵的俯仰控制效率;
真实操纵面的偏转角矢量δ与虚拟操纵面偏转角矢量
Figure FDA000029211337000122
满足关系
Figure FDA000029211337000123
K为加权均衡分配矩阵,且虚拟操纵面矢量的控制效率矩阵满足
Figure FDA000029211337000124
控制器根据驾驶员的驾驶指令或自动驾驶仪期望的轨迹、姿态指令Cmd及飞机当前状态矢量X计算虚拟操纵面偏转角矢量 &delta; ~ = &delta; ~ x &delta; ~ y &delta; ~ z &prime; ; 根据加权均衡分配矩阵K计算真实操纵面偏转角矢量
Figure FDA000029211337000126
真实操纵面偏转角矢量根据真实操纵面矢量的控制效率矩阵B,计算得到期望的力矩矢量
Figure FDA000029211337000127
其中 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; ; 虚拟操纵面偏转角矢量
Figure FDA000029211337000129
根据虚拟操纵面矢量的控制效率矩阵
Figure FDA000029211337000130
,计算得到力矩矢量为
Figure FDA000029211337000131
虚拟操纵面矢量产生与真实操纵面矢量相同的力矩矢量 V &OverBar; = v &OverBar; x v &OverBar; y v &OverBar; z &prime; ; 其中
Figure FDA000029211337000133
分别表示期望的滚转力矩、期望的偏航力矩、期望的俯仰力矩;
步骤二:确定对真实操纵面进行标称化及控制效率加权均衡分配的基本方法:
定义真实操纵面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 FDA00002921133700023
其中函数fabs(x)表示小数x的绝对值;
设n个真实操纵面中有m个真实操纵面是属于A转动方向的操纵面,其中tj∈[1,2,...,n-1,n],且
Figure FDA000029211337000226
真实操纵面
Figure FDA000029211337000227
偏转角
Figure FDA000029211337000228
偏转范围分别为 - R t j R t j , 控制效率矢量为
Figure FDA00002921133700025
,且在A转动方向的控制效率为
Figure FDA00002921133700026
设某虚拟操纵面
Figure FDA00002921133700027
与m个真实操纵面在A转动方向的控制等效,虚拟操纵面的偏转角为
Figure FDA00002921133700028
虚拟操纵面在A转动方向的控制效率为,偏转角的偏转范围为[-Rh Rh];真实操纵面
Figure FDA000029211337000210
对于偏转范围[-Rh Rh]进行标称化,标称化操纵面
Figure FDA000029211337000211
的标称化控制效率矢量:
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 FDA000029211337000215
对于偏转范围[-Rh Rh]进行标称化得到标称化操纵面
Figure FDA000029211337000216
,对应标称化控制效率为
Figure FDA000029211337000217
标称化操纵面在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; ~ h ,(j=1,2...,m-1,m)
得到控制效率均衡分配下虚拟操纵面
Figure FDA000029211337000220
的偏转角
Figure FDA000029211337000221
到真实操纵面
Figure FDA000029211337000229
的偏转角的分配系数:
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 FDA00002921133700033
,则将其划分为滚转操纵面,其主导控制效率为滚转控制效率,该真实操纵面与虚拟副翼相对应;
若真实操纵面ui(i=1,2,...,n-1,n)满足偏航控制效率
Figure FDA00002921133700034
大于滚转控制效率
Figure FDA00002921133700035
及俯仰控制效率
Figure FDA00002921133700036
,则将其划分为偏航操纵面,其主导控制效率为偏航控制效率,该真实操纵面与虚拟方向舵相对应;
若真实操纵面ui(i=1,2,...,n-1,n)满足俯仰控制效率
Figure FDA00002921133700037
大于滚转控制效率及偏航控制效率
Figure FDA00002921133700039
,则将其划分为俯仰操纵面,其主导控制效率为俯仰控制效率,该真实操纵面与虚拟升降舵相对应;
滚转操纵面的数目计为n1,偏航操纵面的数目计为n2,俯仰操纵面的数目计为n3,n1+n2+n3=n;
步骤四:分别将滚转操纵面、偏航操纵面、俯仰操纵面对于所对应的虚拟操纵面的偏转范围进行标称化,并按照标称化控制效率的绝对值排序:
确定虚拟副翼的滚转控制效率与所有滚转操纵面中标称化滚转控制效率的绝对值最大的操纵面的滚转控制效率同号,将所有滚转操纵面对于虚拟副翼的偏转范围[-Rk Rk]进行标称化,并按照标称化滚转控制效率的绝对值由大到小排序,排序中第j(j=1,2,...,n1-1,n1)个标称化滚转操纵面为
Figure FDA000029211337000310
其标称化控制效率矢量
Figure FDA000029211337000311
为:
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 FDA000029211337000313
分别表示标称化之前的滚转操纵面
Figure FDA000029211337000314
的控制效率矢量及滚转控制效率,
Figure FDA000029211337000315
表示虚拟副翼的滚转控制效率,滚转操纵面
Figure FDA000029211337000316
的偏转范围为 - 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 FDA000029211337000318
分别表示标称化滚转操纵面
Figure FDA000029211337000319
的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化滚转操纵面矢量 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; ,其中 u &OverBar; p j ( p j &Element; [ 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 FDA000029211337000323
表示按照标称化滚转控制效率的绝对值排序中第j(j=1,2,...,n1-1,n1)个标称化滚转操纵面
Figure FDA000029211337000329
的标称化控制效率矢量;
确定虚拟方向舵的偏航控制效率与所有偏航操纵面中标称化偏航控制效率的绝对值最大的操纵面的偏航控制效率同号,将所有偏航操纵面对于虚拟方向舵的偏转范围[-Rl Rl]进行标称化,并按照标称化偏航控制效率的绝对值由大到小排序,排序中第j(j=1,2,...,n2-1,n2)个标称化偏航操纵面为
Figure FDA000029211337000330
,其标称化控制效率矢量为:
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 , . . . , n 2 - 1 , n 2 )
Figure FDA00002921133700041
分别表示标称化之前的偏航操纵面
Figure FDA000029211337000439
的控制效率矢量及偏航控制效率,
Figure FDA00002921133700042
表示虚拟方向舵的偏航控制效率,偏航操纵面
Figure FDA00002921133700043
的偏转范围为 - 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; , 分别表示标称化偏航操纵面的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率,建立标称化偏航操纵面矢量 U &OverBar; Q = u &OverBar; q 1 u &OverBar; q 2 . . . u &OverBar; q j . . . u &OverBar; q n 2 - 1 u &OverBar; p n 2 &prime; , 其中 u &OverBar; q j ( q j &Element; [ 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 FDA000029211337000410
表示按照标称化偏航控制效率的绝对值排序中第j(j=1,2,...n2-1,n2)个标称化偏航操纵面
Figure FDA000029211337000442
的标称化控制效率矢量;
确定虚拟升降舵的俯仰控制效率与所有俯仰操纵面中标称化俯仰控制效率的绝对值最大的操纵面的俯仰控制效率同号,将所有俯仰操纵面对于虚拟升降舵的偏转范围[-Rm Rm]进行标称化,并按照标称化俯仰控制效率的绝对值由大到小排序,排序中第j(j=1,2,...n3-1,n3)个标称化俯仰操纵面为
Figure FDA000029211337000412
其标称化控制效率矢量
Figure FDA000029211337000413
为:
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 , . . . n 3 - 1 , n 3 )
Figure FDA000029211337000415
分别表示标称化之前的俯仰操纵面
Figure FDA000029211337000416
的控制效率矢量及俯仰控制效率,
Figure FDA000029211337000417
表示虚拟升降舵的俯仰控制效率,俯仰操纵面
Figure FDA000029211337000418
的偏转范围为 - 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 FDA000029211337000421
分别表示标称化俯仰操纵面的标称化滚转控制效率、标称化偏航控制效率及标称化俯仰控制效率;则标称化俯仰操纵面矢量 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 FDA000029211337000443
表示按照标称化俯仰控制效率的绝对值排序中第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 FDA000029211337000426
表示按照标称化俯仰控制效率的绝对值排序中第j(j=1,2,...n3-1,n3)个标称化俯仰操纵面
Figure FDA000029211337000444
的标称化控制效率矢量;
步骤五:确定虚拟操纵面的主导控制效率:
虚拟副翼的主导控制效率为滚转控制效率
Figure FDA000029211337000428
Figure FDA000029211337000429
Figure FDA000029211337000430
为虚拟副翼的滚转控制效率比例系数,
Figure FDA000029211337000431
表示标称化滚转操纵面矢量
Figure FDA000029211337000432
中第j(j=1,2,...,n1-1,n1)的标称化滚转操纵面
Figure FDA000029211337000433
的标称化滚转控制效率;
虚拟方向舵的主导控制效率为偏航控制效率
Figure FDA000029211337000434
Figure FDA000029211337000435
Figure FDA000029211337000436
为虚拟方向舵的偏航控制效率比例系数,表示标称化偏航操纵面矢量
Figure FDA000029211337000438
中第j(j=1,2,...,n2-1,n2)的标称化偏航操纵面
Figure FDA00002921133700051
的标称化偏航控制效率;
虚拟升降舵的主导控制效率为俯仰控制效率
Figure FDA00002921133700052
Figure FDA00002921133700053
Figure FDA00002921133700054
为虚拟升降舵的俯仰控制效率比例系数,表示标称化俯仰操纵面矢量
Figure FDA00002921133700056
中第j(j=1,2,...,n3-1,n3)的标称化俯仰操纵面
Figure FDA00002921133700057
的标称化俯仰控制效率;
步骤六:根据标称化控制效率将标称化操纵面划分成主、副、辅三级,设定标称化主操纵面与标称化副操纵面的权限系数,并计算主、副、辅各级标称化操纵面期望分担的主导控制效率:
(1)分别将标称化滚转操纵面、标称化偏航操纵面、标称化俯仰操纵面的划分为主、副、辅三级:
Figure FDA00002921133700058
表示标称化滚转操纵面矢量
Figure FDA00002921133700059
中第j(j=1,2,...,n1-1,n1)的标称化滚转操纵面
Figure FDA000029211337000510
的标称化滚转控制效率,则确定标称化滚转主操纵面序号临界值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 FDA000029211337000513
中前nx1个位置的操纵面划分为标称化滚转主操纵面;将位于标称化滚转操纵面矢量
Figure FDA000029211337000514
中从(nx1+1)到nx2个位置的操纵面划分为标称化滚转副操纵面;将位于标称化滚转操纵面矢量
Figure FDA000029211337000515
中从(nx2+1)到n1个位置的操纵面划分为标称化滚转辅操纵面;
Figure FDA000029211337000516
表示标称化偏航操纵面矢量
Figure FDA000029211337000517
中第j(j=1,2,...,n2-1,n2)的标称化偏航操纵面
Figure FDA000029211337000518
的标称化偏航控制效率,则标称化偏航主操纵面序号临界值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 FDA000029211337000521
中前ny1个位置的操纵面划分为标称化偏航主操纵面;将位于标称化偏航操纵面矢量
Figure FDA000029211337000522
中从(ny1+1)到ny2个位置的操纵面划分为标称化偏航副操纵面;将位于标称化偏航操纵面矢量
Figure FDA000029211337000523
中从(ny2+1)到n2个位置的操纵面划分为标称化偏航辅操纵面;
Figure FDA00002921133700061
表示标称化俯仰操纵面矢量
Figure FDA00002921133700062
中第j(j=1,2,...,n3-1,n3)的标称化俯仰操纵面
Figure FDA00002921133700063
的标称化俯仰控制效率,则标称化俯仰主操纵面序号临界值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 FDA00002921133700066
中前nz1个位置的操纵面划分为标称化俯仰主操纵面;将位于标称化俯仰操纵面矢量
Figure FDA00002921133700067
中从(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 FDA000029211337000611
则所有的标称化滚转副操纵面期望分担的滚转控制效率所有的标称化滚转辅操纵面期望分担的滚转控制效率 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 FDA00002921133700073
所有的标称化偏航副操纵面期望分担的偏航控制效率所有的标称化偏航辅操纵面期望分担的偏航控制效率 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 FDA00002921133700079
所有的标称化俯仰辅操纵面期望分担的俯仰控制效率 B &OverBar; &omega; z &delta; &OverBar; zf = B &omega; z &delta; ~ z ( 1 - Q zm C zm - Q zs C zs ) ;
步骤七:采用控制效率均衡分配的方法计算每个标称化操纵面期望分担的主导控制效率:
(1)计算每个标称化滚转操纵面期望分担的滚转控制效率:
采用控制效率均衡分配的方法将所有的标称化滚转主操纵面期望分担的滚转控制效率
Figure FDA000029211337000711
分配给每个标称化滚转主操纵面,则第j(j=1,2,...,nx1-1,nx1)个标称化滚转主操纵面期望分担的滚转控制效率
Figure FDA000029211337000713
为:
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 FDA00002921133700082
分配给每个标称化滚转副操纵面,则第j(j=nx1+1,nx1+2,...,nx2-1,nx2)个标称化滚转副操纵面
Figure FDA00002921133700083
期望分担的滚转控制效率
Figure FDA00002921133700084
为:
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 FDA00002921133700086
分配每个标称化滚转辅操纵面,则第j(j=nx2+1,nx2+2,...,n1-1,n1)个标称化滚转辅操纵面
Figure FDA00002921133700087
期望分担的滚转控制效率
Figure FDA000029211337000822
为:
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)计算每个标称化偏航操纵面期望分担的偏航控制效率:
采用控制效率均衡分配的方法将所有的标称化偏航主操纵面期望分担的偏航控制效率分配给每个标称化偏航主操纵面,则第j(j=1,2,...,ny1-1,ny1)个标称化偏航主操纵面
Figure FDA000029211337000810
期望分担的偏航控制效率
Figure FDA000029211337000811
为:
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)
采用控制效率均衡分配的方法将所有的标称化偏航副操纵面期望分担的偏航控制效率分配给每个标称化偏航副操纵面,则第j(j=ny1+1,ny1+2,...,ny2-1,ny2)个标称化偏航副操纵面
Figure FDA000029211337000814
期望分担的偏航控制效率
Figure FDA000029211337000815
为:
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 FDA000029211337000817
配给每个标称化偏航辅操纵面,则第j(j=ny2+1,ny2+2,...,n2-1,n2)个标称化偏航辅操纵面
Figure FDA000029211337000818
期望分担的偏航控制效率
Figure FDA000029211337000819
为:
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 FDA000029211337000821
分配给每个标称化俯仰主操纵面,则第j(j=1,2,...,nz1-1,nz1)个标称化俯仰主操纵面
Figure FDA00002921133700091
期望分担的俯仰控制效率
Figure FDA00002921133700092
为:
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 FDA00002921133700095
期望分担的俯仰控制效率
Figure FDA00002921133700096
为:
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 FDA00002921133700099
期望分担的俯仰控制效率
Figure FDA000029211337000910
为:
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 FDA000029211337000912
与标称化之前的滚转操纵面
Figure FDA000029211337000913
对应,标称化滚转操纵面
Figure FDA000029211337000914
期望分担的滚转控制效率为
Figure FDA000029211337000915
滚转操纵面的偏转范围为 - R p j R p j , 滚转控制效率为
Figure FDA000029211337000918
,则虚拟副翼
Figure FDA000029211337000919
的偏转角
Figure FDA000029211337000920
到滚转操纵面的偏转角
Figure FDA000029211337000933
的分配系数为:
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 FDA000029211337000923
表示虚拟副翼
Figure FDA000029211337000924
的偏转角
Figure FDA000029211337000925
到滚转操纵面
Figure FDA000029211337000935
的偏转角
Figure FDA000029211337000936
的分配系数;
②计算每个偏航操纵面的分配系数:
由于第j(j=1,2,...,n2-1,n2)个标称化偏航操纵面
Figure FDA000029211337000926
与标称化之前的偏航操纵面
Figure FDA000029211337000937
对应,标称化偏航操纵面
Figure FDA000029211337000927
期望分担的偏航控制效率为
Figure FDA000029211337000928
偏航操纵面的偏转范围为 - R q j R q j , 偏航控制效率为
Figure FDA000029211337000929
,则虚拟方向舵
Figure FDA000029211337000930
的偏转角到偏航操纵面
Figure FDA000029211337000940
的偏转角
Figure FDA000029211337000941
的分配系数为:
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 p n 2 &prime; ; 其中,
Figure FDA000029211337001036
表示虚拟方向舵
Figure FDA00002921133700103
的偏转角
Figure FDA00002921133700104
到偏航操纵面的偏转角
Figure FDA000029211337001038
的分配系数;
③计算每个俯仰操纵面的分配系数:
由于第j(j=1,2,...,n3-1,n3)个标称化俯仰操纵面
Figure FDA00002921133700105
与标称化之前的俯仰操纵面
Figure FDA000029211337001039
对应,标称化俯仰操纵面期望分担的俯仰控制效率为
Figure FDA00002921133700107
俯仰操纵面
Figure FDA000029211337001040
的偏转范围为 - R r j R r j , 俯仰控制效率为
Figure FDA00002921133700109
则虚拟升降舵
Figure FDA000029211337001010
的偏转角
Figure FDA000029211337001011
到俯仰操纵面
Figure FDA000029211337001012
的偏转角
Figure FDA000029211337001013
的分配系数为:
k rj = 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 FDA000029211337001016
表示虚拟升降舵
Figure FDA000029211337001017
的偏转角
Figure FDA000029211337001018
到俯仰操纵面的偏转角
Figure FDA000029211337001020
的分配系数;
(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 FDA000029211337001041
(i=1,2,...,n1-1,n1)分别表示滚转操纵面的偏转角及控制效率矢量,(j=1,2,...,n2-1,n2)分别表示偏航操纵面
Figure FDA000029211337001044
的偏转角及控制效率矢量,
Figure FDA000029211337001026
(t=1,2,...,n3-1,n3)分别表示滚转操纵面
Figure FDA000029211337001027
的偏转角及控制效率矢量,虚拟操纵面矢量 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 FDA000029211337001031
表示虚拟副翼的偏转角及控制效率矢量,
Figure FDA000029211337001032
Figure FDA000029211337001033
表示虚拟方向舵的偏转角及控制效率矢量,
Figure FDA000029211337001034
分别表示虚拟升降舵的偏转角及控制效率矢量;则虚拟操纵面偏转角矢量到过渡操纵面偏转角矢量的传递关系为
Figure FDA000029211337001035
其中,表示虚拟操纵面矢量到过渡操纵面矢量的加权均衡分配矩阵:
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 FDA00002921133700112
表示n1行1列的全零向量,
Figure FDA00002921133700113
表示n2行1列的全零向量,
Figure FDA00002921133700114
表示n3行1列的全零向量;
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足
Figure FDA00002921133700115
真实操纵面矢量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 FDA00002921133700118
的偏转角矢量
Figure FDA00002921133700119
通过n行n列的转换矩阵T转化为真实操纵面矢量U的偏转角矢量δ,即
Figure FDA000029211337001110
且过渡操纵面矢量控制效率矩阵
Figure FDA000029211337001111
转换矩阵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 FDA000029211337001112
从而得到真实操纵面偏转角矢量虚拟操纵面矢量到真实操纵面矢量的加权均衡分配矩阵
Figure FDA000029211337001114
虚拟操纵面矢量的控制效率矩阵与过渡操纵面矢量的控制效率矩阵满足过渡操纵面矢量控制效率矩阵与真实操纵面的控制效率矩阵满足
Figure FDA000029211337001116
虚拟操纵面控制效率矩阵
Figure FDA000029211337001117
与真实操纵面的控制效率矩阵B满足
Figure FDA000029211337001118
②由加权均衡分配矩阵计算虚拟操纵面的非主导控制效率,得到虚拟操纵面矢量的控制效率矩阵;
虚拟操纵面的控制效率矩阵
Figure FDA000029211337001119
与过渡操纵面控制效率矩阵
Figure FDA000029211337001120
满足
Figure FDA000029211337001121
其中过渡操纵面矢量的控制效率矩阵为:
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 FDA000029211337001123
分别表示滚转操纵面
Figure FDA000029211337001124
的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure FDA000029211337001125
分别表示偏航操纵面
Figure FDA000029211337001127
的滚转控制效率、偏航控制效率及俯仰控制效率,
Figure FDA000029211337001128
分别表示俯仰操纵面
Figure FDA000029211337001129
的滚转控制效率、偏航控制效率及俯仰控制效率;
虚拟操纵面矢量的控制效率矩阵为:
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 FDA00002921133700122
虚拟方向舵的偏航控制效率
Figure FDA00002921133700123
虚拟升降舵的俯仰控制效率
Figure FDA00002921133700124
为主导控制效率,均由步骤五得出,进而确定虚拟操纵面的非主导控制效率:虚拟副翼的偏航控制效率
Figure FDA00002921133700125
Figure FDA000029211337001240
表示虚拟副翼
Figure FDA00002921133700126
的偏转角
Figure FDA00002921133700127
到滚转操纵面的偏转角
Figure FDA000029211337001227
的分配系数;虚拟副翼的俯仰控制效率
Figure FDA00002921133700128
Figure FDA000029211337001241
表示虚拟副翼的偏转角
Figure FDA000029211337001210
到滚转操纵面
Figure FDA000029211337001228
的偏转角的分配系数;虚拟方向舵的滚转控制效率
Figure FDA000029211337001239
表示虚拟方向舵
Figure FDA000029211337001212
的偏转角
Figure FDA000029211337001213
到偏航操纵面
Figure FDA000029211337001230
的偏转角
Figure FDA000029211337001231
的分配系数;虚拟方向舵的俯仰控制效率
Figure FDA000029211337001214
Figure FDA000029211337001237
表示虚拟方向舵
Figure FDA000029211337001215
的偏转角
Figure FDA000029211337001216
到偏航操纵面
Figure FDA000029211337001232
的偏转角
Figure FDA000029211337001233
的分配系数;虚拟升降舵的滚转控制效率
Figure FDA000029211337001217
表示虚拟升降舵
Figure FDA000029211337001218
的偏转角
Figure FDA000029211337001219
到俯仰操纵面
Figure FDA000029211337001234
的偏转角
Figure FDA000029211337001235
的分配系数;虚拟升降舵的偏航控制效率
Figure FDA000029211337001220
Figure FDA000029211337001236
表示虚拟升降舵
Figure FDA000029211337001221
的偏转角
Figure FDA000029211337001222
到俯仰操纵面
Figure FDA000029211337001242
的偏转角的分配系数。
2.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤五中的虚拟副翼的滚转控制效率比例系数
Figure FDA000029211337001223
的取值为0.8~2.0。
3.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤五中的虚拟方向舵的偏航控制效率比例系数
Figure FDA000029211337001224
的取值为0.8~2.0。
4.根据权利要求1所述的多操纵面飞机的一种均衡操纵分配方法,其特征在于:步骤五中的虚拟升降舵的俯仰控制效率比例系数
Figure FDA000029211337001225
的取值为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 CN102320378A (zh) 2012-01-18
CN102320378B true 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 (1)

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

Families Citing this family (7)

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

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 (2)

* Cited by examiner, † Cited by third party
Title
余晓艇等.无人机轮式着陆横侧向控制.《系统仿真学报》.2010,第22卷(第S1期),166-171.
无人机轮式着陆横侧向控制;余晓艇等;《系统仿真学报》;20100228;第22卷(第S1期);166-171 *

Cited By (2)

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

Also Published As

Publication number Publication date
CN102320378A (zh) 2012-01-18

Similar Documents

Publication Publication Date Title
CN102320378B (zh) 多操纵面飞机的一种均衡操纵分配方法
Heidlauf et al. Verification Challenges in F-16 Ground Collision Avoidance and Other Automated Maneuvers.
CN108681240B (zh) 基于未知输入观测器的无人机分布式编队的故障诊断方法
CN102707624B (zh) 基于飞行器常规模型的纵向控制器区域设计方法
CN103558857A (zh) 一种btt飞行器的分布式复合抗干扰姿态控制方法
CN104216417A (zh) 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法
CN106874617B (zh) 一种高效的直升机机动飞行品质等级评估方法
CN104020774A (zh) 基于动态控制重新分配的飞行器姿态容错控制方法
CN104035447A (zh) 基于动态控制重新分配的无人飞行器姿态容错控制方法
CN104881035A (zh) 飞行器操纵耦合补偿方法、姿态运动控制方法及系统
CN104331084B (zh) 一种基于方向舵控滚转策略的气动舵偏范围计算方法
CN102736631B (zh) 一种基于角加速度传感器的多操纵面无人机闭环控制分配方法
CN108628167A (zh) 基于自适应分配技术的飞行控制系统的容错控制方法
CN103587680A (zh) 一种飞行器侧滑转弯控制方法
CN105173051A (zh) 一种平流层飞艇的制导控制一体化及控制分配方法
Ashraf et al. Design linear feedback and LQR controller for lateral flight dynamics of F-16 aircraft
CN111158391A (zh) 一种基于离散系统直接控制分配的舵面控制方法
CN104965418A (zh) 一种基于弹道阻尼控制和热流解析预测的引入段制导方法
Sadien et al. A detailed comparison of control allocation techniques on a realistic on-ground aircraft benchmark
CN112487551A (zh) 一种飞翼无人机多舵面链式直接控制分配与重构方法
CN111897219A (zh) 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法
CN104808681B (zh) 一种确定与控制策略匹配的无动力下滑轨迹角的方法
CN105259762A (zh) 一种飞行控制系统控制参数的图形化自动寻优整定方法
CN109002575A (zh) 一种复合式旋翼飞行器过渡飞行模式控制分配方法
Vanek et al. Robust model matching for geometric fault detection filters: A commercial aircraft example

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