CN112212869B - 一种模拟火箭飞行试验的地面测试设计方法 - Google Patents
一种模拟火箭飞行试验的地面测试设计方法 Download PDFInfo
- Publication number
- CN112212869B CN112212869B CN202010912300.2A CN202010912300A CN112212869B CN 112212869 B CN112212869 B CN 112212869B CN 202010912300 A CN202010912300 A CN 202010912300A CN 112212869 B CN112212869 B CN 112212869B
- Authority
- CN
- China
- Prior art keywords
- increment
- theoretical
- arrow
- calculating
- actual
- 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
- 238000012360 testing method Methods 0.000 title claims abstract description 33
- 238000013461 design Methods 0.000 title claims abstract description 23
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000004364 calculation method Methods 0.000 claims abstract description 62
- 238000005259 measurement Methods 0.000 claims abstract description 14
- 230000001133 acceleration Effects 0.000 claims description 14
- 230000005484 gravity Effects 0.000 claims description 14
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 101100221616 Halobacterium salinarum (strain ATCC 29341 / DSM 671 / R1) cosB gene Proteins 0.000 description 4
- 241001442234 Cosa Species 0.000 description 2
- 244000089409 Erythrina poeppigiana Species 0.000 description 2
- 235000009776 Rathbunia alamosensis Nutrition 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- 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/0833—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Astronomy & Astrophysics (AREA)
- Computer Security & Cryptography (AREA)
- Aviation & Aerospace Engineering (AREA)
- Navigation (AREA)
Abstract
一种模拟火箭飞行试验的地面测试设计方法,包括如下步骤:(1)计算实际箭体系视速度增量,将计算结果送地面遥测;(2)计算实际箭体系角增量;(3)根据实际箭体系角增量计算姿态阵及姿态角,将姿态角计算结果送地面遥测;(4)根据步骤3计算的实际箭体系视速度增量和姿态阵结果,计算实际惯性系视速度增量;(5)计算理论箭体系视速度增量;(6)计算理论箭体系角增量;(7)根据理论箭体系角增量计算箭体的理论姿态阵;(8)根据步骤5计算的理论箭体系视速度增量和步骤7理论姿态阵结果计算理论惯性系视速度增量;(9)将实际惯性系视速度增量替换为理论惯性系视速度增量,作为导航计算的输入。
Description
技术领域
本发明属于制导控制***领域,具体涉及一种模拟火箭飞行试验的地面测试设计方法。
背景技术
火箭在飞行试验前,控制***需要在地面进行模拟飞行试验的测试,考核软、硬件产品是否工作正常,因而需要针对测试设计相应的方法。目前的设计方法是: 1)按照惯性导航器件实际敏感地面1g0(重力加速度)和地球自转角速度作为输入的方式进行后续的制导控制计算,2)在捷联惯组实际敏感地面1g0和地球自转角速度作为输入的计算结果中,将角增量计算结果和箭体系视速度计算结果替换成飞行弹道的数据,3)将1)和2)两者结合起来接力计算。这些方法的缺点分别如下:
针对1)方法,由于模拟飞行试验测试中没有对捷联惯组进行准确对准,并且每发任务测试使用的相同的或其他任务测试使用的不同的捷联惯组工具误差都不相同且均是随机量,因而制导计算结果误差较大且数值也是随机的,造成不能准确设置误差大小门限,从而不适应采用自动化方式判读制导控制计算的结果;此外,这种方法需要更改图1所示原理图中飞行使用的导航计算部分公式,因此,会影响飞行软件的可靠性;针对2)方法,没有捷联惯组敏感实际地面1g0和地球自转角速度作为输入计算的姿态角和箭体系视速度结果,因而,无法通过这些结果分析捷联惯组工作是否正常,不利于对硬件产品的考核;针对3)方法,1)和2)的缺点均有。
发明内容
本发明针对惯性导航器件为捷联惯组的地面模拟飞行试验测试,同时解决模拟火箭飞行试验的地面测试自动化判读应用范围小、硬件考核覆盖性较低、飞行软件可靠性有待进一步提高的问题。
工作原理:一种模拟火箭飞行试验的地面测试设计方法,包括如下步骤:(1)利用惯组加速度计敏感重力加速度信息后输出的脉冲增量计算实际箭体系视速度增量,将计算结果送地面遥测;(2)根据惯组陀螺敏感的地球自转角速度信息输出的脉冲增量计算实际箭体系角增量;(3)根据实际箭体系角增量计算姿态阵及姿态角,并将姿态角计算结果送地面遥测,分析陀螺是否工作正常;(4)根据步骤3计算的实际箭体系视速度增量和姿态阵结果,计算实际惯性系视速度增量;(5)将重力加速度分解到箭体系三方向,计算理论箭体系视速度增量;(6)将地球自转角速度分解到箭体系三方向,计算理论箭体系角增量;(7)根据步骤6 所述的理论箭体系角增量计算箭体的理论姿态阵;(8)根据步骤5计算的理论箭体系视速度增量和步骤7理论姿态阵结果计算理论惯性系视速度增量;(9)将实际惯性系视速度增量替换为理论惯性系视速度增量,作为箭体导航计算的输入。
进一步的,步骤1所述的实际箭体系视速度增量计算公式为:
其中O-X1Y1Z1为箭体坐标系,其中OX1为纵轴,OY1为法向轴,OZ1为横向轴,ΔWx1、ΔWy1、ΔWz1为箭体系x1、y1、z1三方向视速度增量,单位为m/s;ΔNax1、ΔNay1、ΔNaz1为安装在箭体系三方向加速度计每个计算周期输出的脉冲增量,单位为个;Kax1、Kay1、Kaz1为加速度计由脉冲增量转为视速度的转换系数,单位为个/(g0·s)。
进一步的,步骤2所述的实际箭体系角增量,计算公式为:
其中:Δθx、Δθy、Δθz为箭体系x1,y1,z1三方向角增量,单位为rad;ΔNgx1、ΔNgy1、ΔNgz1为安装在箭体系三方向陀螺每计算周期输出的脉冲增量,单位为个;Kgx1、Kgy1、Kgz1为陀螺由脉冲增量转为角增量的转换系数,单位为"/个。
进一步的,步骤3所述姿态阵计算公式为:
进一步的,步骤3所述姿态角计算公式为:
ψ=arcsin(-a31)
进一步的,步骤4所述实际惯性系视速度增量计算公式为:
其中,O-XYZ为发射点惯性坐标系(简称惯性系),OX指向射向,OY为发射点重力反方向,OZ按右手坐标法则定义,ΔWx、ΔWy、ΔWz分别为惯性系 x,y,z三方向的视速度增量,单位为m/s。
进一步的,步骤5所述的理论箭体系视速度增量的计算公式为:
ΔWx1=g0·ΔT·Kp;
ΔWy1=ΔWz1=0;
其中:g0为理论设计时选取的重力加速度,单位为m/s2;ΔT为计算周期,单位为s;Kp为重力加速度比例系数。
进一步的,步骤6所述的理论箭体系角增量计算公式为:
Δθx=ωe·ΔT·sinB0
Δθy=-ωe·ΔT·cosA0cosB0
Δθz=-ωe·ΔT·sinA0cosB0
ωe为地球自转角速度,单位为rad;A0为理论设计时选取的射向,单位为°; B0为理论设计时选取的纬度,单位为°。
本发明的有益效果:
(1)本发明可以保留利用地面1g0和地球自转角速度作为输入计算的姿态角和箭体系视速度结果,实现对捷联惯组的考核;(2)可以通过固定输入,实现制导控制计算的结果误差极小,能准确设置误差大小门限,从而能采用自动化方式判读制导控制计算的结果,大大提高了判读效率,降低了人为失误的风险;(3)测试方法全部封闭在一个独立的模飞计算模块中,不改变飞行使用的导航计算公式,提高了飞行软件的可靠性,且实现简单,通过飞行诸元标志字设置,即可实现模拟飞行测试状态和实际飞行试验状态的切换。
附图说明
图1模拟飞行试验的地面测试设计方法原理图。
图2实际惯性系视速度增量的O-XYZ发射点惯性坐标系。
具体实施方式
除了下面所述的实施例,本发明还可以有其它实施例或以不同方式来实施。因此,应当知道,本发明并不局限于在下面的说明书中所述或在附图中所示的部件的结构的详细情况。当这里只介绍一个实施例时,权利要求并不局限于该实施例。
本发明使用模拟飞行计算的理论惯性系视速度增量替换利用实物捷联惯组敏感信息计算得到的实际惯性系视速度增量结果Δw,采用理论惯性系视速度增量结果进入导航计算及后续的制导控制。在模拟飞行计算中使用事先设计好的理论加速度和角速度作为加表和陀螺敏感信息,分别进行箭体系视速度增量和箭体系到发射点重力惯性系的姿态矩阵计算,从而计算出理论的惯性系视速度增量将实物捷联惯组敏感信息计算得到的实际惯性系视速度增量结果Δw替换,利用理论的进入导航计算,利用导航计算的结果进行后续的制导控制。
一种模拟火箭飞行试验的地面测试设计方法,包括如下步骤如图1所示:
(1)利用惯组加速度计敏感重力加速度信息后输出的脉冲增量计算实际箭体系视速度增量,其中O-X1Y1Z1为箭体坐标系,其中OX1为纵轴,OY1为法向轴,OZ1为横向轴,如图2所示,并将计算结果送地面遥测,分析加速度计是否工作正常。实际箭体系视速度增量计算公式如下:
其中:ΔWx1、ΔWy1、ΔWz1为箭体系x1、y1、z1三方向视速度增量,单位为 m/s;
ΔNax1、ΔNay1、ΔNaz1为安装在箭体系三方向加速度计输出的脉冲增量,单位为个;Kax1、Kay1、Kaz1为加速度计由脉冲增量转为视速度的转换系数,单位为个 /(g0·s)。
(2)根据惯组陀螺敏感的地球自转角速度信息输出的脉冲增量计算实际箭体系角增量,计算公式为:
其中:Δθx、Δθy、Δθz为箭体系x1,y1,z1三方向角增量,单位为rad;ΔNgx1、ΔNgy1、ΔNgz1为安装在箭体系三方向陀螺每计算周期输出的脉冲增量,单位为个;Kgx1、Kgy1、Kgz1为陀螺由脉冲增量转为角增量的转换系数,单位为"/个。
(3)根据实际箭体系角增量计算姿态阵及姿态角,并将姿态角计算结果送地面遥测,分析陀螺是否工作正常,计算公式如下:
1)姿态阵计算公式:
2)姿态角计算公式:
ψ=arcsin(-a31)
(4)根据步骤3计算的实际箭体系视速度增量和姿态阵结果,计算实际惯性系视速度增量,其中O-XYZ为发射点惯性坐标系(简称惯性系),OX指向射向,OY为发射点重力反方向,OZ按右手坐标法则定义,如图2所示,公式为:
其中:ΔWx、ΔWy、ΔWz分别为惯性系x,y,z三方向的视速度增量,单位为 m/s。
(5)将重力加速度分解到箭体系三方向,从而计算理论箭体系视速度增量,公式为:
ΔWx1=g0·ΔT·Kp;
ΔWy1=ΔWz1=0;
其中:g0为理论设计时选取的重力加速度,单位为m/s2;ΔT为计算周期,单位为s;Kp为重力加速度比例系数。
(6)将地球自转角速度分解到箭体系三方向,从而计算理论箭体系角增量,公式为:
Δθx=ωe·ΔT·sinB0
Δθy=-ωe·ΔT·cosA0cosB0
Δθz=-ωe·ΔT·sinA0cosB0
ωe为地球自转角速度,单位为rad;A0为理论设计时选取的射向,单位为°; B0为理论设计时选取的纬度,单位为°。
(7)根据步骤6所述的理论箭体系角增量计算箭体系到惯性系的理论姿态阵,计算公式同步骤(3)的中1)姿态阵计算公式;
(8)根据步骤5计算的理论箭体系视速度增量和步骤7理论姿态阵结果计算理论惯性系视速度增量,计算公式同步骤(4);
(9)将实际惯性系视速度增量替换为理论惯性系视速度增量,作为箭体导航计算的输入。
对于上述本发明所提出的方法,还可以在不脱离本发明内容上作出各种改进,因此本发明的保护范围应该由所附的权利要求书内容确定。
Claims (6)
1.一种模拟火箭飞行试验的地面测试设计方法,其特征在于,包括如下步骤:
(1)利用惯组加速度计敏感重力加速度信息后输出的脉冲增量计算实际箭体系视速度增量,将计算结果送地面遥测;
(2)根据惯组陀螺敏感的地球自转角速度信息输出的脉冲增量计算实际箭体系角增量;
(3)根据实际箭体系角增量计算姿态阵及姿态角,并将姿态角计算结果送地面遥测,分析陀螺是否工作正常;
(4)根据步骤1以及步骤3计算的实际箭体系视速度增量和姿态阵结果,计算实际惯性系视速度增量;
(5)将重力加速度分解到箭体系三方向,计算理论箭体系视速度增量,所述理论箭体系视速度增量的计算公式为:
ΔWx1=g0·ΔT·Kp;
ΔWy1=ΔWz1=0;
其中:g0为理论设计时选取的重力加速度,单位为m/s2;ΔT为计算周期,单位为s;Kp为重力加速度比例系数;
(6)将地球自转角速度分解到箭体系三方向,计算理论箭体系角增量,所述理论箭体系角增量计算公式为:
Δθx=ωe·ΔT·sin B0
Δθy=-ωe·ΔT·cos A0cos B0
Δθz=-ωe·ΔT·sin A0cos B0
ωe为地球自转角速度,单位为rad;A0为理论设计时选取的射向,单位为°;B0为理论设计时选取的纬度,单位为° ;
(7)根据步骤5计算的理论箭体系视速度增量和步骤7理论姿态阵结果计算理论惯性系视速度增量;
(8)将实际惯性系视速度增量替换为理论惯性系视速度增量,作为箭体导航计算的输入。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010912300.2A CN112212869B (zh) | 2020-09-03 | 2020-09-03 | 一种模拟火箭飞行试验的地面测试设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010912300.2A CN112212869B (zh) | 2020-09-03 | 2020-09-03 | 一种模拟火箭飞行试验的地面测试设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112212869A CN112212869A (zh) | 2021-01-12 |
CN112212869B true CN112212869B (zh) | 2022-11-22 |
Family
ID=74048995
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010912300.2A Active CN112212869B (zh) | 2020-09-03 | 2020-09-03 | 一种模拟火箭飞行试验的地面测试设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112212869B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101173858A (zh) * | 2007-07-03 | 2008-05-07 | 北京控制工程研究所 | 一种月面巡视探测器的三维定姿与局部定位方法 |
CN106927063A (zh) * | 2017-03-01 | 2017-07-07 | 北京航天自动控制研究所 | 惯组输出数据的模拟方法及装置 |
CN107065594A (zh) * | 2017-01-12 | 2017-08-18 | 上海航天控制技术研究所 | 一种运载火箭六自由度分布式半物理仿真方法及*** |
CN107063244A (zh) * | 2017-04-14 | 2017-08-18 | 北京航天自动控制研究所 | 一种飞行器飞行过程模拟方法 |
CN110411478A (zh) * | 2019-08-15 | 2019-11-05 | 重庆零壹空间科技集团有限公司 | 一种运载火箭惯性器件快速标定方法 |
CN110780319A (zh) * | 2019-09-16 | 2020-02-11 | 蓝箭航天空间科技股份有限公司 | 运载火箭组合导航功能验证***及验证方法 |
US10669045B1 (en) * | 2016-06-22 | 2020-06-02 | United States Of America As Represented By The Administrator Of The Nasa | Affordable vehicle avionics system |
CN111522326A (zh) * | 2020-04-17 | 2020-08-11 | 上海宇航***工程研究所 | 一种火箭子级回收综合控制器仿真测试***及测试方法 |
-
2020
- 2020-09-03 CN CN202010912300.2A patent/CN112212869B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101173858A (zh) * | 2007-07-03 | 2008-05-07 | 北京控制工程研究所 | 一种月面巡视探测器的三维定姿与局部定位方法 |
US10669045B1 (en) * | 2016-06-22 | 2020-06-02 | United States Of America As Represented By The Administrator Of The Nasa | Affordable vehicle avionics system |
CN107065594A (zh) * | 2017-01-12 | 2017-08-18 | 上海航天控制技术研究所 | 一种运载火箭六自由度分布式半物理仿真方法及*** |
CN106927063A (zh) * | 2017-03-01 | 2017-07-07 | 北京航天自动控制研究所 | 惯组输出数据的模拟方法及装置 |
CN107063244A (zh) * | 2017-04-14 | 2017-08-18 | 北京航天自动控制研究所 | 一种飞行器飞行过程模拟方法 |
CN110411478A (zh) * | 2019-08-15 | 2019-11-05 | 重庆零壹空间科技集团有限公司 | 一种运载火箭惯性器件快速标定方法 |
CN110780319A (zh) * | 2019-09-16 | 2020-02-11 | 蓝箭航天空间科技股份有限公司 | 运载火箭组合导航功能验证***及验证方法 |
CN111522326A (zh) * | 2020-04-17 | 2020-08-11 | 上海宇航***工程研究所 | 一种火箭子级回收综合控制器仿真测试***及测试方法 |
Non-Patent Citations (2)
Title |
---|
Qinglin Niu 等.Numerical analysis of point-source infrared radiation phenomena of rocket exhaust plumes at low and middle altitudes.《Infrared Physics & Technology》.2019,第28-38页. * |
杨永安 等.一种基于火箭视位置与视速度的航天器初轨确定方法.《空间科学学报》.2008,第169-172页. * |
Also Published As
Publication number | Publication date |
---|---|
CN112212869A (zh) | 2021-01-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100585602C (zh) | 惯性测量***误差模型验证试验方法 | |
CN103676941B (zh) | 基于运动学和动力学模型的卫星控制***故障诊断方法 | |
CN106840196A (zh) | 一种捷联惯性导航计算机测试***及实现方法 | |
KR20090018659A (ko) | 자세각 검출 장치와 자세각 검출 방법 | |
CN110262282A (zh) | 火箭子级落区控制三轴转台半实物仿真***及方法 | |
CN1932444A (zh) | 适用于高速旋转体的姿态测量方法 | |
CN111522326A (zh) | 一种火箭子级回收综合控制器仿真测试***及测试方法 | |
CN110682290B (zh) | 一种基于动量观测器的闭环机械臂***碰撞检测方法 | |
CN111141286A (zh) | 一种无人机飞控多传感器姿态置信解算方法 | |
CN112212869B (zh) | 一种模拟火箭飞行试验的地面测试设计方法 | |
Filatov et al. | Structure and algorithms of motion control system's software of the small spacecraft | |
Blachuta et al. | Attitude and heading reference system based on 3D complementary filter | |
Wandarosanza et al. | Hardware-in-the-loop simulation of UAV hexacopter for chemical hazard monitoring mission | |
CN107300861B (zh) | 一种航天器动力学分布式计算方法 | |
Karvande et al. | Development of hardware-in-loop simulation test-bed for testing of navigation system-INS | |
JP2015100567A (ja) | 方位角キャリブレーション方法、運動解析装置、および方位角キャリブレーションプログラム | |
Baranek et al. | Model-based attitude estimation for multicopters | |
CN111649738A (zh) | 微重力场下的加速度计初始姿态解算方法 | |
CN110132267A (zh) | 空天地一体化飞行器的光纤惯导***及光纤惯导在轨对准方法 | |
CN108956003A (zh) | 一种实时标定六维传感器姿态的方法、装置及终端设备 | |
CN114018279B (zh) | 一种阵列式传感器多采样率数据融合姿态校正方法 | |
CN106996778A (zh) | 误差参数标定方法及装置 | |
CN110435922B (zh) | 一种旋翼无人机测试方法、装置及*** | |
US11493344B2 (en) | In-flight azimuth determination | |
CN106997053A (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 |