CN111027137B - 基于遥测数据的航天器动力学模型高精度动态构建方法 - Google Patents

基于遥测数据的航天器动力学模型高精度动态构建方法 Download PDF

Info

Publication number
CN111027137B
CN111027137B CN201911234178.1A CN201911234178A CN111027137B CN 111027137 B CN111027137 B CN 111027137B CN 201911234178 A CN201911234178 A CN 201911234178A CN 111027137 B CN111027137 B CN 111027137B
Authority
CN
China
Prior art keywords
coordinate system
emission
spacecraft
formula
velocity sequence
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
Application number
CN201911234178.1A
Other languages
English (en)
Other versions
CN111027137A (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.)
UNIT 63620 OF PLA
Original Assignee
UNIT 63620 OF PLA
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 UNIT 63620 OF PLA filed Critical UNIT 63620 OF PLA
Priority to CN201911234178.1A priority Critical patent/CN111027137B/zh
Publication of CN111027137A publication Critical patent/CN111027137A/zh
Application granted granted Critical
Publication of CN111027137B publication Critical patent/CN111027137B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Navigation (AREA)

Abstract

本发明属于航天发射领域与航天测控领域,公开了一种基于遥测数据的航天器动力学模型高精度动态构建方法。本发明首先根据航天器遥测弹道序列计算发射惯性坐标系的视速度序列;然后通过计算发射惯性坐标系与发射坐标系之间的方向余项矩阵,得到发射坐标系视速度序列;最后根据发射坐标系视速度序列,动态构建航天器动力学模型。本发明只需要直接应用遥测数据构建航天器动力学模型,成功地避开了所有与航天器具体结构、性能参数和控制规律相关的细节,同时又能够真实准确反映其动力学特性,是以往从来没有出现过的新方法。

Description

