CN106020224B - 一种考虑质心位置不确定性的上面级矢量推力控制方法 - Google Patents
一种考虑质心位置不确定性的上面级矢量推力控制方法 Download PDFInfo
- Publication number
- CN106020224B CN106020224B CN201610586938.5A CN201610586938A CN106020224B CN 106020224 B CN106020224 B CN 106020224B CN 201610586938 A CN201610586938 A CN 201610586938A CN 106020224 B CN106020224 B CN 106020224B
- Authority
- CN
- China
- Prior art keywords
- vector
- upper stage
- attitude
- stage
- control
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 230000006641 stabilisation Effects 0.000 claims abstract description 18
- 238000011105 stabilization Methods 0.000 claims abstract description 18
- 230000009466 transformation Effects 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000005096 rolling process Methods 0.000 claims description 6
- 230000009897 systematic effect Effects 0.000 abstract 1
- 230000036544 posture Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 230000014509 gene expression Effects 0.000 description 3
- 238000013178 mathematical model Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 2
- 241001669696 Butis Species 0.000 description 1
- 235000015842 Hesperis Nutrition 0.000 description 1
- 235000012633 Iberis amara Nutrition 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种考虑质心位置不确定性的上面级矢量推力控制方法,首先分析质心位置不确定对上面级姿控***期望姿态的影响。其次分析质心位置不确定性导致的上面级矢量推力对上面级实际作用力矩与控制器力矩的关系。最后设计考虑质心位置不确定时的上面级矢量推力控制率,包含姿态稳定阶段和姿态修正阶段。姿态稳定阶段可根据***稳态输出修正上面级本体的期望姿态并获取质心不确定性导致的控制器稳态输出;姿态修正阶段根据稳定阶段获取的参数消除质心位置不确定性对矢量推力控制的影响。本发明的矢量推力控制方法可使得上面级矢量发动机的推力矢量方向既能跟踪制导指令方向又通过上面级本体质心,保证了上面级轨道转移段的安全系数和变轨精度。
Description
技术领域
本发明属于飞行器姿态控制技术领域,涉及一种上面级矢量推力控制方法,特别适用于安装主矢量发动机的上面级。
背景技术
上面级一般是指在基础级运载火箭上面增加的相对独立的一级(或多级),其具有较强的任务适应性,能够完成轨道机动、有效载荷分离等任务,是提高运载火箭性能和任务适应能力的有效途径,其主要作用是提高运载火箭的运载能力和在轨部署多颗卫星的能力。
目前世界上主要的航天大国,如美国、俄罗斯、欧洲空间局等,均把发展火箭上面级当作提高航天运输***能力的重点进行开发。目前国外正在使用或正在进一步研制和发展的上面级有10多种型号。大型运载火箭所使用的上面级有半人马座G、液体过渡级、IUS、PAM-DIII、轨道转移级、H-II的第二级、质子号D级、阿里安5的上面级、微风上面级、Fregat上面级等等。美国的上面级大多数都考虑了通用性,既可用于航天飞机的发射任务,又能用于多种运载火箭的发射任务,并具备多星发射的能力。我国也成功地研制和发射了应用于长征二号丙改进型运载火箭的CZ-2C/FP、CZ-2C/SM两种型号的固体上面级和长征三号的三级低温上面级。
上面级通常是在初始入轨后工作,其主要功能是按照任务要求进行轨道转移和多星部署。现有上面级的主发动机一般为矢量发动机,相对上面级本体有两个转动自由度,用以提供轨道转移的动力。在上面级轨道转移段,对于轨道控制***,一般的推力矢量的控制方法为:通过利用矢量推力的主动偏心控制上面级的姿态,以达到矢量推力控制的目的。此类矢量推力控制方法,受上面级本体质心位置的影响较大,由于在轨辨识***的精度限制,上面级本体的质心存在一定的不确定性。质心位置的不确定不仅影响了上面级姿态控制时期望姿态的解算,也使得上面级本体实际所受的控制力矩与控制器输出的控制力矩不一致,从而导致上面级矢量推力的方向偏离制导指令方向。这样不仅降低了轨道转移的精度,而且降低了轨道转移的安全系数,从而增加了整个轨道转移过程中轨道修正的次数,同时也增加了燃料消耗。
发明内容
本发明解决的技术问题是:克服现有上面级推力矢量控制技术的不足,提供了一种考虑质心位置不确定性的上面级矢量推力控制方法,可以在上面级动力飞行段实际质心位置不精确已知的情况下,保证上面级矢量发动机的矢量推力既能跟踪制导指令方向,又通过上面级本体的质心,从而提高上面级轨道转移段的安全系数和入轨精度,减小轨道修正的次数。
本发明的技术解决方案是:一种考虑质心位置不确定性的上面级矢量推力控制方法,包括如下步骤:
(1)根据已知上面级的质心位置rc,计算矢量推力过质心位置rc时矢量发动机相对上面级本体的转角(αsd,βsd);
(2)根据上面级矢量发动机矢量推力的制导指令方向(ξd,ζd)获取矢量发动机的制导指令姿态其中(ξd,ζd)分别为制导***给出的期望的矢量推力在轨道坐标系下的俯仰角和方向角;
(3)根据矢量发动机的制导指令姿态和矢量推力通过上面级质心位置rc时的矢量发动机相对上面级本体的转角(αsd,βsd)计算上面级本体的期望姿态角
(4)采用控制率对上面级进行姿态控制,使得矢量推力的方向既能跟踪制导指令方向又能通过上面级本体质心位置rc;其中kD>0,kP>0为控制器的增益系数,Tb=[Tbx Tby Tbz]T为上面级本体的控制力矩,Tbx,Tby,Tbz分别为滚转轴、俯仰轴和偏航轴的控制力矩,I为上面级本体的转动惯量;
(5)获取经过步骤(4)控制稳定后矢量发动机相对上面级本体的转角(αbs,βbs),再次根据矢量发动机的制导指令方向计算获得上面级的实际期望姿态角
(6)采用控制率对上面级再次进行姿态控制,使得矢量推力的方向既能跟踪制导指令方向又能通过上面级本体的实际质心位置其中(Tb)p1为经过步骤(4)控制稳定后控制器输出的稳态控制力矩。
所述的矢量发动机相对上面级本体的转角(αsd,βsd)满足关系式
其中,rc=[rcx rcy rcz]T为已知的上面级本体质心位置。
所述的矢量发动机的制导指令方向(ξd,ζd)与制导指令姿态满足关系式其中为矢量发动机的期望俯仰姿态角,为矢量发动机期望偏航姿态角。
所述的φd为上面级本体的期望滚转角,θd为上面级本体的期望俯仰角,ψd为上面级本体的期望偏航角,其中为矩阵第i行j列的元素,为上面级轨道坐标系到上面级本体坐标系的坐标转换矩阵。
本发明与现有技术相比的优点在于:本发明方法充分考虑了质心位置不确定性对上面级矢量推力控制的影响,消除了质心位置不确定导致的矢量推力偏离制导指令方向的问题。由于上面级的矢量推力控制是姿态控制***实现的,因此本发明方法首先给出了通过已知质心位置rc和矢量推力的制导指令方向(ξd,ζd)来计算上面级本体期望姿态的方法和矢量推力偏心时的力矩公式。其次,分析了质心位置不确定性对姿态控制***中上面级本体期望姿态的影响。然后分析了质心位置不确定引起的实际作用在上面级本体的控制力矩与控制器设计的控制力矩Tb之间的关系。最后,设计了上面级矢量推力的控制率,为消除质心不确定性对控制***的影响,控制过程分为两个阶段:姿态稳定阶段和姿态修正阶段。通过本发明方法完成的推力矢量控制,可以消除质心位置不确定导致的上面级矢量推力控制***的偏差,使推力矢量与制导指令方向一致,且推力矢量通过上面级本体的质心,从而提高上面级轨道转移段的安全系数和入轨精度,减小了轨道修正的次数。
附图说明
图1为轨道中上面级和轨道系中矢量推力的示意图;
图2为上面级的构型和坐标系示意图;
图3为本发明的推力矢量控制流程图;
图4为控制力控制力矩和实际作用力矩之间的关系图;
图5为矢量推力控制***的控制目标示意图;
图6为本发明的控制器设计流程图。
具体实施方式
如图1(a)所示,为轨道中的上面级,图中,OIXIYIZI为地球惯性坐标系,其中,原点OI在地球质心,XI轴指向春分点,ZI轴指向地球北极,YI轴与XI轴、ZI轴组成右手坐标系。oxoyozo为上面级的轨道坐标系,其中,原点o在上面级本体质心,xo轴指向上面级的速度方向,zo轴指向地心,yo轴与xo轴、zo轴组成右手坐标系。图1(b)所示为矢量推力在上面级轨道坐标系下的定义,其中(ξ,ζ)分别为矢量推力在轨道坐标系下的俯仰角和方向角,根据投影关系,矢量推力的方向和(ξ,ζ)是一一对应的。
如图2(a)所示为上面级的构型图。本发明中,上面级为标准配置,安装一个矢量发动机、8个滚转方向的RCS发动机、2个俯仰方向的RCS发动机和2个偏航方向的RCS发动机,安装方向如图2(a)所示。轨道转移段,矢量发动机用以提供轨道转移的动力、俯仰和偏航轴的姿态控制力矩,8个RCS发动机用以提供滚转轴的姿态控制力矩。2个俯仰方向和2个偏航方向的RCS发动机用以提供无轨控阶段的姿态控制,在本发明中不做使用,仅用于描述上面级的整体构型。图中,obxbybzb为上面级的本体坐标系,用以描述上面级的姿态运动,当姿态角都为零时,上面级本体系obxbybzb和上面级轨道系oxoyozo方向一致;oaxayaza为上面级的布局坐标系(用以描述上面级本体质心位置和矢量发动机的旋转运动),上面级的本体坐标系和上面级的布局坐标下的各轴方向均相同,仅原点位置不同。上面级本体坐标系的原点ob在上面级本体的质心,而上面级布局坐标系的原点oa在矢量发动机的推力作用点。
图2(b)所示为矢量发动机相对上面级本体的运动描述。矢量发动机本体系相对上面级布局坐标系(本体系)有两个旋转自由度:首先,上面级布局坐标系绕ya轴的旋转角度为α,旋转后的坐标系定义为支架坐标系oaxkykzk(中间坐标系);然后,支架坐标系的zk轴的旋转角度为β,旋转后的坐标系即为矢量发动机的本体坐标系oaxgygzg。矢量发动机相对上面级本体的转角(α,β)是为了计算矢量推力在上面级本体坐标系下的分量,进而计算矢量推力偏心时对上面级本体产生的力矩大小。
本发明中采用矢量推力(矢量发动机的推力)主动偏心进行姿态控制以实现矢量推力控制的目的(主动控制偏心达到消除偏心的目的)。通过分析质心位置不确定对上面级本体姿态控制***的期望姿态产生的影响和矢量推力对上面级本体产生的控制力矩与控制器设计的控制力矩之间的关系,设计了包含姿态稳定阶段和姿态修正阶段的上面级姿态控制率,消除了质心位置不确定对矢量推力控制的影响,使得上面级的矢量推力既能跟踪其制导指令方向又通过上面级本体的质心,保证了上面级轨道转移的安全和精度。由于本发明方法针对的是一般情况,因此其中的策略具有可扩展性。
如图3所示,为本发明方法的流程图,其主要步骤如下:
1、根据已知上面级的质心位置rc,计算矢量推力过质心时矢量发动机相对上面级本体的转角(αsd,βsd)。
首先,根据各参数的定义计算矢量推力对上面级本体的力矩公式。步骤如下:
根据坐标系的定义,矢量推力在矢量发动机本体坐标系下的描述为
F=Fig+0jg+0kg
其中,F为矢量推力,F为推力的大小,ig,jg,kg分别为矢量发动机本体坐标系oaxgygzg坐标轴xg,yg,zg的单位矢量。
根据上面级布局坐标系oaxayaza和矢量发动机本体坐标系oaxgygzg的转动关系,可以得到上面级布局坐标系(本体系)到矢量发动机本体坐标系的坐标转换矩阵Aga(Agb)为
由此可得矢量推力在上面级布局坐标系下的描述为
F=F(cosβcosαia+sinβja-cosβsinαka)
ia,ja,ka分别为上面级布局坐标系oaxayaza坐标轴xa,ya,za的单位矢量。
令上面级本体质心在上面级布局坐标系下的位置为rc=[rcx rcy rcz]T,则矢量推力的力臂矢量为-rc,矢量发动机偏心时对上面级本体产生的力矩T(上面级布局坐标系或上面级本体系下描述)为
然后,根据上面级本体质心位置和矢量推力偏心时的力矩公式,即
由于(α,β)是小角度,因此将力矩公式线性化为:
其中,Tx,Ty,Tz为矢量推力对上面级本体产生的力矩T在滚转轴xb、俯仰轴yb和偏航轴zb的分量。式中,三个表达式只有两个自由变量(α,β),且满足:Ty=Tz=0时,Tx=0。
因此,矢量推力通过上面级本体质心位置时的矢量发动机相对上面级本体的两个自由度的转角(αsd,βsd)的计算公式为:
上式计算得到的转角(αsd,βsd)是根据已知质心位置rc计算得到的而非实际质心位置设根据计算的所需的实际转角为因此在(αsd,βsd)基础上计算得到上面级期望姿态角也将偏于由计算得到的实际的上面级期望姿态角
2、获取上面级本体期望的姿态角
为了保证完成姿态控制的矢量推力既为制导指令方向,又通过上面级本体的质心,需要特殊设计上面级本体的期望姿态角,下面给出详细步骤:
第一步,根据上面级矢量发动机矢量推力的制导指令方向(上面级轨道坐标系下描述)(ξd,ζd)((ξd,ζd)为制导***给出的期望的矢量推力在轨道坐标系下的俯仰角和方向角)获取矢量发动机的制导指令姿态
为了方便物理描述,采用3-2-1旋转顺序描述上面级本体和矢量发动机的姿态,则上面级的轨道坐标系到矢量发动机的本体坐标系变换矩阵为
其中, 为矢量发动机期望滚转姿态角,为矢量发动机期望俯仰姿态角,为矢量发动机期望偏航姿态角,c=cos(·),s=sin(·)。
则由制导指令姿态描述的矢量推力在上面级轨道坐标系下的分量Fo为
而根据图1(b)所示,由制导指令方向(ξd,ζd)描述的矢量推力在上面级的轨道坐标系下的描述为
Fo=F[sinξd cosξd cosζd cosξd sinζd]T
对比上述两式可得到俯仰和偏航两轴的制导指令姿态为
由于矢量推力沿矢量发动机本体坐标系的滚转轴方向,因此其制导指令方向未对矢量发动机的滚转姿态角进行约束,在此情况下,假设(此假设不影响结果,可以假设为任意约束)。
则上面级的轨道坐标系到矢量发动机的本体坐标系的期望坐标转换矩阵转化为
第二步,根据矢量发动机的制导指令姿态和矢量推力通过质心时的矢量发动机相对上面级本体的转角(αsd,βsd)计算上面级本体的期望姿态角
根据坐标系的定义:矢量推力通过上面级本体的质心时,上面级的本体坐标系(布局系)到矢量发动机本体坐标系的坐标转换矩阵为
则矢量推力既与制导指令方一致又通过上面级本体质心时,上面级轨道坐标系到上面级本体坐标系的坐标转换矩阵为
然后根据姿态的定义可得到矢量推力既与制导指令方一致又通过上面级本体质心时的上面级本体的期望姿态(3-2-1)为
其中,φd为上面级本体的期望滚转角,θd为上面级本体的期望俯仰角,ψd为上面级本体的期望偏航角,为矩阵第i行j列的元素。本部分设计的期望姿态角是用于设计控制律。
由于质心位置的不确定性,实际上推力通过实际质心位置时矢量发动机的转角为根据上述步骤,基于和(ξd,ζd)可以计算得到上面级本体实际的期望姿态角
3、实际控制力矩与控制器设计的控制力矩的关系
矢量发动机的转角(操纵律)由控制器的控制力矩Tb和已知的质心位置rc计算得到的,由于实际质心位置和rc存在一定偏差,因此实际作用在上面级本体的控制力矩和Tb并不一致,本部分推导其中关系,以便设计控制***,从Tb到的流程如图4所示。
第一步,计算操纵律:假设控制器输出的控制力矩为Tb=[Tbx Tby Tbz]T(上面级本体系下描述),由此得到为提供此控制力矩的矢量发动机转角(αb,βb)为
而RCS发动机提供的控制力矩为
Tx=Tbx-F·(αb·rcy+βb·rcz)
第二,计算实际控制力矩:根据实际质心位置和可得实际作用在上面级本体的控制力矩的表达式为
上式可转化为
其中,K和ΔT为常值矩阵。
4、控制***设计
本发明控制***设计的目的是:在考虑质心位置不确定的情况下,利用矢量推力和RCS发动机控制上面级本体的姿态,使得矢量推力为制导指令方向又通过上面级本体的质心。
如图5所示,用在轨道系oxoyozo下描述的上面级的状态参数描述矢量推力控制***的目的。已知:σu0为上面级本体的初始姿态,F0为矢量推力的初始方向,rc为已知的上面级本体的质心位置,且相对实际质心位置具有一定的偏差,其中是未知的。控制***的目的:在由于的未知对上面级姿态控制***的影响下,将上面级的姿态稳定到其实际的期望姿态从而使得矢量推力F的方向与其制导指令方向Fd一致,且通过上面级本体实际的质心
由于质心位置不确定的影响,本发明设计的控制***分为两个阶段:姿态稳定阶段和姿态修正阶段。姿态稳定阶段的控制目的是稳定姿态,然后根据稳态状态参数获取姿态修正信息;姿态修正阶段的目的在于根据获取的修正信息对上面级的姿态进行修正,使得矢量推力为制导指令方向又通过上面级本体的质心。
控制***的设计流程如图6所示,具体流程如下:
第一步,首先建立***数学模型。
上面级的动力学模型为
其中,I为上面级本体的转动惯量,ω=[ωx ωy ωz]T为上面级本体相对轨道坐标系的三轴角速度,ωx为滚转角速度,ωy俯仰角速度,ωz为偏航加速度,T为上面级本体的控制力矩,为ω的一阶导数,为叉乘矩阵,
上面级的运动学数学模型(3-2-1旋转顺序)为
其中,σ=[φ θ ψ]T为上面级的姿态角,φ为滚转角,θ为俯仰角,ψ为偏航角,为姿态角速度,Aωσ为变换矩阵。
上面级在动力飞行段,其姿态运动为小角度运动,因此***的运动学和动力学数学模型可线性化为
设控制器输出的控制力矩为Tb,则上面级本体实际所受的控制力矩为将其代入动力学中可得上面级的实际动力学和控制器输出之间的关系为
控制器设计的目的在于设计Tb,使得上面级的姿态达到任务要求。
第二步,姿态稳定控制器设计。
在实际工程中,质心的位置rc是辨识***得到的,由于辨识***精度的限制,虽然rc和实际质心位置是有偏差的,但是不可知的。因此本发明首先利用rc获取的上面级期望姿态设计姿态稳定阶段的姿态控制器,然后根据控制***的稳态参数获取修正参数,供修正阶段的控制器使用。
姿态稳定阶段的姿态控制器设计与分析如下:
定义***状态误差:则姿态稳定阶段的控制器设计为
其中,kD>0,kP>0为控制器的增益系数,Tb=[Tbx Tby Tbz]T为上面级本体的控制力矩,Tbx,Tby,Tbz分别为滚转、俯仰和偏航轴的控制力矩。
为证明控制律作用下***的稳定性,将控制律表达式带入到动力学模型中,
其中,E3为三阶单位阵,kD>0,kP>0且(E3+I-1KI)>0,根据传统控制***的稳定性原理可知:姿态控制***是渐进稳定的。
(1)由于常值输入I-1ΔT的存在,控制***的状态会有稳态误差,即姿态误差:当时间t→∞时。(2)***稳态时,Tb→-IkPσe→-(E3+K)-1ΔT,即稳态时控制器输出的控制力矩(Tb)p1与ΔT的关系为:(Tb)p1=-(E3+K)-1ΔT。(3)此时上面级本体实际所受的力矩:即***稳定时,上面级的矢量推力通过上面级本体的实际质心位置设此时矢量发动机相对上面级本体的转角为(αbs,βbs),则有
姿态稳定控制器作用后,当***稳定时,上面级矢量推力F通过上面级本体实际质心位置但由于质心不确定导致的上面级本体期望姿态与实际期望姿态之间的偏差和控制设计力矩Tb和实际作用力矩之间的偏差,导致了矢量推力的方向偏离了其制导指令方向。因此,需要在姿态稳定控制器的基础上设计姿态修正控制器,以完成矢量推力控制任务。
第三步,姿态修正控制器设计
为设计姿态修正控制器,首先,根据姿态稳定阶段稳态时,矢量发动机相对上面级本体的转角(αbs,βbs)和矢量发动机的制导指令方向获取按步骤2中获取“上面级本体期望的姿态角”的方法计算上面级本体实际的期望姿态角
令***状态误差为:则姿态修正阶段的控制器设计为
其中,kD>0,kP>0与姿态稳定阶段控制器的参数相同,(Tb)p1为姿态稳定阶段控制器输出的稳态控制力矩。
为证明控制律作用下***的稳定性,将控制律表达式带入到动力学模型中,
其中,kD>0,kP>0且(E3+I-1KI)>0,根据传统控制***的稳定性原理可知:姿态控制***是渐进稳定的。由此可得:且Tb→(Tb)p1当t→∞;即且(ξ,ζ)→(ξd,ζd)。
按照上述步骤进行上面级本体的姿态控制,当姿态控制***稳定后:且(ξ,ζ)→(ξd,ζd)。即根据姿态稳定控制和姿态修正控制***,所述的姿态控制***稳定后,消除了质心不确定对上面级矢量推力控制的影响,使得实际工程中上面级的推力矢量既能跟踪制导指令方向,又通过上面级本体的质心。即满足:(ξ,ζ)=(ξd,ζd)、T=r×F=0。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (4)
1.一种考虑质心位置不确定性的上面级矢量推力控制方法,其特征在于包括如下步骤:
(1)根据已知上面级的质心位置rc,计算矢量推力过质心位置rc时矢量发动机相对上面级本体的转角(αsd,βsd);
(2)根据上面级矢量发动机矢量推力的制导指令方向(ξd,ζd)获取矢量发动机的制导指令姿态其中(ξd,ζd)分别为制导***给出的期望的矢量推力在轨道坐标系下的俯仰角和方向角;
(3)根据矢量发动机的制导指令姿态和矢量推力通过上面级质心位置rc时的矢量发动机相对上面级本体的转角(αsd,βsd)计算上面级本体的期望姿态角
(4)采用控制率对上面级进行姿态控制,使得矢量推力的方向既能跟踪制导指令方向又能通过上面级本体质心位置rc;其中kD>0,kP>0为控制器的增益系数,Tb=[Tbx Tby Tbz]T为上面级本体的控制力矩,Tbx,Tby,Tbz分别为滚转轴、俯仰轴和偏航轴的控制力矩,I为上面级本体的转动惯量;
(5)获取经过步骤(4)控制稳定后矢量发动机相对上面级本体的转角(αbs,βbs),再次根据矢量发动机的制导指令方向计算获得上面级的实际期望姿态角
(6)采用控制率对上面级再次进行姿态控制,使得矢量推力的方向既能跟踪制导指令方向又能通过上面级本体的实际质心位置其中(Tb)p1为经过步骤(4)控制稳定后控制器输出的稳态控制力矩。
2.根据权利要求1所述的一种考虑质心位置不确定性的上面级矢量推力控制方法,其特征在于:所述的矢量发动机相对上面级本体的转角(αsd,βsd)满足关系式
其中,rc=[rcx rcy rcz]T为已知的上面级本体质心位置。
3.根据权利要求1或2所述的一种考虑质心位置不确定性的上面级矢量推力控制方法,其特征在于:所述的矢量发动机的制导指令方向(ξd,ζd)与制导指令姿态满足关系式其中为矢量发动机的期望俯仰姿态角,为矢量发动机期望偏航姿态角,上面级本体和矢量发动机的姿态采用3-2-1旋转顺序描述。
4.根据权利要求3所述的一种考虑质心位置不确定性的上面级矢量推力控制方法,其特征在于:所述的φd为上面级本体的期望滚转角,θd为上面级本体的期望俯仰角,ψd为上面级本体的期望偏航角,其中为矩阵第i行j列的元素,为上面级轨道坐标系到上面级本体坐标系的坐标转换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610586938.5A CN106020224B (zh) | 2016-07-22 | 2016-07-22 | 一种考虑质心位置不确定性的上面级矢量推力控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610586938.5A CN106020224B (zh) | 2016-07-22 | 2016-07-22 | 一种考虑质心位置不确定性的上面级矢量推力控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106020224A CN106020224A (zh) | 2016-10-12 |
CN106020224B true CN106020224B (zh) | 2019-01-08 |
Family
ID=57117672
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610586938.5A Expired - Fee Related CN106020224B (zh) | 2016-07-22 | 2016-07-22 | 一种考虑质心位置不确定性的上面级矢量推力控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106020224B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109976362B (zh) * | 2019-03-15 | 2022-03-25 | 中国西安卫星测控中心 | 一种使用差分进化算法的火箭上面级弹道重规划方法 |
CN112066943B (zh) * | 2020-07-28 | 2022-04-12 | 中国空间技术研究院 | 一种矢量调节转动机构转动角度的计算方法及装置 |
CN113567134A (zh) * | 2021-07-08 | 2021-10-29 | 北京星途探索科技有限公司 | 一种姿控发动机悬吊试验装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030016172A1 (en) * | 2001-07-23 | 2003-01-23 | Mitsubishi Denki Kabushiki Kaisha | Satellite-tracking antenna controlling apparatus |
US20040167683A1 (en) * | 2001-06-26 | 2004-08-26 | Kristen Lagadec | Method and device for controlling satellite attitude and steering using a gyrodyne cluster |
CN101708780B (zh) * | 2009-11-26 | 2012-12-05 | 哈尔滨工业大学 | 用于目标姿态跟踪的刚性航天器的控制方法 |
CN104527994A (zh) * | 2015-01-21 | 2015-04-22 | 哈尔滨工业大学 | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 |
CN104570742A (zh) * | 2015-01-29 | 2015-04-29 | 哈尔滨工业大学 | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 |
CN104634190A (zh) * | 2015-02-17 | 2015-05-20 | 北京精密机电控制设备研究所 | 具有简易姿控功能的机电伺服***及飞行器 |
-
2016
- 2016-07-22 CN CN201610586938.5A patent/CN106020224B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040167683A1 (en) * | 2001-06-26 | 2004-08-26 | Kristen Lagadec | Method and device for controlling satellite attitude and steering using a gyrodyne cluster |
US20030016172A1 (en) * | 2001-07-23 | 2003-01-23 | Mitsubishi Denki Kabushiki Kaisha | Satellite-tracking antenna controlling apparatus |
CN101708780B (zh) * | 2009-11-26 | 2012-12-05 | 哈尔滨工业大学 | 用于目标姿态跟踪的刚性航天器的控制方法 |
CN104527994A (zh) * | 2015-01-21 | 2015-04-22 | 哈尔滨工业大学 | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 |
CN104570742A (zh) * | 2015-01-29 | 2015-04-29 | 哈尔滨工业大学 | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 |
CN104634190A (zh) * | 2015-02-17 | 2015-05-20 | 北京精密机电控制设备研究所 | 具有简易姿控功能的机电伺服***及飞行器 |
Non-Patent Citations (1)
Title |
---|
上面级轨道转移段姿态控制技术;王召辉;《中国空间科学技术》;20141031(第5期);第41-48页 |
Also Published As
Publication number | Publication date |
---|---|
CN106020224A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Hu et al. | Robust fault-tolerant tracking control for spacecraft proximity operations using time-varying sliding mode | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN105867401B (zh) | 单框架控制力矩陀螺群的航天器姿态容错控制方法 | |
CN105159310B (zh) | 一种惯性系航天器姿态控制/角动量管理方法 | |
CN109911249B (zh) | 低推重比飞行器的星际转移有限推力入轨迭代制导方法 | |
US20080315039A1 (en) | System and methods for space vehicle torque balancing | |
Sun | Adaptive fault-tolerant constrained control of cooperative spacecraft rendezvous and docking | |
CN104570742B (zh) | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 | |
CN110794863A (zh) | 一种控制性能指标可定制的重型运载火箭姿态控制方法 | |
CN105629732B (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
CN106094853B (zh) | 一种上面级轨道转移段矢量推力的控制方法 | |
CN106020224B (zh) | 一种考虑质心位置不确定性的上面级矢量推力控制方法 | |
Jin et al. | Attitude control of a spacecraft with single variable-speed control moment gyroscope | |
CN114706413A (zh) | 近地轨道微纳卫星变质心姿态控制方法及*** | |
Somov et al. | Health checking autonomous attitude control system of Earth-observing miniature satellite in initial orientation modes | |
Wang et al. | Thrust vector control of upper stage with a gimbaled thruster during orbit transfer | |
CN110955255B (zh) | 基于cmg的高精度轨控姿态维持方法、***及介质 | |
CN114265420B (zh) | 适于高动态、控制慢响应的制导控制一体化设计方法 | |
Somov et al. | Health checking of a spacecraft control system in the orientation initial modes | |
Zhang | The output torque estimation of MCMG for agile satellites | |
Zhang et al. | Quaternion-based reusable launch vehicle composite attitude control via active disturbance rejection control and sliding mode approach | |
Mohammed et al. | Magnetorquer control for orbital manoeuvre of low earth orbit microsatellite | |
Somov et al. | Nonlinear dynamics of a spacecraft control system in the orientation initial modes | |
Wang et al. | Thrust Vector Control for Powered Flight of the Upper Stages | |
Grøtli | Modeling and control of formation flying satellites in 6 DOF |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190108 |