《飞行器姿态通道内的控制器及其设计方法.pdf》由会员分享,可在线阅读,更多相关《飞行器姿态通道内的控制器及其设计方法.pdf(13页珍藏版)》请在专利查询网上搜索。
1、10申请公布号CN104155984A43申请公布日20141119CN104155984A21申请号201410389938722申请日20140808G05D1/08200601G05B13/0420060171申请人北京航天自动控制研究所地址100854北京市海淀区永定路50号72发明人柳嘉润黄万伟包为民马卫华祁振强唐海红74专利代理机构北京君恒知识产权代理事务所普通合伙11466代理人林月俊黄启行54发明名称飞行器姿态通道内的控制器及其设计方法57摘要本发明公开了一种飞行器姿态通道内的控制器及其设计方法,所述控制器包括频率响应函数为WGS的第一频率响应单元,其输入端为控制器的输入端;低。
2、通滤波单元,其输入端与第一频率响应单元的输出端相连;减法器,其正向输入端与第一频率响应单元的输出端相连,负向输入端与低通滤波单元的输出端相连,其输出端输出的信号用于控制第一空气舵;频率响应函数为的第二频率响应单元,其输入端与低通滤波单元的输出端相连;乘法器,其输入端与第二频率响应单元的输出端相连,用于将第二频率响应单元输出的信号乘以系数后从其输出端输出,输出的信号用于控制第二空气舵。本发明的控制器在实现姿态通道内的两个空气舵的控制时,设计工作量小。51INTCL权利要求书2页说明书7页附图3页19中华人民共和国国家知识产权局12发明专利申请权利要求书2页说明书7页附图3页10申请公布号CN10。
3、4155984ACN104155984A1/2页21一种飞行器姿态通道内的控制器,其特征在于,包括第一频率响应单元,其频率响应函数为WGS,其输入端为所述控制器的输入端;低通滤波单元,其输入端与第一频率响应单元的输出端相连;减法器,其正向输入端与第一频率响应单元的输出端相连,其负向输入端与所述低通滤波单元的输出端相连,其输出端输出的信号用于控制所述姿态通道内的第一空气舵;第二频率响应单元,其频率响应函数为其输入端与所述低通滤波单元的输出端相连;乘法器,其输入端与第二频率响应单元的输出端相连,用于将第二频率响应单元输出的信号乘以系数后从其输出端输出,输出的信号用于控制所述姿态通道内的第二空气舵;。
4、其中,WGS是根据所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数设计的;WSF1S是第一空气舵的伺服系统的频率响应函数;WSF2S是第二空气舵的伺服系统的频率响应函数;K是第二空气舵的频率响应函数与第一空气舵的频率响应函数的比例。2如权利要求1所述的控制器,其特征在于,所述WGS具体根据如下方法计算得到的将所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS;根据WS、WSFS设计出虚拟控制器的频率响应函数WGS。3如权利要求2或3所述的控制器,其特征。
5、在于,所述WLPS具体为其中,M为设定的数值,S为频率。4一种飞行器姿态通道内的控制器设计方法,包括将所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS;根据WS、WSFS设计出虚拟控制器的频率响应函数WGS;根据WGS计算出用于控制第一空气舵的第一控制器的频率响应函数WG1S,以及用于控制所述姿态通道内的第二空气舵的第二控制器的频率响应函数WG2SWG1S1WLPSWGS其中,WSF1S为第一空气舵的伺服系统的频率响应函数;WSF2S为第二空气舵的伺服系统的频率响应函数;K为第。
6、二空气舵的频率响应函数与第一空气舵的频率响应函数的比权利要求书CN104155984A2/2页3例;WLPS为设定的低通滤波器的频率响应函数;根据WG1S、WG2S分别设计出第一控制器和第二控制器。5如权利要求4所述的方法,其特征在于,所述根据WGS计算出用于控制第一空气舵的第一控制器的频率响应函数WG1S,以及所述姿态通道内的第二空气舵的控制器的频率响应函数WG2S,具体包括计算出所述虚拟控制器的开环传递特性使得第一空气舵的控制器与第二空气舵的控制器的控制回路的开环传递特性WOPENS与一致后,通过设定的低通滤波器的频率响应函数WLPS,得到WGS的高频部分WG1S和低频部分WG2S,进而根。
7、据WG2S得到WG2S。6如权利要求4或5所述的方法,其特征在于,所述WLPS具体为其中,M为设定的数值,S为频率。7一种飞行器姿态通道内的控制器,其特征在于,包括第一控制器,用于控制所述姿态通道内的第一空气舵,其频率响应函数为WG1S;第二控制器,用于控制所述姿态通道内的第二空气舵,其频率响应函数为WG2S;其中,WG1S1WLPSWGS其中,WSF1S为第一空气舵的伺服系统的频率响应函数;WSF2S为第二空气舵的伺服系统的频率响应函数;K为第二空气舵的频率响应函数与第一空气舵的频率响应函数的比例;WLPS为设定的低通滤波器的频率响应函数。8如权利要求7所述的控制器,其特征在于,所述WG1S。
8、、WG2S是根据如下方法设计出的将所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS;根据WS、WSFS设计出虚拟控制器的频率响应函数WGS;根据WGS计算出WG1S、WG2S。9如权利要求7或8所述的控制器,其特征在于,所述WLPS具体为其中,M为设定的数值,S为频率。权利要求书CN104155984A1/7页4飞行器姿态通道内的控制器及其设计方法技术领域0001本发明涉及航空航天领域,尤其涉及一种飞行器姿态通道内的控制器及其设计方法。背景技术0002飞行器FLIGHTVEHI。
9、CLE是一种由人类制造并由人来控制的器械飞行物,它能飞离地面,并可在大气层内或大气层外空间太空飞行。飞行器分为5类,包括滑翔机、飞艇、飞机、直升机等航空器,人造地球卫星、载人飞船、空间探测器、航天飞机等航天器,火箭,导弹和制导武器。0003飞行器能在空中按预定的轨迹运动总离不开它的姿态控制系统。由于角运动使飞行器的姿态发生变化,因此对飞行器在空间的角运动可分解为俯仰、偏航和滚动三个角运动的控制就是对飞行器姿态的控制。其中,控制使飞行器三个姿态角发生变化的力矩由飞行器上的执行机构产生,常见的执行机构有空气舵、推力矢量发动机、反作用飞轮、喷气执行机构或由其它环境力执行机构。0004其中,带有伺服系。
10、统的空气舵在航空航天领域有着广泛的应用。为保证诸如高速滑翔飞行器类的飞行器的稳定飞行,飞行器的单个姿态通道内可配置两个独立的空气舵以及相应的伺服系统记为SF1和SF2;其中,两个空气舵的频率响应函数分别为W1S、W2S;两个空气舵的伺服系统的频率响应函数分别为WSF1S和WSF2S。通常,可认为WSF1S的动态特性较快,WSF2S的动态特性较慢。000500060007其中,1,1分别表示伺服系统SF1的自然频率和阻尼比,2,2分别表示伺服系统SF2的自然频率和阻尼比。0008而且,技术人员需要分别设计两个控制器来控制两个独立的空气舵,设计的两个控制器的频率响应函数分别为WG1S、WG2S;然。
11、而,这种分别设计两个控制器的方式的设计工作量大,而且容易使得两个控制支路之间产生不协调,往往需要耗费大量精力进行参数调试。0009综上,现有技术中在单个姿态通道内存在两个空气舵时,设计用于控制两个空气舵的控制器的设计工作量较大。发明内容0010针对上述现有技术存在的缺陷,本发明实施例提供了一种飞行器姿态通道内的控制器及其设计方法,用以降低控制器的设计工作量。0011本发明实施例提供了一种飞行器姿态通道内的控制器,包括说明书CN104155984A2/7页50012第一频率响应单元,其频率响应函数为WGS,其输入端为所述控制器的输入端;0013低通滤波单元,其输入端与第一频率响应单元的输出端相连。
12、;0014减法器,其正向输入端与第一频率响应单元的输出端相连,其负向输入端与所述低通滤波单元的输出端相连,其输出端输出的信号用于控制所述姿态通道内的第一空气舵;0015第二频率响应单元,其频率响应函数为其输入端与所述低通滤波单元的输出端相连;0016乘法器,其输入端与第二频率响应单元的输出端相连,用于将第二频率响应单元输出的信号乘以系数后从其输出端输出,输出的信号用于控制所述姿态通道内的第二空气舵;0017其中,WGS是根据所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数设计的;0018WSF1S是第一空气舵的伺服系统的频率响应函数;0019WSF2S是第二空气舵的。
13、伺服系统的频率响应函数;0020K是第二空气舵的频率响应函数与第一空气舵的频率响应函数的比例。0021其中,所述WGS具体根据如下方法计算得到的0022将所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS;0023根据WS、WSFS设计出虚拟控制器的频率响应函数WGS。0024所述WLPS具体为00250026其中,M为设定的数值,S为频率。0027本发明实施例还提供了一种飞行器姿态通道内的控制器设计方法,包括0028将所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系。
14、统的频率响应函数,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS;0029根据WS、WSFS设计出虚拟控制器的频率响应函数WGS;0030根据WGS计算出用于控制第一空气舵的第一控制器的频率响应函数WG1S,以及用于控制所述姿态通道内的第二空气舵的第二控制器的频率响应函数WG2S0031WG1S1WLPSWGS00320033其中,WSF1S为第一空气舵的伺服系统的频率响应函数;WSF2S为第二空气舵的伺服系统的频率响应函数;K为第二空气舵的频率响应函数与第一空气舵的频率响应函数的比例;WLPS为设定的低通滤波器的频率响应函数;说明书CN1041559。
15、84A3/7页60034根据WG1S、WG2S分别设计出第一控制器和第二控制器。0035较佳地,所述根据WGS计算出用于控制第一空气舵的第一控制器的频率响应函数WG1S,以及所述姿态通道内的第二空气舵的控制器的频率响应函数WG2S,具体包括0036计算出所述虚拟控制器的开环传递特性0037使得第一空气舵的控制器与第二空气舵的控制器的控制回路的开环传递特性WOPENS与一致后,通过设定的低通滤波器的频率响应函数WLPS,得到WGS的高频部分WG1S和低频部分WG2S,进而根据WG2S得到WG2S。0038其中,所述WLPS具体为00390040其中,M为设定的数值,S为频率。0041本发明实施例。
16、还提供了一种飞行器姿态通道内的控制器,包括0042第一控制器,用于控制所述姿态通道内的第一空气舵,其频率响应函数为WG1S;0043第二控制器,用于控制所述姿态通道内的第二空气舵,其频率响应函数为WG2S;其中,0044WG1S1WLPSWGS00450046其中,WSF1S为第一空气舵的伺服系统的频率响应函数;WSF2S为第二空气舵的伺服系统的频率响应函数;K为第二空气舵的频率响应函数与第一空气舵的频率响应函数的比例;WLPS为设定的低通滤波器的频率响应函数。0047其中,所述WG1S、WG2S是根据如下方法设计出的0048将所述姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频。
17、率响应函数,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS;0049根据WS、WSFS设计出虚拟控制器的频率响应函数WGS;0050根据WGS计算出WG1S、WG2S。0051所述WLPS具体为00520053其中,M为设定的数值,S为频率。0054本发明的技术方案中,基于一个空气舵及其伺服系统的频率响应函数设计出虚拟控制器的频率响应函数;之后,再根据两个空气舵的频率响应函数之间的关联关系,通过一个低通滤波器得到虚拟控制器的频率响应函数的高频部分和低频部分,进而根据得到的高频部分和低频部分得出两个控制器的频率响应函数,从而实现两个空气舵的控制器的设计。。
18、本发明设计两个控制器的设计工作量几乎仅相当于现有技术中设计一个控制器的设计工作量,因此大大减少了对于单姿态通道内存在两个空气舵时设计相应控制器的工作量。而且,两个控制器之间关联,可以协调工作,减少了进行参数调试的大量工作量。说明书CN104155984A4/7页7附图说明0055图1为飞行器在典型飞行状态下两个空气舵的频率响应函数的波特图;0056图2为本发明实施例的飞行器姿态通道内的控制器的结构框图;0057图3为本发明实施例的飞行器姿态通道内的控制器的设计方法示意图;0058图4为本发明实施例的额定状态下虚拟控制器的频率响应函数的波特图;0059图5为本发明实施例的额定状态下虚拟控制器的开。
19、环传递特性的波特图;0060图6为多种偏差状态下虚拟控制器的开环传递特性的波特图。具体实施方式0061为使本发明的目的、技术方案及优点更加清楚明白,以下参照附图并举出优选实施例,对本发明进一步详细说明。然而,需要说明的是,说明书中列出的许多细节仅仅是为了使读者对本发明的一个或多个方面有一个透彻的理解,即便没有这些特定的细节也可以实现本发明的这些方面。0062本发明的发明人对多种类似外形的高超声速飞行器进行分析研究发现,对于单个姿态通道如俯仰通道,配置两个独立的空气舵作为控制舵面时,两个空气舵的频率响应函数满足或近似满足比例关系W2SKW1S。例如,图1示出了某飞行器在典型飞行状态高度、马赫数、。
20、攻角条件下,两个空气舵的频率响应函数的波特图;在主要频段上,二者仅相差一个常值增益。0063因此,本发明的发明人考虑到,可以基于一个空气舵及其伺服系统的频率响应函数设计出一个虚拟控制器的频率响应函数;之后,再根据两个空气舵的频率响应函数之间的关联关系,通过一个低通滤波器得到虚拟控制器的频率响应函数的高频部分和低频部分,进而根据得到的高频部分和低频部分得出两个控制器的频率响应函数,从而实现控制两个空气舵的两个控制器的设计。这样设计两个控制器的设计工作量,几乎仅相当于现有技术中设计一个控制器的设计工作量,因此大大减少了对于单姿态通道内存在两个空气舵时设计相应控制器的工作量。0064下面结合附图详细。
21、说明本发明的技术方案。0065本发明实施例的飞行器姿态通道内的控制器的结构框图,如图2所示,包括第一频率响应单元201、低通滤波单元202、减法器203、第二频率响应单元204、乘法器205。0066其中,第一频率响应单元201的频率响应函数为WGS,第一频率响应单元201的输入端为飞行器姿态通道内的控制器的输入端。其中,WGS是根据姿态通道内的第一空气舵的频率响应函数、第一空气舵的伺服系统的频率响应函数设计的,具体设计方法在下述进行详细介绍。0067低通滤波单元202的输入端与第一频率响应单元201的输出端相连。0068减法器203的正向输入端与第一频率响应单元201的输出端相连,减法器20。
22、3的负向输入端与低通滤波单元202的输出端相连,减法器203的输出端输出的信号用于控制姿态通道内的第一空气舵。0069第二频率响应单元204的频率响应函数为其输入端与低通滤波单元202的输出端相连。其中,WSF1S是第一空气舵的伺服系统的频率响应函数;WSF2S是第二空说明书CN104155984A5/7页8气舵的伺服系统的频率响应函数。0070乘法器205的输入端与第二频率响应单元204的输出端相连,用于将第二频率响应单元204输出的信号乘以系数后从乘法器205的输出端输出,乘法器205输出的信号用于控制姿态通道内的第二空气舵。K是第二空气舵的频率响应函数与第一空气舵的频率响应函数的比例。0。
23、071具体地,上述的飞行器姿态通道内的控制器的设计方法如图3所示,包括如下步骤0072S301将姿态通道内的第一空气舵的频率响应函数W1S、第一空气舵的伺服系统的频率响应函数WSF1S,分别作为虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS。0073也就是,构造虚拟回路,令虚拟的被控对象的频率响应函数WS和虚拟的被控对象的伺服系统的频率响应函数WSFS分别为0074WSW1S。0075WSFSWSF1S0076S302根据WS、WSFS设计出虚拟控制器的频率响应函数WGS。0077具体地,对于虚拟的被控对象及其伺服系统,可采用传统的SISOSINGLEINPU。
24、TSINGLEOUTPUT,单输入单输出系统设计方法、设计工具、评价准则等手段,根据虚拟的被控对象的频率响应函数WS、虚拟的被控对象的伺服系统的频率响应函数WSFS,设计出虚拟控制器的频率响应函数WGS。0078S303根据WGS计算出用于控制第一空气舵的第一控制器的频率响应函数WG1S、以及用于控制第二空气舵的第二控制器的频率响应函数WG2S。0079具体地,根据公式1计算出虚拟控制器的开环传递特性0080公式10081其中,WPTS为姿态通道内的惯性平台的频率响应函数。0082如公式2,第一空气舵的控制器与第二空气舵的控制器的控制回路的开环传递特性为0083WOPENSWG1SWSF1SW。
25、1SWG2SWSF2SW2SWPTS公式20084使得第一空气舵的控制器与第二空气舵的控制器的控制回路的开环传递特性WOPENS与一致,即使得也就是使得公式3成立0085WG1SWSF1SW1SWG2SWSF2SW2SWGSWSFSWS公式30086将WSW1S、WSFSWSF1S、W2SKW1S代入公式3中,可以得到如下公式40087WG1SWSF1SKWG2SWSF2SWGSWSF1S公式40088再令上述公式4可进一步简写为如下公式50089WG1SWG2SWGS公式5说明书CN104155984A6/7页90090考虑到WSF1S的动态特性较快,WSF2S的动态特性较慢,可将WG1S设。
26、计为WGS的高频部分,将WG2S设计为WGS的低频部分。0091因此,本发明通过设计一个简单的低通滤波器来实现,也就是通过设定的低通滤波器的频率响应函数WLPS,得到WGS的高频部分WG1S、低频部分WG2S0092WG1S1WLPSWGS0093WG2SWLPSWGS。0094因此,可得到第一控制器和第二控制器的频率响应函数分别为0095WG1S1WLPSWGS00960097从而,得到第一控制器和第二控制器的设计结果。0098其中,WLPS具体可以为00990100其中,M为设定的数值,S为频率。0101例如,当K取额定状态下的数值时,第一空气舵和第二空气舵的频率响应函数的波特图如图1所示。
27、。采用传统方法,设计虚拟控制器的频率响应函数WGS为01020103虚拟控制器的频率响应函数WGS的波特图如图4所示。0104当低通滤波器的频率响应函数WLPS取为时,虚拟控制器的开环传递特性的波特图如图5所示。由图5可以看出,额定状态下系统幅值裕度为18DB,相位裕度为514度,截频为632RAD/S。0105考虑到被控对象的各种参数慑动,对多种偏差状态进行了频率分析,波特图如图6所示,系统均具有足够的稳定裕度。由图6可以看出,幅值裕度141DB,相位裕度149度,截频为245936RAD/S。0106S304根据WG1S、WG2S分别设计出第一控制器和第二控制器。0107具体地,得到第一控。
28、制器和第二控制器的频率响应函数后,可设计出实际的控制回路。0108基于上述的飞行器姿态通道内的控制器的设计方法,本发明实施例提供的一种飞行器姿态通道内的控制器包括第一控制器和第二控制器。0109其中,第一控制器用于控制飞行器姿态通道内的第一空气舵,其频率响应函数为WG1S;其中,WG1S1WLPSWGS。0110第二控制器用于控制飞行器姿态通道内的第二空气舵,其频率响应函数为WG2S;其中,说明书CN104155984A7/7页100111其中,WSF1S为第一空气舵的伺服系统的频率响应函数;WSF2S为第二空气舵的伺服系统的频率响应函数;K为第二空气舵的频率响应函数与第一空气舵的频率响应函数。
29、的比例;WLPS为设定的低通滤波器的频率响应函数。0112本发明的技术方案中,基于一个空气舵及其伺服系统的频率响应函数设计出虚拟控制器的频率响应函数;之后,再根据两个空气舵的频率响应函数之间的关联关系,通过一个低通滤波器得到虚拟控制器的频率响应函数的高频部分和低频部分,进而根据得到的高频部分和低频部分得出两个控制器的频率响应函数,从而实现两个空气舵的控制器的设计。本发明设计两个控制器的设计工作量几乎仅相当于现有技术中设计一个控制器的设计工作量,因此大大减少了对于单姿态通道内存在两个空气舵时设计相应控制器的工作量。而且,两个控制器之间关联,可以协调工作,减少了进行参数调试的大量工作量。0113本领域普通技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序可以存储于计算机可读取存储介质中,如ROM/RAM、磁碟、光盘等。0114以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以作出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。说明书CN104155984A101/3页11图1图2说明书附图CN104155984A112/3页12图3图4说明书附图CN104155984A123/3页13图5图6说明书附图CN104155984A13。