基于遥测数据的航天器动力学模型高精度动态构建方法
技术领域
本发明属于航天发射领域与航天测控领域,涉及一种基于遥测数据的航天器动力学模型高精度动态构建方法。
背景技术
在我国当前的航天发射任务中,现有的光学、雷达与导航卫星测量数据融合机理比较简单、融合程度不高,而且目前还没有出现将遥测弹道数据与其他测量数据实时进行深度融合处理的相关研究结果。随着航天发射高密度常态化发展的趋势越来越明显,对航天发射过程中大量的光学、雷达、遥测和导航测量数据进行融合处理、获得高品质的实时处理结果,对航天发射过程中的指挥决策和分析评估具有重要的现实意义,实时深度融合处理航天发射光学、雷达、遥测弹道数据与导航卫星测量数据已成为必然要求。
为了实时深度融合航天发射测量数据,实时准确估算航天器飞行状态,就必需建立航天器的高精度动力学模型。航天器的动力学模型与其具体结构、飞行状态、制导规律、制造误差、大气参数等密切相关,这就制约了模型的独立性与通用性,也影响了模型的准确性,难以满足高品质实时融合处理航天发射测量数据的需求。从工程实现与技术发展的角度来说,正是因为难以独立建立航天器的高精度动力学模型,所以航天发射任务测量数据实时融合的效果一直较差且发展缓慢,实时与事后高精度一体化综合处理的发展目标也一直无法有效推进。
发明内容
本发明所要解决的技术问题是提供一种新的航天器动力学模型构建方法,建立的模型既避开了所有与航天器具体结构、性能参数和控制规律相关的细节,又真实反映航天器的动力学特性。
为解决上述技术问题,本发明的技术方案如下:
一种基于遥测数据的航天器动力学模型高精度动态构建方法,包括如下步骤:
步骤一:根据发射惯性坐标系遥测弹道序列
Figure BDA0002304435690000021
计算发射惯性坐标系视速度序列/>
Figure BDA0002304435690000022
步骤二:根据发射惯性坐标系视速度序列
Figure BDA0002304435690000023
计算发射坐标系视速度序列Wi
步骤三:根据发射坐标系视速度序列Wi(i=0,1,…,n),动态构建航天器动力学模型。
进一步的,所述步骤一中,计算发射惯性坐标系的视速度序列
Figure BDA0002304435690000024
的公式如下:
当i=0时,令
Figure BDA0002304435690000025
当i=1,…,n时,按照(1)式计算发射惯性坐标系的视速度序列
Figure BDA0002304435690000026
Figure BDA0002304435690000027
其中,g(XI)为发射惯性坐标系的地球引力模型,XI为遥测弹道参数。
进一步的,所述步骤二中,计算发射坐标系的视速度序列Wi的公式如下:
Figure BDA0002304435690000031
式中,TFA为发射惯性坐标系与发射坐标系之间的方向余弦矩阵,具体表达式为:
Figure BDA0002304435690000032
式中,ωe为地球自转角速率;Ti为遥测弹道第i个输出节点对应的导航计算机解算弹道的累积积分时间长度;Af、Bf分别表示航天器的发射方位角与发射点地理纬度。
进一步的,所述步骤三进一步包括:
3.1根据发射系视速度序列Wi(i=0,1,…,n),构建视速度插值函数W(t);
利用(3)式构建视速度的拉格朗日插值函数W(t):
Figure BDA0002304435690000033
该函数为关于时刻t的二次连续函数。
3.2对于不超过tn时刻的任意两个连续时刻tk与tk+1,按照(4)式建立航天器动力学模型:
Figure BDA0002304435690000041
式中,Xk表示航天器tk时刻的发射坐标系弹道参数,Xk+1表示航天器tk+1时刻的发射坐标系弹道参数,
Figure BDA0002304435690000042
式中,g为地球引力加速度,ae为离心加速度,ac为哥氏加速度;
Figure BDA0002304435690000043
表示视加速度,视加速度/>
Figure BDA0002304435690000044
的积分计算式为/>
Figure BDA0002304435690000045
W(tk)与W(tk+1)由(3)式计算。
本发明的优点是:
本发明直接应用遥测弹道数据在每一个时刻动态建立航天器飞行全过程动力学模型,成功地避开了所有与航天器具体结构、性能参数和控制规律相关的细节,同时又能够真实准确反映其动力学特性,是以往从来没有出现过的新方法。本发明利用的遥测弹道数据来自航天器惯性测量器件,由此建立的航天器飞行全过程动力学模型的精度可达到航天器惯性测量器件的精度。
附图说明
图1为基于遥测数据的航天器动力学模型高精度动态构建方法流程图。
具体实施方式
下面结合附图对本发明作进一步详细说明。
航天器的导航计算机通过处理高精度加速度计输出脉冲数、高精度陀螺输出脉冲数和高精度地球引力模型,得到发射惯性坐标系的弹道参数,发射惯性坐标系的弹道参数经航天器上遥测系统向外发送。地面接收的遥测数据中,包括发射惯性坐标系的弹道数据,这些数据经地面遥测数据处理系统解码还原即为遥测弹道数据。
在发明中,时刻ti(i=0,1,…,n)表示等间隔的时间节点,时刻tk(k=0,1,2,…)表示连续的时间点。
本发明中要用到的主要符号定义如下:
Figure BDA0002304435690000051
—ti时刻发射惯性坐标系的航天器遥测弹道参数;
Figure BDA0002304435690000052
—ti时刻发射惯性坐标系的航天器视速度;
Wi—ti时刻发射坐标系的航天器视速度;
Xi—ti时刻发射坐标系的航天器弹道参数;
Xk—tk时刻发射坐标系的航天器弹道参数。
i=0,1,…,n,k=0,1,2,…。
如图1所示,本发明提供的一种基于遥测数据的航天器动力学模型高精度动态构建方法包括如下步骤:
步骤一:根据航天器发射惯性坐标系遥测弹道序列计算发射惯性坐标系视速度序列/>
Figure BDA0002304435690000054
当i=0时,令
Figure BDA0002304435690000055
当i=1,…,n时,按照(1)式计算发射惯性坐标系的视速度序列
Figure BDA0002304435690000056
Figure BDA0002304435690000061
式中,g(XI)为发射惯性坐标系的地球引力模型,XI为遥测弹道参数。
步骤二:根据发射惯性坐标系视速度序列
Figure BDA0002304435690000062
计算发射坐标系视速度序列Wi
通过计算发射惯性坐标系与发射坐标系之间的方向余弦矩阵,即可将发射惯性坐标系的视速度序列变换至发射坐标系。
根据发射惯性坐标系视速度序列
Figure BDA0002304435690000063
按照(2)式计算其对应在发射坐标系的视速度序列Wi
Figure BDA0002304435690000064
式中,TFA为发射惯性坐标系与发射坐标系之间的方向余弦矩阵,具体表达式为:
Figure BDA0002304435690000065
式中,ωe为地球自转角速率;Ti为遥测弹道第i个时间节点对应的导航计算机解算弹道的累积积分时间长度;Af、Bf分别表示航天器的发射方位角与发射点地理纬度。
步骤三:根据发射坐标系视速度序列Wi(i=0,1,…,n),动态构建航天器动力学模型;
3.1根据发射系视速度序列Wi(i=0,1,…,n),构建视速度的拉格朗日插值函数W(t);
利用(3)式构建视速度的拉格朗日插值函数W(t):
Figure BDA0002304435690000071
该函数为关于时刻t的二次连续函数。
3.2对于不超过tn时刻的任意两个连续时刻tk与tk+1,按照(4)式建立航天器动力学模型:
Figure BDA0002304435690000072
式中,Xk表示航天器tk时刻的发射坐标系弹道参数,Xk+1表示航天器tk+1时刻的发射坐标系弹道参数,
Figure BDA0002304435690000073
式中,
Figure BDA0002304435690000081
表示视加速度,视加速度/>的积分计算式为
Figure BDA0002304435690000083
W(tk)与W(tk+1)由(3)式计算;g为地球引力加速度,ae为离心加速度,ac为哥氏加速度,具体计算如下:
计算引力加速度g的方程如下:
Figure BDA0002304435690000084
式中,
Figure BDA0002304435690000085
表示引力加速度g在/>
Figure BDA0002304435690000086
方向上的投影,
Figure BDA0002304435690000087
表示引力加速度g在/>
Figure BDA0002304435690000088
方向上的投影;/>
Figure BDA0002304435690000089
表示航天器的地心纬度;
计算离心加速度ae的方程如下:
Figure BDA00023044356900000810
计算哥氏加速度ac的方程如下:
Figure BDA00023044356900000811
在上述各式中,
Figure BDA0002304435690000091
Figure BDA0002304435690000092
表示航天器发射点在发射坐标系上的地心矢量,φf=tan-1[(1-e2)tan Bf]表示发射点的地心纬度,μf=Bff表示发射点的地理纬度与地心纬度之差,Af、Hf分别表示发射方位角与发射点的大地高程;
Figure BDA0002304435690000093
表示地球自转方向,/>
Figure BDA0002304435690000094
表示航天器在发射系的位置坐标,/>
Figure BDA0002304435690000095
表示航天器在发射系的速度坐标;Ra、Rb、e分别表示地球标准椭球模型的长半轴长度、短半轴长度和偏心率,GM表示地球万有引力常数与地球质量之积,J表示地球引力模型二阶项常数,ωe为地球自转角速率。
以上实施方式仅用于说明本发明,而并非对本发明的限制,有关技术领域的普通技术人员,在不脱离本发明的精神和范围的情况下,还可以做出各种变化和变型,因此所有等同的技术方案也属于本发明的范畴,本发明的专利保护范围应由权利要求限定。

