CN116301008B - 运载火箭控制方法、运载火箭、电子设备及存储介质 - Google Patents
运载火箭控制方法、运载火箭、电子设备及存储介质 Download PDFInfo
- Publication number
- CN116301008B CN116301008B CN202310566867.2A CN202310566867A CN116301008B CN 116301008 B CN116301008 B CN 116301008B CN 202310566867 A CN202310566867 A CN 202310566867A CN 116301008 B CN116301008 B CN 116301008B
- Authority
- CN
- China
- Prior art keywords
- time
- real
- coordinate system
- angle
- carrier rocket
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 65
- 239000011159 matrix material Substances 0.000 claims description 113
- 238000012546 transfer Methods 0.000 claims description 78
- 230000001131 transforming effect Effects 0.000 claims description 24
- 238000004590 computer program Methods 0.000 claims description 10
- 230000007704 transition Effects 0.000 claims description 7
- 230000004044 response Effects 0.000 abstract description 13
- 230000009466 transformation Effects 0.000 description 22
- 238000006243 chemical reaction Methods 0.000 description 11
- 230000008569 process Effects 0.000 description 9
- 238000004891 communication Methods 0.000 description 7
- 230000005540 biological transmission Effects 0.000 description 5
- 238000013461 design Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 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
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请公开了一种运载火箭控制方法、运载火箭、电子设备及存储介质,涉及航空航天技术领域,其中方法包括:获取运载火箭在当前飞行时刻的目标攻角、实时侧滑角和在发射坐标系中的实时速度矢量;基于所述实时速度矢量,确定所述运载火箭在所述当前飞行时刻的实时弹道倾角和实时弹道偏角;基于所述实时弹道倾角、所述实时弹道偏角、所述目标攻角、所述实时侧滑角,以及所述运载火箭在所述当前飞行时刻的姿态关联关系,确定所述运载火箭在所述当前飞行时刻的实时俯仰角和实时偏航角;对所述运载火箭的飞行姿态进行控制。本申请提供的方法和装置,提高了俯仰角和偏航角的求解效率,提高了运载火箭的控制响应速度。
Description
技术领域
本申请涉及航空航天技术领域,具体而言,涉及一种运载火箭控制方法、运载火箭、电子设备及存储介质。
背景技术
在运载火箭的研制过程中,弹道设计是一项需要进行顶层规划和首先研究的总体设计工作,它为制导控制***和箭体结构***设计提供输入,因此弹道设计是一项非常重要的工作。运载火箭在沿着弹道飞行时,一般都是采用程序角转弯的控制方式,预先设计一个指令攻角,然后由指令攻角换算得到火箭在发射惯性坐标系的姿态角。该姿态角至少包括俯仰角和偏航角。
因此,如何快速而准确地确定运载火箭的俯仰角和偏航角,提高运载火箭的控制响应速度成为业界亟待解决的技术问题。
发明内容
本申请提供一种运载火箭控制方法、运载火箭、电子设备及存储介质,用于解决如何快速而准确地确定运载火箭的俯仰角和偏航角,提高运载火箭的控制响应速度的技术问题。
本申请提供一种运载火箭控制方法,包括:
获取运载火箭在当前飞行时刻的目标攻角、实时侧滑角和在发射坐标系中的实时速度矢量;
基于所述实时速度矢量,确定所述运载火箭在所述当前飞行时刻的实时弹道倾角和实时弹道偏角;
基于所述实时弹道倾角、所述实时弹道偏角、所述目标攻角、所述实时侧滑角,以及所述运载火箭在所述当前飞行时刻的姿态关联关系,确定所述运载火箭在所述当前飞行时刻的实时俯仰角和实时偏航角;
基于所述实时俯仰角和所述实时偏航角对所述运载火箭的飞行姿态进行控制;
其中,所述姿态关联关系是基于所述运载火箭的发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间的姿态转移矩阵确定的。
在一些实施例中,所述姿态关联关系是基于如下步骤确定的:
基于所述运载火箭的方位角、发射点地理纬度、当前飞行时刻,以及地球自转角速度,确定所述发射惯性坐标系变换到所述发射坐标系的第一姿态转移矩阵;
基于所述运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,确定所述发射坐标系变换到所述速度坐标系的第二姿态转移矩阵;
基于所述运载火箭在当前飞行时刻的目标攻角和实时侧滑角,确定所述速度坐标系变换到所述箭体坐标系的第三姿态转移矩阵;
基于所述第一姿态转移矩阵、所述第二姿态转移矩阵和所述第三姿态转移矩阵,确定所述发射惯性坐标系变换到所述箭体坐标系的第四姿态转移矩阵;
基于所述运载火箭在当前飞行时刻在所述发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,确定所述发射惯性坐标系变换到所述箭体坐标系的第五姿态转移矩阵;
基于所述第四姿态转移矩阵和所述第五姿态转移矩阵,确定所述姿态关联关系。
在一些实施例中,所述基于所述运载火箭的方位角、发射点地理纬度、当前飞行时刻,以及地球自转角速度,确定所述发射惯性坐标系变换到所述发射坐标系的第一姿态转移矩阵,包括:
其中,为所述发射惯性坐标系/>到所述发射坐标系/>的第一姿态转移矩阵,/>为所述方位角,/>为所述发射点地理纬度,/>为当前飞行时刻,/>为所述地球自转角速度,为用于表示绕坐标系的/>轴旋转的旋转矩阵;/>为用于表示绕坐标系的/>轴旋转的旋转矩阵;/>为用于表示绕坐标系的/>轴旋转的旋转矩阵。
在一些实施例中,所述基于所述运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,确定所述发射坐标系变换到所述速度坐标系的第二姿态转移矩阵,包括:
其中,为所述发射坐标系/>到所述速度坐标系/>的第二姿态转移矩阵,/>为所述实时速度倾角,/>为所述实时弹道偏角,/>为所述实时弹道倾角。
在一些实施例中,所述基于所述运载火箭在当前飞行时刻的目标攻角和实时侧滑角,确定所述速度坐标系变换到所述箭体坐标系的第三姿态转移矩阵,包括:
其中,为所述速度坐标系/>到所述箭体坐标系/>的第三姿态转移矩阵,/>为所述目标攻角,/>为所述实时侧滑角。
在一些实施例中,所述基于所述运载火箭在当前飞行时刻在所述发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,确定所述发射惯性坐标系变换到所述箭体坐标系的第五姿态转移矩阵,包括:
其中,为所述发射惯性坐标系/>到所述箭体坐标系/>的第五姿态转移矩阵,/>为所述实时俯仰角,/>为所述实时偏航角,/>为所述实时滚转角。
在一些实施例中,所述实时偏航角基于如下公式求解:
所述实时俯仰角基于如下公式求解:
式中,为三维矩阵/>中的元素,/>为三维矩阵/>中的元素,/>为行号,/>为列号;为第一中间变量;/>为第二中间变量;/>为第三中间变量;/>为第四中间变量;
;
;
。
本申请提供一种运载火箭,包括火箭本体,以及设置在所述火箭本体上的箭载计算机;
所述箭载计算机用于执行所述的运载火箭控制方法。
本申请提供一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述程序时实现所述的运载火箭控制方法。
本申请提供一种非暂态计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现所述的运载火箭控制方法。
本申请提供一种运载火箭,包括火箭本体,以及设置在所述火箭本体上的箭载计算机;所述箭载计算机用于执行所述的运载火箭控制方法。
本申请提供一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述程序时实现所述的运载火箭控制方法。
本申请提供一种非暂态计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现所述的运载火箭控制方法。
本申请提供的运载火箭控制方法、运载火箭、电子设备及存储介质,根据运载火箭的发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间的姿态转移矩阵确定了姿态关联关系,根据运载火箭在当前飞行时刻的实时速度矢量,确定实时弹道倾角和实时弹道偏角,根据实时弹道倾角、实时弹道偏角、实时侧滑角和目标攻角,以及运载火箭在当前飞行时刻的姿态关联关系,确定运载火箭在当前飞行时刻的实时俯仰角和实时偏航角,对运载火箭的飞行姿态进行控制,由于姿态关联关系是根据各个坐标系之间的姿态转移矩阵建立的,相比于相关技术中的三角函数求反解,易于通过计算机进行快速求解,提高了运载火箭的俯仰角和偏航角的计算速度,避免了将各个姿态转移矩阵逐个展开再相乘的繁琐运算过程,提高了俯仰角和偏航角的求解效率,缩短了俯仰角和偏航角的求解时间,提高了运载火箭的控制响应速度,缩短了运载火箭的控制响应时间,提高了运载火箭的控制性能。
附图说明
此处的附图被并入说明书中并构成本说明书的一部分,示出了符合本申请的实施例,并与说明书一起用于解释本申请的原理。
为了更清楚地说明本申请或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请一个实施例提供的运载火箭控制方法的流程示意图;
图2是本申请一个实施例提供的运载火箭坐标系变换的示意图;
图3是本申请一个实施例提供的运载火箭的结构示意图;
图4是本申请一个实施例提供的电子设备的结构示意图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,本申请中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或模块的过程、方法、***、产品或设备不必限于清楚地列出的那些步骤或模块,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或模块。
图1为本申请一个实施例提供的运载火箭控制方法的流程示意图,如图1所示,该方法包括步骤110、步骤120、步骤130和步骤140。
步骤110、获取运载火箭在当前飞行时刻的目标攻角、实时侧滑角和在发射坐标系中的实时速度矢量。
具体地,本申请实施例提供的运载火箭控制方法的执行主体可以为运载火箭的箭载计算机。
飞行时刻是指运载火箭沿弹道飞行的各个时刻。攻角为运载火箭的速度方向与运载火箭的纵对称轴之间的夹角。目标攻角为运载火箭在当前飞行时刻进行转弯时需要保持的攻角。实时速度矢量包括运载火箭在当前飞行时刻的速度大小和速度方向。实时侧滑角是指运载火箭的实时速度矢量与运载火箭的纵向对称面之间的夹角。
运载火箭在发射升空的过程中,涉及的坐标系主要包括发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系。
其中,发射坐标系是指以发射点为原点O,OX轴在发射点水平面内指向发射瞄准方向,OY轴垂直于发射点水平面向上,OZ轴分别与OX轴、OY轴垂直而构成的右手直角坐标系。例如,发射坐标系中的原点O可以为运载火箭的发射点在大地坐标系参考椭球体表面的投影点。OX轴可以为经过原点的参考椭球体切平面内指向发射方向,OY可以与参考椭球体当地法线方向一致并且指向上方。运载火箭的发射点一经确定,则整个发射坐标系就已经确定,并在运载火箭的整个发射过程中保持不变。
发射惯性坐标系在运载火箭起飞瞬间与发射坐标系重合,运载火箭起飞后,发射坐标系中各个坐标轴的方向在惯性空间保持不变。
速度坐标系以运载火箭的质心为原点O,OX轴(也可以表示为轴)的方向为沿运载火箭的飞行速度方向,OY轴(也可以表示为/>轴)在运载火箭的主对称面(纵向对称面)内并垂直于OX轴指向上为正,OZ轴(也可以表示为/>轴)垂直于OX轴和OY轴形成的平面,顺着运载火箭的飞行方向看去指向右方。
箭体坐标系以运载火箭的质心为原点O,OX轴沿着运载火箭的箭体外壳对称轴指向运载火箭的头部,OY轴在运载火箭的主对称面内并垂直于OX轴指向上为正,OZ轴垂直于OX轴和OY轴形成的平面,顺着运载火箭的发射方向看去指向右方。
步骤120、基于实时速度矢量,确定运载火箭在当前飞行时刻的实时弹道倾角和实时弹道偏角。
具体地,对运载火箭的实时速度矢量进行解析,可以得到运载火箭在当前飞行时刻的实时弹道倾角和实时弹道偏角。
实时弹道倾角是指运载火箭的实时速度矢量与水平面之间的夹角。实时弹道偏角是指运载火箭的实时速度矢量在水平面的投影与发射坐标系的OX轴之间的夹角。
步骤130、基于实时弹道倾角、实时弹道偏角、目标攻角、实时侧滑角,以及运载火箭在当前飞行时刻的姿态关联关系,确定运载火箭在当前飞行时刻的实时俯仰角和实时偏航角。
其中,姿态关联关系是基于运载火箭的发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间的姿态转移矩阵确定的。
具体地,发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间存在变换关系,这些变换关系可以通过姿态转移矩阵进行表示。姿态转移矩阵与对应坐标系下的姿态角相关。
可以根据各个坐标系之间的姿态转换矩阵进行矩阵运算,得到姿态关联关系。姿态关联关系用于表示在各个坐标系中姿态角之间的关联关系。
这些姿态角至少包括:
(1)发射惯性坐标系中的俯仰角、偏航角和滚转角等;
(2)发射坐标系中的速度倾角和弹道倾角等;
(3)速度坐标系中的攻角和侧滑角等。
将实时弹道倾角和实时弹道偏角代入姿态关联关系,可以求解得到运载火箭在当前飞行时刻的实时俯仰角和实时偏航角。实时俯仰角为运载火箭在当前飞行时刻进行转弯时的俯仰角。实时偏航角为运载火箭在当前飞行时刻进行转弯时的偏航角。实时滚转角为运载火箭在当前飞行时刻进行转弯时的滚转角。
步骤140,基于实时俯仰角和实时偏航角对运载火箭的飞行姿态进行控制。
具体地,根据实时俯仰角和实时偏航角可以得到运载火箭的姿轨控发动机的控制参数,从而控制运载火箭的姿轨控发动机改变输出,对运载火箭的飞行姿态进行控制,使得运载火箭的俯仰角和偏航角进行改变,完成转弯动作。
本申请实施例提供的运载火箭控制方法,根据运载火箭的发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间的姿态转移矩阵确定了姿态关联关系,根据运载火箭在当前飞行时刻的实时速度矢量,确定实时弹道倾角和实时弹道偏角,根据实时弹道倾角、实时弹道偏角、实时侧滑角和目标攻角,以及运载火箭在当前飞行时刻的姿态关联关系,确定运载火箭在当前飞行时刻的实时俯仰角和实时偏航角,对运载火箭的飞行姿态进行控制,由于姿态关联关系是根据各个坐标系之间的姿态转移矩阵建立的,相比于相关技术中的三角函数求反解,易于通过计算机进行快速求解,提高了运载火箭的俯仰角和偏航角的计算速度,避免了将各个姿态转移矩阵逐个展开再相乘的繁琐运算过程,提高了俯仰角和偏航角的求解效率,缩短了俯仰角和偏航角的求解时间,提高了运载火箭的控制响应速度,缩短了运载火箭的控制响应时间,提高了运载火箭的控制性能。
需要说明的是,本申请每一个实施方式可以自由组合、调换顺序或者单独执行,并不需要依靠或依赖固定的执行顺序。
在一些实施例中,姿态关联关系是基于如下步骤确定的:
基于运载火箭的方位角、发射点地理纬度、当前飞行时刻,以及地球自转角速度,确定发射惯性坐标系变换到发射坐标系的第一姿态转移矩阵;
基于运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,确定发射坐标系变换到速度坐标系的第二姿态转移矩阵;
基于运载火箭在当前飞行时刻的目标攻角和实时侧滑角,确定速度坐标系变换到箭体坐标系的第三姿态转移矩阵;
基于第一姿态转移矩阵、第二姿态转移矩阵和第三姿态转移矩阵,确定发射惯性坐标系变换到箭体坐标系的第四姿态转移矩阵;
基于运载火箭在当前飞行时刻在发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,确定发射惯性坐标系变换到箭体坐标系的第五姿态转移矩阵;
基于第四姿态转移矩阵和第五姿态转移矩阵,确定姿态关联关系。
具体地,图2是本申请一个实施例提供的运载火箭坐标系变换的示意图,如图2所示,从发射惯性坐标系到箭体坐标系存在两种变换途径。第一种是从发射惯性坐标系变换至发射坐标系,从发射坐标系变换至速度坐标系,再从速度坐标系变换至箭体坐标系;第二种是从发射惯性坐标系直接变换至箭体坐标系。两种变换路径所得到的结果是相等的。因此,可以根据两种变换路径下姿态转换矩阵的矩阵运算,得到姿态关联关系。
从第一种变换途径出发,运载火箭的方位角是指从发射点的指北方向线起,依顺时针方向到目标方向线之间的水平夹角。根据当前飞行时刻和地球自转角速度,可以得到运载火箭的当前位置与发射点之间的地理经度变化,再根据方位角和发射点地理纬度,可以求解得到发射惯性坐标系到发射坐标系的第一姿态转移矩阵。根据运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,可以求解得到发射坐标系到速度坐标系的第二姿态转移矩阵。根据运载火箭在当前飞行时刻的目标攻角和实时侧滑角,可以求解得到速度坐标系到箭体坐标系的第三姿态转移矩阵。对上述三个姿态转移矩阵进行相乘运算,可以得到发射惯性坐标系到箭体坐标系的第四姿态转移矩阵。
从第二种变换途径出发,可以根据运载火箭在当前飞行时刻在发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,可以求解得到发射惯性坐标系变换到箭体坐标系的第五姿态转移矩阵。
由于第四姿态转移矩阵和第五姿态转移矩阵均是从发射惯性坐标系变换至箭体坐标系,两者是相等的,则可以得到姿态关联关系。
本申请实施例提供的运载火箭控制方法,根据运载火箭发射过程中涉及到的各个坐标系之间的姿态转移矩阵,得到姿态关联关系,便于实现对各个坐标系下的姿态角进行快速解算,提高了运载火箭的控制响应速度,缩短了运载火箭的控制响应时间,提高了运载火箭的控制性能。
在一些实施例中,基于运载火箭的方位角、发射点地理纬度、当前飞行时刻,以及地球自转角速度,确定发射惯性坐标系变换到发射坐标系的第一姿态转移矩阵,包括:
其中,为发射惯性坐标系/>到发射坐标系/>的第一姿态转移矩阵,/>为方位角,/>为发射点地理纬度,/>为当前飞行时刻,/>为地球自转角速度,/>为用于表示绕坐标系的/>轴旋转的旋转矩阵;/>为用于表示绕坐标系的/>轴旋转的旋转矩阵;/>为用于表示绕坐标系的轴旋转的旋转矩阵。
具体地,在各个坐标系的变换中,为用于表示绕坐标系的/>轴旋转角度为/>的旋转矩阵,可以表示为:
为用于表示绕坐标系的/>轴旋转角度为/>的旋转矩阵,可以表示为:
为用于表示绕坐标系的/>轴旋转角度为/>的旋转矩阵,可以表示为:
相对于发射惯性坐标系的三个坐标轴,发射坐标系/>中对应的三个轴都存在至少一次旋转。
发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为地球自转的角度(地理经度变化),可以通过地球自转角速度/>与当前飞行时刻/>的乘积得到。
发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为方位角。在坐标系的转换过程中,发生过两次旋转。
发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为发射点地理纬度。在坐标系的转换过程中,发生过两次旋转。
上述旋转的顺序为:
1、发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为/>;
2、发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为/>;
3、发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为/>;
4、发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为/>;
5、发射坐标系的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为/>。
根据上述角度旋转关系,各个轴对应的旋转矩阵,以及各个轴的旋转变换顺序,可以得到第一姿态转移矩阵。
本申请实施例提供的运载火箭控制方法,根据发射惯性坐标系和发射坐标系中三个坐标轴发生的旋转变换,得到第一姿态旋转矩阵,能够准确表示发射惯性坐标系和发射坐标系之间的转换关系。
在一些实施例中,基于运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,确定发射坐标系变换到速度坐标系的第二姿态转移矩阵,包括:
其中,为发射坐标系/>到速度坐标系/>的第二姿态转移矩阵,/>为实时速度倾角,/>为实时弹道偏角,/>为实时弹道倾角。
具体地,首先,速度坐标系的/>轴相对于发射坐标系/>中的/>轴绕过的角度为实时弹道倾角/>;其次,速度坐标系/>的/>轴相对于发射坐标系/>中的/>轴绕过的角度为实时弹道偏角/>;最后,速度坐标系/>的/>轴相对于发射坐标系/>中的/>轴绕过的角度为实时速度倾角/>。
根据上述角度旋转关系,各个轴对应的旋转矩阵,以及各个轴的旋转变换顺序,可以得到第二姿态转移矩阵。
本申请实施例提供的运载火箭控制方法,根据发射坐标系和速度坐标系中三个坐标轴发生的旋转变换,得到第二姿态旋转矩阵,能够准确表示发射坐标系和速度坐标系之间的转换关系。
在一些实施例中,基于运载火箭在当前飞行时刻的目标攻角和实时侧滑角,确定速度坐标系变换到箭体坐标系的第三姿态转移矩阵,包括:
其中,为速度坐标系/>到箭体坐标系/>的第三姿态转移矩阵,/>为目标攻角,/>为实时侧滑角。
具体地,首先,速度坐标系中的/>轴相对于箭体坐标系/>中的/>轴绕过的角度为实时侧滑角/>;其次,速度坐标系/>中的/>轴相对于箭体坐标系/>中的/>轴绕过的角度为目标攻角/>。
根据上述角度旋转关系,各个轴对应的旋转矩阵,以及各个轴的旋转变换顺序,可以得到第三姿态转移矩阵。
本申请实施例提供的运载火箭控制方法,根据速度坐标系和箭体坐标系中三个坐标轴发生的旋转变换,得到第三姿态旋转矩阵,能够准确表示速度坐标系和箭体坐标系之间的转换关系。
在一些实施例中,基于第一姿态转移矩阵、第二姿态转移矩阵和第三姿态转移矩阵,确定发射惯性坐标系变换到箭体坐标系的第四姿态转移矩阵。
具体地,发射惯性坐标系变换到箭体坐标系/>的第四姿态转移矩阵/>可以表示为:
在一些实施例中,基于运载火箭在当前飞行时刻在发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,确定发射惯性坐标系变换到箭体坐标系的第五姿态转移矩阵,包括:
其中,为发射惯性坐标系/>到箭体坐标系/>的第五姿态转移矩阵,/>为实时俯仰角,/>为实时偏航角,/>为实时滚转角。
具体地,首先,箭体坐标系中的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为实时俯仰角/>;其次,箭体坐标系/>中的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为实时偏航角/>;最后,箭体坐标系/>中的/>轴相对于发射惯性坐标系/>中的/>轴绕过的角度为实时滚转角/>。
根据上述角度旋转关系,各个轴对应的旋转矩阵,以及各个轴的旋转变换顺序,可以得到第五姿态转移矩阵。
本申请实施例提供的运载火箭控制方法,根据箭体坐标系和发射惯性坐标系中三个坐标轴发生的旋转变换,得到第五姿态旋转矩阵,能够准确表示箭体坐标系和发射惯性坐标系之间的转换关系。
在一些实施例中,基于第四姿态转移矩阵和第五姿态转移矩阵,确定姿态关联关系。
具体地,由于第四姿态转移矩阵和第五姿态转移矩阵均是表示从发射惯性坐标系到箭体坐标系的转换关系,两者是相等的,可以得到第一关系式:
第一关系式可以用来表示姿态关联关系。
代入和/>,可以进一步得到第二关系式:
在第二关系式中:
中方位角/>,发射点地理纬度/>,地球自转角速度/>是已知的,当前飞行时刻/>也是已知的;实时弹道偏角/>和实时弹道倾角/>可以根据发射坐标系的实时速度矢量计算得到;目标攻角/>是预先设计,通过程序输入的;实时侧滑角/>是可以根据实时速度矢量与运载火箭的纵向对称面之间的夹角计算得到;对于运载火箭弹道设计而言,发射惯性坐标系下的实时滚转角/>可以设置为零。
因此,在第二关系式所涉及到的8个姿态角中,实时滚转角、目标攻角/>、实时侧滑角/>、实时弹道偏角/>和实时弹道倾角/>是已知的;只有实时速度倾角/>、实时俯仰角/>、实时偏航角/>是未知的。
考虑到,则/>,/>为3维单位矩阵,第二关系式可以简化为第三关系式:
由旋转矩阵的变换可知:
因此,第三关系式可以表示为第四关系式:
分别利用矩阵和矩阵/>表示旋转变换:
其中,为矩阵/>中的元素,/>为矩阵/>中的元素,/>为行号,/>为列号。
则第四关系式可以表示为:
对第四关系式进行展开,可以得到第五关系式:
进一步地,可以用大小为矩阵/>表示/>,则有:
可以得到:
其中,为矩阵/>中的元素,/>为行号,/>为列号。
由于矩阵对应的元素是相等的,则存在,即/>。考虑到/>,代入可以得到方程式:/>
记,/>为第一中间变量;/>为第二中间变量;/>为第三中间变量,则方程式可以表示:
对方程式进行求解,可以得到:
考虑到都是在0附近变化的小值,故/>,因此得到,由/>算出/>的数值,进而根据/>和/>,可以得到实时偏航角/>,并判断/>的正负号。
同理,存在,/>。
可以用矩阵表示为:
记,/>为第四中间变量,代入上述矩阵可以得到:
求解上述矩阵,可以得到和/>,进而可以得到实时俯仰角/>,并判断的正负号。
本申请实施例提供的运载火箭控制方法,通过两种变换路径下姿态转换矩阵的运算,得到可以表示姿态关联关系的矩阵,该矩阵可由计算机代码编程实现矩阵相乘获得,无需人工展开再相乘得到,可以提高俯仰角和偏航角的求解效率,缩短俯仰角和偏航角的求解时间,提高运载火箭的控制响应速度。
图3是本申请一个实施例提供的运载火箭的结构示意图,如图3所示,该运载火箭300,包括火箭本体310,以及设置在火箭本体310上的箭载计算机320;箭载计算机320用于执行上述实施例中的运载火箭控制方法。
本申请实施例提供的运载火箭,在发射过程中执行上述实施例中的控制方法,提高了运载火箭的俯仰角和偏航角的计算速度,避免了将各个姿态转移矩阵逐个展开再相乘的繁琐运算过程,提高了俯仰角和偏航角的求解效率,缩短了俯仰角和偏航角的求解时间,提高了运载火箭的控制响应速度,缩短了运载火箭的控制响应时间,提高了运载火箭的控制性能。
图4为本申请一个实施例提供的电子设备的结构示意图,如图4所示,该电子设备可以包括:处理器(Processor)410、通信接口(Communications Interface)420、存储器(Memory)430和通信总线(Communications Bus)440,其中,处理器410,通信接口420,存储器430通过通信总线440完成相互间的通信。处理器410可以调用存储器430中的逻辑命令,以执行上述方法,该方法包括:
获取运载火箭在当前飞行时刻的目标攻角、实时侧滑角和在发射坐标系中的实时速度矢量;基于实时速度矢量,确定运载火箭在当前飞行时刻的实时弹道倾角和实时弹道偏角;基于实时弹道倾角、实时弹道偏角、目标攻角、实时侧滑角,以及运载火箭在当前飞行时刻的姿态关联关系,确定运载火箭在当前飞行时刻的实时俯仰角和实时偏航角;基于实时俯仰角和实时偏航角对运载火箭的飞行姿态进行控制;其中,姿态关联关系是基于运载火箭的发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间的姿态转移矩阵确定的。
此外,上述的存储器中的逻辑命令可以通过软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干命令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
本申请实施例提供的电子设备中的处理器可以调用存储器中的逻辑指令,实现上述方法,其具体的实施方式与前述方法实施方式一致,且可以达到相同的有益效果,此处不再赘述。
本申请实施例还提供一种计算机可读的存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现以执行上述各实施例提供的方法。
其具体的实施方式与前述方法实施方式一致,且可以达到相同的有益效果,此处不再赘述。
本申请实施例提供一种计算机程序产品,包括计算机程序,计算机程序被处理器执行时实现如上述方法。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性的劳动的情况下,即可以理解并实施。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件。基于这样的理解,上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
最后应说明的是:以上实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围。
Claims (9)
1.一种运载火箭控制方法,其特征在于,包括:
获取运载火箭在当前飞行时刻的目标攻角、实时侧滑角和在发射坐标系中的实时速度矢量;
基于所述实时速度矢量,确定所述运载火箭在所述当前飞行时刻的实时弹道倾角和实时弹道偏角;
基于所述实时弹道倾角、所述实时弹道偏角、所述目标攻角、所述实时侧滑角,以及所述运载火箭在所述当前飞行时刻的姿态关联关系,确定所述运载火箭在所述当前飞行时刻的实时俯仰角和实时偏航角;
基于所述实时俯仰角和所述实时偏航角对所述运载火箭的飞行姿态进行控制;
其中,所述姿态关联关系是基于所述运载火箭的发射惯性坐标系、发射坐标系、速度坐标系和箭体坐标系之间的姿态转移矩阵确定的;
所述姿态关联关系是基于如下步骤确定的:
基于所述运载火箭的方位角、发射点地理纬度、当前飞行时刻,以及地球自转角速度,确定所述发射惯性坐标系变换到所述发射坐标系的第一姿态转移矩阵;
基于所述运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,确定所述发射坐标系变换到所述速度坐标系的第二姿态转移矩阵;
基于所述运载火箭在当前飞行时刻的目标攻角和实时侧滑角,确定所述速度坐标系变换到所述箭体坐标系的第三姿态转移矩阵;
基于所述第一姿态转移矩阵、所述第二姿态转移矩阵和所述第三姿态转移矩阵,确定所述发射惯性坐标系变换到所述箭体坐标系的第四姿态转移矩阵;
基于所述运载火箭在当前飞行时刻在所述发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,确定所述发射惯性坐标系变换到所述箭体坐标系的第五姿态转移矩阵;
基于所述第四姿态转移矩阵和所述第五姿态转移矩阵,确定所述姿态关联关系。
2.根据权利要求1所述的运载火箭控制方法,其特征在于,所述基于所述运载火箭的方位角、发射点地理纬度、当前飞行时刻,以及地球自转角速度,确定所述发射惯性坐标系变换到所述发射坐标系的第一姿态转移矩阵,包括:
;
其中,为所述发射惯性坐标系/>到所述发射坐标系/>的第一姿态转移矩阵,/>为所述方位角,/>为所述发射点地理纬度,/>为当前飞行时刻,/>为所述地球自转角速度,/>为用于表示绕坐标系的/>轴旋转的旋转矩阵;/>为用于表示绕坐标系的/>轴旋转的旋转矩阵;/>为用于表示绕坐标系的/>轴旋转的旋转矩阵。
3.根据权利要求2所述的运载火箭控制方法,其特征在于,所述基于所述运载火箭在当前飞行时刻的实时速度倾角、实时弹道偏角和实时弹道倾角,确定所述发射坐标系变换到所述速度坐标系的第二姿态转移矩阵,包括:
;
其中,为所述发射坐标系/>到所述速度坐标系/>的第二姿态转移矩阵,/>为所述实时速度倾角,/>为所述实时弹道偏角,/>为所述实时弹道倾角。
4.根据权利要求3所述的运载火箭控制方法,其特征在于,所述基于所述运载火箭在当前飞行时刻的目标攻角和实时侧滑角,确定所述速度坐标系变换到所述箭体坐标系的第三姿态转移矩阵,包括:
;
其中,为所述速度坐标系/>到所述箭体坐标系/>的第三姿态转移矩阵,/>为所述目标攻角,/>为所述实时侧滑角。
5.根据权利要求4所述的运载火箭控制方法,其特征在于,所述基于所述运载火箭在当前飞行时刻在所述发射惯性坐标系中的实时俯仰角、实时偏航角和实时滚转角,确定所述发射惯性坐标系变换到所述箭体坐标系的第五姿态转移矩阵,包括:
;
其中,为所述发射惯性坐标系/>到所述箭体坐标系/>的第五姿态转移矩阵,/>为所述实时俯仰角,/>为所述实时偏航角,/>为所述实时滚转角。
6.根据权利要求5所述的运载火箭控制方法,其特征在于,所述实时偏航角基于如下公式求解:
;
所述实时俯仰角基于如下公式求解:
;
式中,为三维矩阵/>中的元素,/>为三维矩阵/>中的元素,/>为行号,/>为列号;/>为第一中间变量;/>为第二中间变量;/>为第三中间变量;/>为第四中间变量;
;
;
。
7.一种运载火箭,其特征在于,包括火箭本体,以及设置在所述火箭本体上的箭载计算机;
所述箭载计算机用于执行权利要求1至6任一项所述的运载火箭控制方法。
8.一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至6任一项所述的运载火箭控制方法。
9.一种非暂态计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至6任一项所述的运载火箭控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310566867.2A CN116301008B (zh) | 2023-05-19 | 2023-05-19 | 运载火箭控制方法、运载火箭、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310566867.2A CN116301008B (zh) | 2023-05-19 | 2023-05-19 | 运载火箭控制方法、运载火箭、电子设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116301008A CN116301008A (zh) | 2023-06-23 |
CN116301008B true CN116301008B (zh) | 2023-09-05 |
Family
ID=86785309
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310566867.2A Active CN116301008B (zh) | 2023-05-19 | 2023-05-19 | 运载火箭控制方法、运载火箭、电子设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116301008B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117113531A (zh) * | 2023-08-21 | 2023-11-24 | 江苏天兵航天科技有限公司 | 运载火箭的备保起飞判断方法、***、设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106342284B (zh) * | 2008-08-18 | 2011-11-23 | 西北工业大学 | 一种飞行载体姿态确定方法 |
CN105116910A (zh) * | 2015-09-21 | 2015-12-02 | 中国人民解放军国防科学技术大学 | 一种对地面点凝视成像的卫星姿态控制方法 |
CN112179217A (zh) * | 2020-10-27 | 2021-01-05 | 中国运载火箭技术研究院 | 固体运载火箭的制导方法以及装置、存储介质、电子装置 |
CN112989496A (zh) * | 2021-04-20 | 2021-06-18 | 星河动力(北京)空间科技有限公司 | 航天器制导方法、装置、电子设备及存储介质 |
CN113847913A (zh) * | 2021-08-27 | 2021-12-28 | 南京理工大学 | 一种基于弹道模型约束的弹载组合导航方法 |
CN115952384A (zh) * | 2022-11-30 | 2023-04-11 | 宁波天擎航天科技有限公司 | 一种运载火箭掉头过程坐标系转换方法及其控制仿真应用 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6666410B2 (en) * | 2001-10-05 | 2003-12-23 | The Charles Stark Draper Laboratory, Inc. | Load relief system for a launch vehicle |
-
2023
- 2023-05-19 CN CN202310566867.2A patent/CN116301008B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106342284B (zh) * | 2008-08-18 | 2011-11-23 | 西北工业大学 | 一种飞行载体姿态确定方法 |
CN105116910A (zh) * | 2015-09-21 | 2015-12-02 | 中国人民解放军国防科学技术大学 | 一种对地面点凝视成像的卫星姿态控制方法 |
CN112179217A (zh) * | 2020-10-27 | 2021-01-05 | 中国运载火箭技术研究院 | 固体运载火箭的制导方法以及装置、存储介质、电子装置 |
CN112989496A (zh) * | 2021-04-20 | 2021-06-18 | 星河动力(北京)空间科技有限公司 | 航天器制导方法、装置、电子设备及存储介质 |
CN113847913A (zh) * | 2021-08-27 | 2021-12-28 | 南京理工大学 | 一种基于弹道模型约束的弹载组合导航方法 |
CN115952384A (zh) * | 2022-11-30 | 2023-04-11 | 宁波天擎航天科技有限公司 | 一种运载火箭掉头过程坐标系转换方法及其控制仿真应用 |
Non-Patent Citations (1)
Title |
---|
刘百奇 等.一种起竖过程中捷联惯导快速对准方法.《兵器装备工程学报》.2018,第39卷(第3期),第169-173页. * |
Also Published As
Publication number | Publication date |
---|---|
CN116301008A (zh) | 2023-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110304270A (zh) | 用于运载火箭的全方位发射控制方法、装置、计算机设备 | |
CN116301008B (zh) | 运载火箭控制方法、运载火箭、电子设备及存储介质 | |
CN107450582B (zh) | 一种基于星上实时规划的相控阵数传引导控制方法 | |
CN105043417B (zh) | 多目标连续成像偏流角补偿方法 | |
CN104281150A (zh) | 一种姿态机动的轨迹规划方法 | |
CN112989496B (zh) | 航天器制导方法、装置、电子设备及存储介质 | |
CN108733066B (zh) | 一种基于吊舱姿态反馈的目标跟踪控制方法 | |
US11787569B2 (en) | System and method for optimizing a low-thrust trajectory of a spacecraft trajectory | |
RU2571567C2 (ru) | Способ управления движением аэробаллистического летательного аппарата по заданной пространственной траектории | |
CN110111260A (zh) | 一种规划编队卫星条带拼接成像任务的方法、装置及计算机存储介质 | |
US10696427B2 (en) | Method of controlling satellite | |
CN114020021B (zh) | 一种多导弹分布式协同制导律的设计方法及*** | |
CN107380485A (zh) | 一种微小卫星大面阵广域多模凝视成像控制方法 | |
CN112361896A (zh) | 固体运载火箭制导方法以及装置、存储介质、电子装置 | |
CN109211231A (zh) | 一种基于牛顿迭代法的炮弹姿态估计方法 | |
CN114440707A (zh) | 顶部与侧面协同拦截的飞行器制导方法、装置及*** | |
CN113238582A (zh) | 飞行器的飞行轨迹的规划方法、装置及*** | |
CN106529105B (zh) | 无人机载光电稳定转台惯性态建模仿真方法 | |
Li et al. | A 3D path planning approach for quadrotor UAV navigation | |
CN108319806B (zh) | 一种机动弹道间空域冲突检测方法 | |
CN112379680B (zh) | 一种飞行器姿态角控制方法、控制装置及存储介质 | |
CN111649734B (zh) | 一种基于粒子群算法的捷联导引头目标定位方法 | |
Hanlon et al. | AFSIM implementation and simulation of the active target defense differential game | |
CN113218423A (zh) | 发射时无基准姿态信息的空中粗对准方法 | |
CN106557090A (zh) | 一种磁力线圈结合动量轮的航天器姿态联合控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |