CN109813302B - 最佳可用导航星快速确定方法 - Google Patents
最佳可用导航星快速确定方法 Download PDFInfo
- Publication number
- CN109813302B CN109813302B CN201910083789.4A CN201910083789A CN109813302B CN 109813302 B CN109813302 B CN 109813302B CN 201910083789 A CN201910083789 A CN 201910083789A CN 109813302 B CN109813302 B CN 109813302B
- Authority
- CN
- China
- Prior art keywords
- navigation
- star
- sun
- map
- navigation star
- 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
Images
Landscapes
- Navigation (AREA)
Abstract
本发明公开了一种最佳可用导航星快速确定方法,充分考虑了弹载计算机的存储和计算速度约束,在已知最佳导航星方位以及弹载导航星图的基础上,首先根据是否需要规避强光源分别确定局部处理窗口的大小;然后利用局部处理窗口对导航星图中的恒星进行筛选,得到局部导航星图,并确定出局部导航星图中恒星的数量;若恒星数量小于N颗,则利用遍历方法确定出最佳可用导航星,若恒星数量大于等于N颗,则利用星间角距最小以及落点圆概率误差变化最小的原则确定出最佳可用导航星。本发明基于局部导航星图确定最佳可用导航星,减小了弹上计算量,加快了运算速度;同时根据局部导航星图中的恒星数量来确定选星方法,占用内存少,计算速度快。
Description
技术领域
本发明涉及制导控制技术领域,可应用于远程弹道导弹、运载火箭的主动段星光/惯性复合制导,尤其是应用于复合制导中最佳可用导航星的确定。
背景技术
现有的远程弹道导弹、运载火箭的主动段一般采用惯性制导技术,即通过加速度计、陀螺等惯性器件测量载体的视加速度、角速度等信息,经导航积分可获得载体的实时运行状态,并传递给制导系统。制导系统计算得到制导指令,控制载体的运动状态达到期望值。在惯性制导过程中,不可避免地存在定位定向误差、初始对准误差、惯性器件漂移误差等误差因素的影响,使惯性制导的精度降低,为此提出星光/惯性复合制导方法。
星光/惯性复合制导,是一种星光制导和惯性制导相结合的复合制导方式,更准确地说,是在纯惯性制导的基础上辅以星光制导。它利用在弹上测量恒星所获得的准确的惯性空间方位基准,来估计惯性导航平台(物理平台或数学平台)与发射惯性坐标系之间的失准角,并根据失准角估计值来修正惯性导航误差造成的落点偏差,以达到综合利用惯性导航信息和星光信息来提高导弹制导精度的目的。
星光/惯性复合制导需要在飞行过程中通过星敏感器测量导航星的方位,而最佳导航星是射前通过计算得到的,在导航星图中不一定存在,因此要在射前从导航星库中选定最佳可用导航星。考虑到星敏感器测量的限制,选取最佳可用导航星时需要考虑强光源的限制;同时还要考虑弹载计算机的存储和运算性能限制,要求在导航星库中选取最佳可用导航星占用的存储量尽可能小,运算量尽可能低,耗时尽可能小。
发明内容
本发明所要解决的技术问题是,针对现有技术不足,提供一种最佳可用导航星快速确定方法,减小弹上计算量,加快运算速度;根据局部导航星图中的恒星数量来确定选星方法,占用内存少,计算速度快。
为解决上述技术问题,本发明所采用的技术方案是:一种最佳可用导航星快速确定方法,包括以下步骤:
Step1:获取已经进行地平、强光源规避的导航星图,所述导航星图中包括恒星的赤经α0、赤纬δ0、高低角e0、方位角σ0信息;获取已经确定的最佳导航星方位[es σs];
Step2:判断是否需要强光源回避,若需要转Step3,若不需要转Step6;
Step3:根据从天文年历中获得的太阳赤经αsun、赤纬δsun,计算太阳在J2000.0 坐标系中的单位方向矢量iJ2000:
然后将J2000.0坐标系中的单位方向矢量转换到发射惯性坐标系中:
根据最佳导航星方位[es σs],计算出最佳导航星在发射惯性坐标系中的单位方向矢量is:
计算出最佳导航星与太阳的角距θs:
θs=arccos(is·isun)
Step4:判断θs是否小于太阳规避角αsun与偏离角Δα的和,若小于重新计算偏离角Δβ:若不小于转Step6;
Step5:根据偏离角Δβ、导航星图中各恒星与太阳的角距θ0确定出导航星图。首先计算出导航星图中恒星在理想发射惯性系中的单位矢量:
根据is和i0,计算导航星图中恒星与最佳导航星的角距θI:
θI=arccos(i0·is)
根据isun和i0,计算导航星图中恒星与太阳的角距θ0:
θ0=arccos(i0·isun)
对导航星库中的每颗恒星,依次判断下式是否成立
如果成立,说明恒星在最佳导航星的偏离角范围之内,在太阳规避角的范围之外,将该恒星放入局部导航星图中;
Step6:根据偏离角Δα、导航星图确定出局部导航星图;首先计算出导航星图中恒星在理想发射惯性坐标系中的单位矢量:
根据is和i0,即可计算出导航星图中恒星与最佳导航星的角距θI:
θI=arccos(i0·is)
判断导航星图中恒星与最佳导航星的角距θI是否小于偏离角Δα,若小于则将该恒星放入局部导航星图中;
Step7:确定局部导航星图中恒星的数量,若小于N颗,利用遍历CEP的方法确定出最佳可用导航星,否则转Step8;
Step8:遍历局部导航星图中恒星与最佳导航星的角距θI,记角距最小的为第一颗备选导航星;遍历局部导航星图中恒星的ΔCEP(ΔCEP为导航星图中恒星 CEP与最佳导航星CEP的差值),记ΔCEP最小的为第二颗备选导航星,ΔCEP的计算公式为
其中,为最佳导航星的CEP对高低角、方位角的偏导数;Δes、Δσs为导航星图中恒星与最佳导航星的方位差;判断第一颗、第二颗导航星是否为同一颗导航星,若是则该导航星即为最佳导航星,否则计算出第一颗、第二颗导航星的CEP,CEP小的为最佳导航星。
在获取到最佳星方位以及做了地平、强光源规避的导航星图的基础上,首先根据是否需要规避强光源分别确定局部处理窗口的大小;然后利用局部处理窗口对导航星图中的恒星进行筛选,得到局部导航星图,并确定出局部导航星图中恒星的数量;若恒星数量小于等于N颗(N=5),则利用遍历CEP的方法确定出最佳可用导航星,若恒星数量大于N颗,则利用星间角距最小以及最小确定出最佳可用导航星。
与现有技术相比,本发明所具有的有益效果为:本发明充分考虑弹上计算机的存储和计算速度条件,按照是否需要规避强光源确定局部导航星图,并确定出局部导航星图中恒星的数量;根据数量来确定选取最佳可用导航星的方式。本发明优点在于:
(1)按照是否需要规避强光源分别确定了局部导航星图,减小了弹上计算量,加快了计算速度;
(2)根据局部导航星中恒星的数量来选取确定最佳可用导航星的方式,当数量小于等于N颗时,采用遍历CEP的方法,当大于N颗时,采用星间角距最小和ΔCEP最小的方法确定最佳可用导航星,占用内存小,计算速度快。
附图说明
图1一种最佳可用导航星快速确定方法流程图。
具体实施方式
以某远程弹道导弹星光/惯性复合制导系统为例,说明本发明实施的方式。
假设发射时间为2018年1月1日0时0分0秒,发射点的纬度为10度,经度为10度,发射点高程为0m,发射方位角为45度,星敏感器的安装角为[20 10] 度,太阳规避角为20度。
S1.获取到已经进行地平、强光源规避的导航星图,所述导航星图中包括 177颗恒星,包含了赤经α0、赤纬δ0、高低角e0、方位角σ0信息;获取已经确定的最佳导航星方位[22.72 9.91]度;
S2.判断是否需要进行强光源规避,需要规避转S3;
S3.从天文年历中获得发射时刻太阳的赤经αsun=-78.5635°、赤纬δsun=-23.0205°,根据赤经、赤纬计算出太阳在J2000.0坐标系中的单位方向矢量:
然后计算出太阳在发射惯性系中的单位方向矢量:
计算出最佳导航星在发射惯性坐标系中的单位方向矢量is:
根据isun和is计算出最佳导航星与太阳的角距θs=112.4°。
S4.θs大于规避角大于αsun与偏离角Δα的和,转S6;
S6.根据偏离角Δα、导航星图确定出局部导航星图:
表1局部导航星图
S7.局部导航星图中恒星的数量为5颗,转S8:
S8.遍历局部导航星图中恒星与最佳导航星的角距θI,记角距最小的为第一颗备选导航星,此时的角距为4.1871deg;遍历局部导航星图中恒星的ΔCEP,记ΔCEP最小的为第二颗备选导航星,此时ΔCEP=0.3543;第一颗备选导航星与第二颗备选导航星不为同一颗导航星,分别计算CEP,第一颗备选导航星的CEP 为5838.7m,第二颗备选导航星的CEP为5943.0m,选取第一颗备选导航星为最佳可用导航星。
表2局部导航星图中参数值
Claims (5)
1.一种最佳可用导航星快速确定方法,其特征在于,包括以下步骤:
1)获取已经进行地平、强光源规避的导航星图,所述导航星图中包括恒星的赤经α0、赤纬δ0、高低角e0、方位角σ0信息;获取已经确定的最佳导航星方位[es σs];es,σs分别为最佳导航星的高低角、方位角;
2)判断是否需要进行强光源规避,若需要转步骤3),若不需要转步骤6);
3)根据从天文年历中获得的太阳规避角αsun、赤纬δsun,计算太阳在发射惯性坐标系中的单位方向矢量isun;同时对于已经确定的最佳导航星,在已知方位的情况下,计算出最佳导航星在发射惯性坐标系中的单位方向矢量is;根据isun和is计算出最佳导航星与太阳的角距θs;
4)判断θs是否小于太阳规避角αsun与偏离角Δα的和,若小于则重新计算偏离角,记重新计算出的偏离角为Δβ,然后根据重新计算出的偏离角Δβ、导航星图中各恒星与太阳的角距θs确定出局部导航星图;若不小于太阳规避角αsun与偏离角Δα的和,则根据偏离角Δα、导航星图确定出局部导航星图;根据重新计算出的偏离角Δβ、导航星图中各恒星与太阳的角距θ0确定出局部导航星图的具体实现过程包括:
5)确定局部导航星图中恒星的数量,若小于N颗,利用遍历圆概率偏差CEP的方法确定出最佳可用导航星;否则,遍历局部导航星图中的恒星与最佳导航星的角距θI,记角距最小的为第一颗备选导航星;遍历局部导航星图中恒星CEP与最佳导航星CEP的差值ΔCEP,记ΔCEP最小的为第二颗备选导航星;判断第一颗备选导航星、第二颗备选导航星是否为同一颗导航星,若是则该导航星为最佳可用导航星,若不是计算这两颗备选导航星的圆概率偏差CEP,CEP最小的为最佳可用导航星。
5.根据权利要求1所述的最佳可用导航星快速确定方法,其特征在于,当局部导航星图中恒星数量多于N颗时,确定最佳可用导航星的计算步骤包括:
1)遍历局部导航星图中恒星与最佳导航星的角距θI,记θI最小的为第一颗备选导航星;
2)遍历局部导航星图中恒星的ΔCEP,记ΔCEP最小的为第二颗备选导航星,ΔCEP的计算公式为:其中,为最佳导航星的CEP对高低角、方位角的偏导数;Δes、Δσs为导航星图中恒星与最佳导航星的方位差;
3)判断第一颗备选导航星、第二颗备选导航星是否为同一颗导航星,若是则该导航星即为最佳可用导航星,若不是,计算出第一颗备选导航星、第二颗备选导航星的CEP,CEP小的为最佳可用导航星。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910083789.4A CN109813302B (zh) | 2019-01-29 | 2019-01-29 | 最佳可用导航星快速确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910083789.4A CN109813302B (zh) | 2019-01-29 | 2019-01-29 | 最佳可用导航星快速确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109813302A CN109813302A (zh) | 2019-05-28 |
CN109813302B true CN109813302B (zh) | 2020-12-04 |
Family
ID=66605502
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910083789.4A Active CN109813302B (zh) | 2019-01-29 | 2019-01-29 | 最佳可用导航星快速确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109813302B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111578934B (zh) * | 2020-04-30 | 2022-07-29 | 中国人民解放军国防科技大学 | 基于惯性/天文组合导航应用的折射星优选方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB107784A (en) * | 1916-06-06 | 1917-07-06 | Edward Thomas Goldsmith | Improvements in or relating to Star-guides for Night Marching. |
CN103940432A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一种星敏感器的姿态确定方法 |
CN105223597A (zh) * | 2014-04-04 | 2016-01-06 | 马维尔国际有限公司 | 基于卫星确定通信设备位置的方法和设备 |
CN106123891A (zh) * | 2016-06-22 | 2016-11-16 | 中国人民解放军63680部队 | 基于周长特征的暗星自主识别方法 |
CN108507569A (zh) * | 2017-11-10 | 2018-09-07 | 中国人民解放军国防科技大学 | 用于星光/惯性复合制导的弹载恒星星库快速生成方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8260567B1 (en) * | 2008-09-19 | 2012-09-04 | The United States Of America, As Represented By The Secretary Of The Navy | System and method for angles-only position and velocity determination using closed-form triangulation |
CN102865880B (zh) * | 2011-07-04 | 2014-11-19 | 中国科学院沈阳自动化研究所 | 一种预计水下机器人导航系统圆概率偏差的方法 |
CN102865865B (zh) * | 2012-09-17 | 2015-07-22 | 常州工学院 | 一种采用十字链表的星敏感器筛选导航星的方法 |
CN104154929B (zh) * | 2014-07-08 | 2017-05-24 | 南京航空航天大学 | 基于星密集度的星图仿真器导航星优选方法 |
CN105928525B (zh) * | 2016-04-25 | 2018-08-07 | 航天东方红卫星有限公司 | 一种卫星对月定标的姿态确定方法 |
CN108225307B (zh) * | 2017-12-29 | 2021-08-10 | 南京航空航天大学 | 一种惯性测量信息辅助的星图匹配方法 |
-
2019
- 2019-01-29 CN CN201910083789.4A patent/CN109813302B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB107784A (en) * | 1916-06-06 | 1917-07-06 | Edward Thomas Goldsmith | Improvements in or relating to Star-guides for Night Marching. |
CN105223597A (zh) * | 2014-04-04 | 2016-01-06 | 马维尔国际有限公司 | 基于卫星确定通信设备位置的方法和设备 |
CN103940432A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一种星敏感器的姿态确定方法 |
CN106123891A (zh) * | 2016-06-22 | 2016-11-16 | 中国人民解放军63680部队 | 基于周长特征的暗星自主识别方法 |
CN108507569A (zh) * | 2017-11-10 | 2018-09-07 | 中国人民解放军国防科技大学 | 用于星光/惯性复合制导的弹载恒星星库快速生成方法 |
Non-Patent Citations (2)
Title |
---|
"Estimation of circular error probability of strapped down inertial navigation system by propagation of error covariance matrix";S. Vathsal;《1991 International Conference on Industrial Electronics, Control and Instrumentation》;19911130;全文 * |
"单星星光/惯性复合制导最佳星快速确定方法研究";叶兵;《宇航学报》;20090731;第30卷(第4期);正文第1371-1374 * |
Also Published As
Publication number | Publication date |
---|---|
CN109813302A (zh) | 2019-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3073223B1 (en) | Navigation system with star tracking sensors | |
US5809457A (en) | Inertial pointing and positioning system | |
CN101793523B (zh) | 一种组合导航和光电探测一体化系统 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN110672128B (zh) | 一种星光/惯性组合导航及误差在线标定方法 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN105115508B (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN105258698A (zh) | 一种高动态自旋制导炮弹空中组合导航方法 | |
CN110398242B (zh) | 一种高旋高过载条件飞行器的姿态角确定方法 | |
CN102735231A (zh) | 一种提高光纤陀螺寻北仪精度的方法 | |
CN115248038B (zh) | 一种发射系下的sins/bds组合导航工程算法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN115343743A (zh) | 一种不依赖水平基准和卫星信号的天文卫星组合导航定位系统及方法 | |
CN114111723B (zh) | 一种基于动态小视场的天体捕获方法 | |
CN109813302B (zh) | 最佳可用导航星快速确定方法 | |
JP2010261842A (ja) | 慣性航法装置、飛翔体及び航法データ算出方法 | |
CN112833878A (zh) | 近地面多源天文自主导航方法 | |
US6142412A (en) | Highly accurate long range optically-aided inertially guided type missile | |
CN115542363A (zh) | 一种适用于垂直下视航空吊舱的姿态测量方法 | |
CN110017809B (zh) | 利用地磁信息和光流传感器解算飞行器姿态的方法 | |
CN109813301B (zh) | 一种最佳导航星方位快速确定方法 | |
CN111090830A (zh) | 一种高轨非合作目标在轨光压辨识方法 | |
CN110986926A (zh) | 一种基于地磁要素的飞行弹体旋转姿态测量方法 | |
CN112747743B (zh) | 基于弹载红外导引头的惯性视觉组合导航方法及装置 | |
CN111895865B (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 |