Claims (1)

1.一种基于遥测数据的航天器动力学模型高精度动态构建方法,其特征在于,包括如下步骤:
步骤一:根据发射惯性坐标系遥测弹道序列
Figure FDA0004252858490000011
计算发射惯性坐标系视速度序列Wi I
计算发射惯性坐标系的视速度序列Wi I的公式如下:
当i=0时,令
Figure FDA0004252858490000012
当i=1,…,n时,按照(1)式计算发射惯性坐标系的视速度序列Wi I
Figure FDA0004252858490000013
其中,g(XI)为发射惯性坐标系的地球引力模型,XI为遥测弹道参数;
步骤二:根据发射惯性坐标系视速度序列
Figure FDA0004252858490000014
计算发射坐标系视速度序列Wi
计算发射坐标系的视速度序列Wi的公式如下:
Wi=TFA·Wi I (2)
式中,TFA为发射惯性坐标系与发射坐标系之间的方向余弦矩阵,具体计算式为:
Figure FDA0004252858490000021
式中,ωe为地球自转角速率;Ti为遥测弹道第i个输出节点对应的导航计算机解箅弹道的累积积分时间长度;Af、Bf分别表示航天器的发射方位角与发射点地理纬度;
步骤三:根据发射坐标系视速度序列Wi(i=0,1,…,n),动态构建航天器动力学模型;
3.1根据发射系视速度序列Wi(i=0,1,…,n),构建视速度的拉格朗日插值函数W(t);
利用(3)式构建视速度的拉格朗日插值函数W(t):
Figure FDA0004252858490000022
该函数为关于时刻t的二次连续函数;
3.2对于不超过tn时刻的任意两个连续时刻tk与tk+1,按照(4)式建立航天器动力学模型:
Figure FDA0004252858490000023
式中,Xk表示航天器tk时刻的发射坐标系弹道参数,Xk+1表示航天器tk+1时刻的发射坐标系弹道参数,
Figure FDA0004252858490000031
式中,g为地球引力加速度,ae为离心加速度,ac为哥氏加速度;
Figure FDA0004252858490000032
表示视加速度,视加速度/>
Figure FDA0004252858490000033
的积分计算式为/>
Figure FDA0004252858490000034
W(tk)与W(tk+1)由(3)式计算。
CN201911234178.1A 2019-12-05 2019-12-05 基于遥测数据的航天器动力学模型高精度动态构建方法 Active CN111027137B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911234178.1A CN111027137B (zh) 2019-12-05 2019-12-05 基于遥测数据的航天器动力学模型高精度动态构建方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911234178.1A CN111027137B (zh) 2019-12-05 2019-12-05 基于遥测数据的航天器动力学模型高精度动态构建方法

Publications (2)

Publication Number Publication Date
CN111027137A CN111027137A (zh) 2020-04-17
CN111027137B true CN111027137B (zh) 2023-07-14

Family

ID=70204333

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911234178.1A Active CN111027137B (zh) 2019-12-05 2019-12-05 基于遥测数据的航天器动力学模型高精度动态构建方法

Country Status (1)

Country Link
CN (1) CN111027137B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112113471B (zh) * 2020-08-18 2022-08-16 中国人民解放军92941部队 基于最优模糊系统的惯导测量弹道修正方法
CN112329131B (zh) * 2020-10-10 2024-04-05 中国运载火箭技术研究院 一种标准测试模型生成方法、生成装置及存储介质

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101000245A (zh) * 2007-01-10 2007-07-18 北京航空航天大学 一种sins/gps/磁罗盘组合导航系统的数据融合方法
JP2010096647A (ja) * 2008-10-17 2010-04-30 Mitsubishi Electric Corp 航法装置及び推定方法
CN101949703A (zh) * 2010-09-08 2011-01-19 北京航空航天大学 一种捷联惯性/卫星组合导航滤波方法
CN104215244A (zh) * 2014-08-22 2014-12-17 南京航空航天大学 基于发射惯性坐标系的空天飞行器组合导航鲁棒滤波方法
CN106153051A (zh) * 2016-06-29 2016-11-23 上海航天控制技术研究所 一种航天器组合导航方法
CN106248082A (zh) * 2016-09-13 2016-12-21 北京理工大学 一种飞行器自主导航系统及导航方法
CN106874626A (zh) * 2017-03-21 2017-06-20 中国人民解放军63655部队 一种基于三维特征值空间的自适应目标指示数据估计方法
CN106871892A (zh) * 2017-02-17 2017-06-20 张梦 一种航空器组合导航方法和装置
CN107065594A (zh) * 2017-01-12 2017-08-18 上海航天控制技术研究所 一种运载火箭六自由度分布式半物理仿真方法及系统
CN107679655A (zh) * 2017-09-15 2018-02-09 中国人民解放军63816部队 一种航天发射火箭落点预测系统
CN108613674A (zh) * 2018-03-25 2018-10-02 哈尔滨工程大学 一种基于自适应差分进化bp神经网络的姿态误差抑制方法
CN109798902A (zh) * 2019-03-11 2019-05-24 北京星际荣耀空间科技有限公司 一种适用于运载火箭入轨修正的迭代制导方法
CN110057382A (zh) * 2019-04-23 2019-07-26 西北工业大学 一种基于发射坐标系的捷联惯导数值更新方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102021498B1 (ko) * 2017-12-08 2019-09-16 한국항공우주연구원 비행체 자세제어 시스템 설계 방법 및 컴퓨터 프로그램

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101000245A (zh) * 2007-01-10 2007-07-18 北京航空航天大学 一种sins/gps/磁罗盘组合导航系统的数据融合方法
JP2010096647A (ja) * 2008-10-17 2010-04-30 Mitsubishi Electric Corp 航法装置及び推定方法
CN101949703A (zh) * 2010-09-08 2011-01-19 北京航空航天大学 一种捷联惯性/卫星组合导航滤波方法
CN104215244A (zh) * 2014-08-22 2014-12-17 南京航空航天大学 基于发射惯性坐标系的空天飞行器组合导航鲁棒滤波方法
CN106153051A (zh) * 2016-06-29 2016-11-23 上海航天控制技术研究所 一种航天器组合导航方法
CN106248082A (zh) * 2016-09-13 2016-12-21 北京理工大学 一种飞行器自主导航系统及导航方法
CN107065594A (zh) * 2017-01-12 2017-08-18 上海航天控制技术研究所 一种运载火箭六自由度分布式半物理仿真方法及系统
CN106871892A (zh) * 2017-02-17 2017-06-20 张梦 一种航空器组合导航方法和装置
CN106874626A (zh) * 2017-03-21 2017-06-20 中国人民解放军63655部队 一种基于三维特征值空间的自适应目标指示数据估计方法
CN107679655A (zh) * 2017-09-15 2018-02-09 中国人民解放军63816部队 一种航天发射火箭落点预测系统
CN108613674A (zh) * 2018-03-25 2018-10-02 哈尔滨工程大学 一种基于自适应差分进化bp神经网络的姿态误差抑制方法
CN109798902A (zh) * 2019-03-11 2019-05-24 北京星际荣耀空间科技有限公司 一种适用于运载火箭入轨修正的迭代制导方法
CN110057382A (zh) * 2019-04-23 2019-07-26 西北工业大学 一种基于发射坐标系的捷联惯导数值更新方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
周宝林.《惯性/天文组合导航系统半物理仿真研究》.《硕士电子期刊》.2011,(第undefined期),全文. *

Also Published As

Publication number Publication date
CN111027137A (zh) 2020-04-17

Similar Documents

Publication Publication Date Title
CN111027204B (zh) 航天发射光、雷、遥与导航卫星测量数据融合处理方法
KR102454882B1 (ko) 차량 주행위치 추산 방법, 장치, 기기, 저장매체 및 프로그램
Mueller et al. Fusing ultra-wideband range measurements with accelerometers and rate gyroscopes for quadrocopter state estimation
CN106990426B (zh) 一种导航方法和导航装置
CN104374388B (zh) 一种基于偏振光传感器的航姿测定方法
CN110274588A (zh) 基于无人机集群信息的双层嵌套因子图多源融合导航方法
CN111027137B (zh) 基于遥测数据的航天器动力学模型高精度动态构建方法
CN105180728B (zh) 基于前数据的旋转制导炮弹快速空中对准方法
CN109931955A (zh) 基于状态相关李群滤波的捷联惯性导航系统初始对准方法
CN111025351B (zh) 运载火箭导航计算与外测系统时间零点差实时估算方法
US12000946B2 (en) System and method for maintaining cooperative precision navigation and timing (PNT) across networked platforms in contested environments
CN110325822A (zh) 云台位姿修正方法和装置
CN106643726B (zh) 一种统一惯性导航解算方法
Goppert et al. Invariant Kalman filter application to optical flow based visual odometry for UAVs
CN116989779A (zh) 一种基于李群的发射系惯导/卫导松耦合组合导航方法
US6282467B1 (en) Three-axis inertial attitude determination for spinning spacecraft
CN109084756B (zh) 一种重力视运动参数辨识与加速度计零偏分离方法
Li et al. Unmanned aerial vehicle position estimation augmentation using optical flow sensor
Braasch Inertial navigation systems
CN109029467A (zh) 一种基于转子式陀螺双正交构型的航天器高精度角运动测量方法
KR102090615B1 (ko) 모델 예측 제어를 이용한 드론 제어 시스템
CN115542363B (zh) 一种适用于垂直下视航空吊舱的姿态测量方法
TW201812338A (zh) 旋翼飛行器的定位方法
Gustavsson UAV pose estimation using sensor fusion of inertial, sonar and satellite signals
CN112833918B (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