CN111578934A - 基于惯性/天文组合导航应用的折射星优选方法及系统 - Google Patents

基于惯性/天文组合导航应用的折射星优选方法及系统 Download PDF

Info

Publication number
CN111578934A
CN111578934A CN202010367026.5A CN202010367026A CN111578934A CN 111578934 A CN111578934 A CN 111578934A CN 202010367026 A CN202010367026 A CN 202010367026A CN 111578934 A CN111578934 A CN 111578934A
Authority
CN
China
Prior art keywords
star
refraction
time
fixed
observation
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.)
Granted
Application number
CN202010367026.5A
Other languages
English (en)
Other versions
CN111578934B (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.)
National University of Defense Technology
Original Assignee
National University of Defense Technology
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 National University of Defense Technology filed Critical National University of Defense Technology
Priority to CN202010367026.5A priority Critical patent/CN111578934B/zh
Publication of CN111578934A publication Critical patent/CN111578934A/zh
Application granted granted Critical
Publication of CN111578934B publication Critical patent/CN111578934B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/02Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
    • G01C21/025Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Astronomy & Astrophysics (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种基于惯性/天文组合导航应用的折射星优选方法及系统,充分考虑导航星的空间构型,观星时长与星敏感器调姿时长,地球/航天器/恒星的几何关系,强光源规避,星敏感器视场角和折射星光的折射高度等约束影响,观星时间满足设定的观星时长和星敏感器调姿准备时间等约束条件。在此基础上,根据标准轨迹和恒星星库生成折射星库,通过遗传算法寻优搜索观星效果最好的观星开始时刻和对应的观星姿态,以确保星敏感器的观星效果。本发明是一种自主折射星优选算法,能够有效提高飞行器组合导航定轨精度。

Description

基于惯性/天文组合导航应用的折射星优选方法及系统
技术领域
本发明涉及导航技术领域,特别是一种基于惯性/天文组合导航应用的折射星优选方法及系统。
背景技术
惯性导航技术,即利用加表、陀螺仪等惯性器件测量弹体的视加速度和角速度等信息,经过弹载计算机积分运算后输出弹体实时的飞行状态。由于惯性导航系统内部存在陀螺仪漂移,加表零偏、随机游走等误差因素,其导航误差随时间积累。虽然近年来惯性系统和器件得到了长足发展,但是一方面高精度惯性系统成本高功耗大体积大,另一方面其误差积累的性质没有改变。尤其在执行高精度、远航程的任务时惯性系统仍需准确的外部信息校正误差。
惯性/星光折射组合导航技术是指利用惯性导航和星光导航的导航信息,通过融合处理获取高精度导航信息的导航技术。通俗地讲,此方法是在惯导积分的基础上,引入天文导航进行量测更新的组合导航技术。该方法的特点是精度高,尤其适用于远程、长航时的近地空间飞行器。
当前,已有大量的工作聚焦于星敏感器的形图识别,导航算法等方面,但是没有涉及折射星的优选问题。星光折射导航的定位精度取决于导航星的空间方位构型和折射角的大小。理论上,观测折射星的理论最优空间构型是观测到三颗方向矢量相互垂直的折射星;同时,由于星敏感器侧角误差的存在,折射角越大,组合导航定位精度越高。
发明内容
本发明所要解决的技术问题是,针对现有技术不足,提供一种基于惯性/天文组合导航应用的折射星优选方法及系统,提高组合导航的定位精度。
为解决上述技术问题,本发明所采用的技术方案是:一种基于惯性/天文组合导航应用的折射星优选方法,包括以下步骤:
1)利用下式生成满足星光折射星等要求的恒星子星库A:
Figure BDA0002477007530000021
其中,N1~Nn是满足星光折射星等要求的恒星编号,e1~en是与恒星编号相对应的恒星单位方向矢量;
2)利用恒星子星库A以及下式生成折射星库E:
Figure BDA0002477007530000022
其中,D1~Dn是可观星时段中每一时刻可持续观测Δtl时长的信息矩阵;其中,相邻时刻之间的间隔为
Figure BDA0002477007530000023
fr为轨迹信息的采样频率;
3)给出观星时长Δtobs和星敏感器调姿准备时长Δtatti,根据航天器飞行时长设置观星时段:优化变量设置为2k次观星开始时间为t1、t2、……、t2k,当1≤n≤k第n次观星开始时间的选择区间是[tua+(n-1)·(Δtobs+Δtatti),tud-(k-n)·Δtatti-(k-n+1)·Δtobs]当k+1≤n≤2k时,第n次观星开始时间的选择区间是[tda+(n-k-1)·(Δtobs+Δtatti),tdd-(2k-n)·Δtatti-(2k-n+1)·Δtobs],线性约束t1-t2≤-Δtobs-Δtatti、t3-t4≤-Δtobs-Δtatti;将2k次观星开始时间的选择区间和线性约束作为遗传算法的输入;其中t1、t2、……、t2k、Δtobs、Δtatti为非负整数;[tua,tud]为升弧段星敏感器可观星时段;[tda,tdd]为降弧段星敏感器可观星时段;由遗传算法给出一组符合选择区间和线性约束的观星开始时刻,判断给出的观星开始时刻t1是否可以匹配到E中有折射星的时刻,若否,则令第一个观星时段观星权重J1=M1;若是,则提取t1时刻的折射星单位方向矢量ei,i=1,2...n且i∈N+,其中N+为正整数集合;将星敏感器主光轴n分别对准恒星方向ei,即令n=ei
4)分别计算2k次观星得到的权重J1、J2、……、J2k,令目标函数J=J1+J2+……+J2k
5)将目标函数J作为遗传算法的输入,得到一组优化结果[T1T2……T2k],找到时刻T1、T2、……、T2k观测到的最大折射角对应的折射星方向矢量
Figure BDA0002477007530000031
2k个观星开始时刻的姿态即为n1、n2、……、n2k
本发明中,M1=10~60。无可观测折射星情况下的惩罚函数M1可以使观星方案向着提高导航精度的方向优化。
将每一历元可持续观测的折射星筛选出来,避免重复计算,便于折射星方案的选择,步骤2)的具体实现过程包括:
1)间隔
Figure BDA0002477007530000032
遍历可观星时段[tua,tud]和[tda,tdd],计算恒星子星库A中恒星反方向的单位方向矢量-e与当前时刻航天器的位置矢量rn的地心夹角θ,以及地心夹角θ的极大值θmax和极小值θmin;筛选出恒星子星库A中地心夹角θ满足以下要求的恒星:θmin≤θ≤θmax;对于地心夹角θ满足要求的恒星,筛选出恒星星光折射高度hg满足以下条件的恒星:hmax,0≥hg≥hmin,0;其中,hmax,0、hmin,0分别为折射高度上限和折射高度下限;将满足恒星星光折射高度要求的恒星的轨迹时刻、星号、单位方向矢量、折射高度记录写入信息矩阵B:
Figure BDA0002477007530000033
其中tn是当前计算的轨迹时刻;Nn1~Nnm是tn时刻满足hg=|rn|sinθ-Re的恒星编号,en1~enm和hn1~hnm是与恒星编号Nn1~Nnm对应的恒星单位方向矢量和折射高度;Re为地球平均半径;
2)提取信息矩阵B中恒星的方向矢量e,根据下式计算恒星与太阳、月球的夹角是否满足强光源规避条件:
Figure BDA0002477007530000041
其中θsun是太阳规避角,θmoon是月球规避角,esun是太阳的地心矢径,emoon是月球的地心矢径;将B中符合强光源规避条件的恒星信息写入信息矩阵C:
Figure BDA0002477007530000042
其中,Na1~Nab是tn时刻符合强光源规避条件的恒星编号,ea1~eab和ha1~hab分别是与恒星编号Na1~Nab对应的恒星单位方向矢量和折射高度;
3)给出观星持续时间Δtl,判断信息矩阵C中tn对应的折射星编号集合S0和tn+Δtl时刻的恒星编号集合
Figure BDA0002477007530000043
是否相同:相同则tn时刻折射星信息不变,写入信息矩阵D;不相同则计算
Figure BDA0002477007530000044
将Sl中恒星编号对应的恒星信息写入D:
Figure BDA0002477007530000045
其中,D是tn时刻可持续观测Δtl时长的折射星信息矩阵,Nn1~Nnm、en1~enm和hn1~hnm分别是D内的折射星编号、恒星单位方向矢量和折射高度;
4)以
Figure BDA0002477007530000046
为间隔,遍历[tua,tud-Δtl]和[tda,tdd-Δtl]时段的所有时刻,将折射星信息写入折射星库E:
Figure BDA0002477007530000047
D1~Dn是可观星时段中每一时刻可持续观测Δtl时长的折射星信息矩阵。
星敏感器在一定的高度范围可以精确工作,超出此范围则精度降低,因此本发明设定可观星时段[tua,tud]和[tda,tdd]符合Hmin≤H≤Hmax;其中,Hmax、Hmin分别为星敏感器工作的高度上限和下限。
地心夹角
Figure BDA0002477007530000051
地心夹角θ的极大值θmax和极小值θmin的计算公式为:
Figure BDA0002477007530000052
通过以上步骤可以判断可观测的恒星星光是否经过地球大气的折射。
为了进一步确保全程观星效果,有效提高组合导航的定位精度,本发明步骤4)的具体实现过程包括:
a)给出星敏感器视场角θc,将t1时刻满足条件
Figure BDA0002477007530000053
的恒星信息写入信息矩阵F:
Figure BDA0002477007530000054
其中,N1~Nn是t1时刻满足
Figure BDA0002477007530000055
的恒星编号,e1~en是与N1~Nn恒星编号对应的恒星单位方向矢量;
b)计算F中折射星的地心夹角θ,判断θmin≤θ≤θmax是否成立,成立则保留F中的折射星信息,并计算折射高度hg=rsinθ-Re;判断折射高度是否满足hmax≥hg≥hmin,将F中同时符合折射高度和地心夹角约束的恒星编号、单位方向矢量记入信息矩阵G:
Figure BDA0002477007530000056
其中,N1~Nm是t1时刻满足θmin≤θ≤θmax的恒星编号,e1~em和hg1~hgm分别是恒星编号N1~Nm对应的恒星单位方向矢量和折射高度;
c)判断G中恒星的方向矢量与强光源地心矢径的夹角是否满足强光源规避条件,计算符合强光源规避约束的恒星星光折射角:
Figure BDA0002477007530000061
其中ρ0是高度h0处的标准密度,H是密度标尺高度;将G中符合强光源规避约束的恒星编号,单位方向矢量和折射角写入信息矩阵I:
Figure BDA0002477007530000062
其中,N1~Nk是t1时刻满足
Figure BDA0002477007530000063
的恒星编号,e1~ek和ar1~ark分别是恒星编号对应的恒星单位方向矢量和折射角;c为大气密度模型的比例系数;k(γ)为折射因子,
Figure BDA0002477007530000064
λ是星敏感器观测折射星光的波长。
d)提取I中折射角的最大值ar,max,根据下式判断t1时刻观星权重值At1
Figure BDA0002477007530000065
e)以
Figure BDA0002477007530000066
为间隔,计算第一个观星时段[t1 t1+Δtobs]内所有时刻的观星权重值At,其中t∈N+,且t∈[t1 t1+Δtobs],则第一个观星时段平均观星效果
Figure BDA0002477007530000067
找到观星权重最大值A1,max和其对应的t1时刻星敏主光轴单位方向矢量n1,判断A1,max是否等于0:若是,则J1=M1;否则,
Figure BDA0002477007530000068
f)计算第二个观星时段时,写入F矩阵的恒星方向矢量e,在满足
Figure BDA0002477007530000071
的同时,还满足e·n1≤0,重复步骤a)~e),得到观星权重J2和t2时刻星敏主光轴的单位方向矢量n2
计算第三个观星时段时,写入F矩阵的恒星方向矢量e,在满足
Figure BDA0002477007530000072
的同时,还满足
Figure BDA0002477007530000073
重复步骤a)~e),计算得到观星权重J3和t3时刻星敏主光轴的单位方向矢量n3
依此类推,计算第k个观星时段时,重复前述步骤,得到观星权重Jk和tk时刻星敏主光轴的单位方向矢量nk;则目标函数J=J1+J2+……+Jk;k个观星开始时刻的姿态即为n1、n2、……、n4
本发明还提供了一种基于惯性/天文组合导航应用的折射星优选系统,包括计算机设备;所述计算机设备被编程或配置为执行上述方法的步骤。
与现有技术相比,本发明所具有的有益效果为:
1、本发明考虑了强光源,地球/飞行器/恒星的几何关系,折射高度,星敏感器视场角等约束条件,计算速度快,导航精度高且完全自动寻优;
2、根据飞行轨迹和恒星星表生成折射星库,在星敏感器工作时段内择优选择观星时段和观星姿态,确保其全程观星效果,有效提高了组合导航的定位精度。
附图说明
图1星敏的观测位置与折射星之间的几何关系;
图2(a)末端定位误差均方差;图2(b)末端定速误差均方差;
图3为本发明方法流程图。
具体实施方式
以下以四次观星为例说明本发明的步骤:
1)加载航天器标准轨迹,给出星敏感器工作的高度上限和下限Hmax、Hmin,根据标准轨迹时刻与位置矢量计算轨迹高度H符合Hmin≤H≤Hmax的可观星时段,升弧段星敏感器可观星时段[tua,tud]和降弧段星敏感器可观星时段[tda,tdd];
加载恒星星库,给出折射星敏感器能够观测的恒星星等Mv,获取满足星等要求的恒星,计算各恒星在地心惯性坐标系中的单位方向矢量
e=[cosδcosα cosδsinα sinδ] (1)
其中,δ是恒星赤经,α是赤纬,e是恒星单位方向矢量
生成满足星光折射星等要求的恒星子星库A
Figure BDA0002477007530000081
其中,N1~Nn是满足星光折射星等要求的恒星编号,e1~en是与恒星编号相对应的恒星单位方向矢量;
2)生成折射星库
(2A)轨迹信息的采样频率为fr,间隔
Figure BDA0002477007530000082
遍历可观星时段[tua,tud]和[tda,tdd],计算恒星反方向的单位方向矢量-e与此时刻航天器的位置矢量rn的地心夹角θ
Figure BDA0002477007530000083
给出星光折射高度上限hmax和下限hmin,计算地心夹角θ的极大值θmax和极小值θmin
Figure BDA0002477007530000091
式中,Re=6378136m为地球平均半径。
根据下式判断各恒星是否满足地心夹角要求
θmin≤θ≤θmax (4)
计算满足地心夹角要求的恒星星光折射高度hg
hg=|rn|sinθ-Re (5)
给出折射高度上限hmax,0和折射高度下限hmin,0,判断各恒星是否满足
hmax,0≥hg≥hmin,0 (6)
将轨迹时刻、星号、单位方向矢量、折射高度记录,写入信息矩阵B:
Figure BDA0002477007530000092
其中tn是当前计算的轨迹时刻,Nn1~Nnm是tn时刻满足式(5)的恒星编号,en1~enm和hn1~hnm是与恒星编号对应的恒星单位方向矢量和折射高度。
(2B)提取B中恒星的方向矢量e,根据下式计算恒星与太阳、月球的夹角是否满足强光源规避条件:
Figure BDA0002477007530000093
其中θsun是太阳规避角,θmoon是月球规避角,是根据星敏感器给出的确定值。esun是太阳的地心矢径,emoon是月球的地心矢径,由DE405计算获得。
将B中符合要求强光源规避条件的恒星信息写入信息矩阵C
Figure BDA0002477007530000101
其中,Na1~Nab是tn时刻符合公式(7)条件的恒星编号,ea1~eab和ha1~hab是与恒星编号对应的恒星单位方向矢量和折射高度
(2C)给出观星持续时间Δtl,判断矩阵C中tn对应的折射星编号集合S0和tn+Δtl时刻的恒星编号集合
Figure BDA0002477007530000105
是否相同:相同则tn时刻折射星信息不变,写入信息矩阵D;不相同则计算
Figure BDA0002477007530000106
将Sl中恒星编号对应的恒星信息写入D:
Figure BDA0002477007530000102
其中,D是tn时刻可持续观测Δtl时长的折射星信息矩阵,Nn1~Nnm、en1~enm和hn1~hnm是D内的折射星编号、恒星单位方向矢量和折射高度。
(2D)以
Figure BDA0002477007530000103
为间隔,遍历[tua,tud-Δtl]和[tda,tdd-Δtl]时段的所有时刻,将折射星信息写入折射星库E。
Figure BDA0002477007530000104
其中,D1~Dn是可观星时段中每一时刻可持续观测Δtl时长的信息矩阵。
3)给出观星时长Δtobs和星敏感器调姿准备时长Δtatti,优化变量设置为四次观星开始时间为t1、t2、t3、t4,则第一次观星开始时间的选择区间为[tua,tud-2Δtobs-Δtatti],第二次观星开始时间的选择区间为[tua+Δtobs+Δtatti,tud-Δtobs],第三次观星开始时间的选择区间为[tda,tdd-2Δtobs-Δtatti],第四次观星开始时间的选择区间为[tda+Δtobs+Δtatti,tdd-Δtobs],线性约束t1-t2≤-Δtobs-Δtatti、t3-t4≤-Δtobs-Δtatti。将四次观星开始时间的选择区间和线性约束作为遗传算法的输入(范围约束和线性约束是遗传算法程序:[x,fval]=ga(@observe,4,a,b,[],[],LB,UB,[],[1,2,3,4],options),a,b为线性约束,LB,UB为范围约束)。其中t1、t2、t3、t4、Δtobs、Δtatti全部是非负整数。
由遗传算法给出一组符合步骤3)中选择区间和线性约束的观星开始时刻,以t1为例,判断t1是否可以匹配到E中有折射星的时刻:
否,则令第一个观星时段观星权重J1=10(根据经验,J1可取10~60之间的整数);
是,则提取t1时刻的折射星单位方向矢量ei,i=1,2...n且i∈N+,其中N+为正整数集合。将星敏感器主光轴n分别对准恒星方向ei,即令n=ei。此后,在整个观星时段[t1 t1+Δtobs]内,不再进行星敏感器调姿。
4)以
Figure BDA0002477007530000111
为间隔计算观星时段[t1 t1+Δtobs]内折射星光的最大折射角,下面以t=t1时刻为例,计算各时刻观星权重和第一个观星时段的平均观星效果A1
(4A)给出星敏感器视场角θc,计算t1时刻可进入星敏感器视场的恒星
Figure BDA0002477007530000125
将符合条件的恒星信息写入信息矩阵F
Figure BDA0002477007530000124
其中,N1~Nn是t1时刻满足公式(9)的恒星编号,e1~en是与恒星编号对应的恒星单位方向矢量。
(4B)利用式(2)计算F中折射星的地心夹角θ,判断公式(4)是否成立,成立则保留折射星信息,并计算折射高度hg=rsinθ-Re。判断折射高度是否满足hmax,0≥hg≥hmin,0,将F中同时符合折射高度和地心夹角约束的恒星编号,单位方向矢量记入信息矩阵G
Figure BDA0002477007530000121
其中,N1~Nn是t1时刻满足公式(4)的恒星编号,e1~en和hg1~hgn分别是恒星编号对应的恒星单位方向矢量和折射高度
(4C)根据式(7)判断G中恒星的方向矢量与强光源地心矢径的夹角是否满足强光源规避约束
计算符合强光源规避约束的恒星星光折射角
Figure BDA0002477007530000122
其中ρ0是h0高度处的标准密度,c为大气密度模型的比例系数,h0=25km,ρ0=40.084g/m3,H是密度标尺高度,H=6.366km,k(γ)为折射因子,仅与光线波长λ有关,
Figure BDA0002477007530000123
将G中符合要求的恒星编号,单位方向矢量和折射角写入信息矩阵I
Figure BDA0002477007530000131
其中,N1~Nn是t1时刻满足公式(7)的恒星编号,e1~en和ar1~arn分别是恒星编号对应的恒星单位方向矢量和折射角。
(4D)提取I中折射角的最大值ar,max,根据下式判断t1时刻观星权重值At1
Figure BDA0002477007530000132
Figure BDA0002477007530000133
为间隔,计算第一个观星时段[t1 t1+Δtobs]内所有时刻的观星权重值At,其中t∈N+,且t∈[t1 t1+Δtobs],则第一个观星时段平均观星效果
Figure BDA0002477007530000134
找到观星权重最大值A1,max和其对应的t1时刻星敏主光轴单位方向矢量n1,判断A1,max是否等于0:是,J1=10;否,
Figure BDA0002477007530000135
(4E)计算第二个观星时段时,在步骤4A)中写入F矩阵的恒星方向矢量e在满足式(9)的同时,还要满足e·n1≤0,重复步骤(4A)、(4B)、(4C)、(4D),计算得到观星权重J2和t2时刻星敏主光轴的单位方向矢量n2
计算第三个观星时段时,在步骤4A)中写入F矩阵的恒星方向矢量e在满足式9)的同时,还要满足
Figure BDA0002477007530000141
重复步骤(4A)、(4B)、(4C)、(4D),计算得到观星权重J3和t3时刻星敏主光轴的单位方向矢量n3
计算第四个观星时段时,重复步骤(4A)、(4B)、(4C)、(4D),计算得到观星权重J4和t4时刻星敏主光轴的单位方向矢量n4
计算目标函数J=J1+J2+J3+J4
将目标函数J输入遗传算法,计算后优化算法给出一组优化结果[T1 T2 T3 T4],找到时刻T1、T2、T3、T4观测到的最大折射角对应的折射星方向矢量
Figure BDA0002477007530000143
四个观星开始时刻的姿态即为n1、n2、n3、n4
实施例:
S1.加载航天器标准轨迹,给出星敏感器工作的高度上限和下限Hmax=600km、Hmin=200km,根据标准轨迹时刻与位置矢量计算轨迹高度H符合Hmin≤H≤Hmax的可观星时段,升弧段星敏感器可观星时段[tua,tud]=[0s 222s]和降弧段星敏感器可观星时段[tda,tdd]=[1828s 2055s];
加载恒星星库,给出折射星敏感器能够观测的恒星星等Mv=6,获取满足星等要求的恒星,计算各恒星在地心惯性坐标系中的单位方向矢量,此处以1号恒星为例
e=[cosδcosα cosδsinα sinδ]=[0.0435 -0.0061 -0.9990]
其中,δ是恒星赤经,α是赤纬,e是恒星单位方向矢量
生成满足星光折射星等要求的恒星子星库A
Figure BDA0002477007530000142
其中,N1~Nn是满足星光折射星等要求的恒星编号,e1~en是与恒星编号相对应的恒星单位方向矢量;
S2.生成折射星库
(S2-1)轨迹信息的采样频率为fr=1hz,间隔
Figure BDA0002477007530000154
遍历可观星时段[0s 222s]和[1828s 2055s],计算恒星反方向的单位方向矢量-e=[-0.2550 -0.3715 -0.8927]与此时刻航天器的位置矢量
Figure BDA0002477007530000151
的地心夹角θ,(此处以0s和4456号恒星为例)
Figure BDA0002477007530000152
给出星光折射高度上限hmax=50km和下限hmin=20km,计算地心夹角θ的极大值θmax和极小值θmin
Figure BDA0002477007530000153
式中,Re=6378136m为地球平均半径。
根据下式判断各恒星是否满足地心夹角要求
θmin≤θ≤θmax
若满足,地心夹角要求的恒星星光折射高度hg
hg=|rn|sinθ-Re=22.5089km
给出折射高度上限hmax,0=31km和折射高度下限hmin,0=20km,判断恒星是否满足
hmax,0≥hg≥hmin,0
若满足,将轨迹时刻、星号、单位方向矢量、折射高度记录,写入信息矩阵B:
Figure BDA0002477007530000161
(S2-2)提取B中恒星的方向矢量e,给出θsun=25°和θmoon=12.5°,以4456号恒星为例,根据下式计算恒星与太阳、月球的夹角是否满足强光源规避条件:
Figure BDA0002477007530000162
将B中符合强光源规避条件的轨道时刻、恒星编号、单位方向矢量和折射高度写入信息矩阵C
Figure BDA0002477007530000163
(S2-3)给出观星持续时间Δtl=30s,判断矩阵C中6s对应的折射星编号集合S0和36s时刻的恒星编号集合
Figure BDA0002477007530000167
是否相同:相同则tn时刻折射星信息不变,写入信息矩阵D;不相同则计算
Figure BDA0002477007530000168
将Sl中恒星编号对应的轨道时刻、恒星编号、恒星单位方向矢量和折射高度等恒星信息写入D:
Figure BDA0002477007530000164
(S2-4)以
Figure BDA0002477007530000165
为间隔,遍历[tua,tud-Δtl]和[tda,tdd-Δtl]时段的所有时刻,将折射星信息写入折射星库E。
Figure BDA0002477007530000166
其中,D1~Dn是可观星时段中每一时刻可持续观测Δtl时长的信息矩阵,其中D的角标表示轨道时刻。
S3.给出观星时长Δtobs=30s和星敏感器调姿准备时长Δtatti=60s,优化变量设置为四次观星开始时间为t1、t2、t3、t4,则第一次观星开始时间的选择区间为[tua,tud-2Δtobs-Δtatti]=[0 102]s,第二次观星开始时间的选择区间为[tua+Δtobs+Δtatti,tud-Δtobs]=[90 192]s,第三次观星开始时间的选择区间为[tda,tdd-2Δtobs-Δtatti]=[18281935]s,第四次观星开始时间的选择区间为[tda+Δtobs+Δtatti,tdd-Δtobs]=[1918 2025]s,线性约束t1-t2≤-Δtobs-Δtatti=-90s、t3-t4≤-Δtobs-Δtatti=-90s。将四次观星开始时间的选择区间和线性约束作为遗传算法的输入,其中t1、t2、t3、t4、Δtobs、Δtatti全部是非负整数。
由遗传算法给出一组符合步骤3)中选择区间和线性约束的观星开始时刻,以t1=6s为例,判断t1是否可以匹配到E中有折射星的时刻:
否,则令第一个观星时段观星权重J1=10;
是,则找到t1时刻的恒星信息:
Figure BDA0002477007530000171
分别提取单位方向矢量,此处以4456号恒星为例,其单位方向矢量ei=[0.25500.3715 0.8927]。将星敏感器主光轴n分别对准恒星方向ei,即令n=ei=[0.2550 0.37150.8927]。此后,在整个观星时段[t1 t1+Δtobs]=[6 36]s内,不再进行星敏感器调姿。
S4.以
Figure BDA0002477007530000172
为间隔计算观星时段[t1 t1+Δtobs]=[6 36]s内折射星光的最大折射角,计算各时刻观星权重和第一个观星时段的平均观星效果A1,下面以t=t1=6s时刻和对准4456号恒星为例:
(S4-1)给出星敏感器视场角θc=18°,计算t1=6s时刻可进入星敏感器视场的恒星
Figure BDA0002477007530000181
将符合条件的轨道时刻、恒星编号、方向矢量和折射高度等恒星信息写入信息矩阵F
F=[6 4456 0.2550 0.3715 0.8927 22.5089]
(S4-2)利用式(2)计算F中折射星的地心夹角θ,判断公式(4)是否成立,成立则保留折射星信息,并计算折射高度hg=rsinθ-Re。判断折射高度是否满足hmax,0≥hg≥hmin,0,将F中同时符合折射高度和地心夹角约束的恒星信息轨道时刻、恒星编号、单位方向矢量和折射高度记入信息矩阵G
G=[6 4456 0.2550 0.3715 0.8927 22.5089]
(S4-3)根据式(7)判断G中恒星的方向矢量与强光源地心矢径的夹角是否满足强光源规避约束。
计算符合强光源规避约束的恒星星光折射角
Figure BDA0002477007530000182
其中ρ0是h0高度处的标准密度,c为大气密度模型的比例系数,此处设置为0,h0=25km,ρ0=40.084g/m3,H是密度标尺高度,H=6.366km,k(γ)为折射因子,仅与光线波长λ有关,
Figure BDA0002477007530000183
令λ=850nm。
将G中符合要求的恒星信息,包括轨道时刻、恒星编号,单位方向矢量和折射角写入信息矩阵I
I=[6s 4456 0.2550 0.3715 0.8927 176.6251″]
(S4-4)提取I中折射角的最大值ar,max=176.6251″,根据下式判断t1时刻观星权重值At1=1
Figure BDA0002477007530000191
Figure BDA0002477007530000192
为间隔,计算第一个观星时段[6 36]s内所有时刻的观星权重值At,其中t∈N+,且t∈[6 36]s,则第一个观星时段平均观星效果
Figure BDA0002477007530000193
在观星开始时刻t1=6s对准D6中的其他恒星,找到观星权重最大值A1,max=0.6631和其对应的t1时刻星敏主光轴单位方向矢量n1=[0.2550 0.3715 0.8927],判断A1,max是否等于0:否,
Figure BDA0002477007530000194
(S4-5)计算第二个观星时段时,在步骤4A)中写入F矩阵的恒星方向矢量e在满足式(9)的同时,还要满足e·n1≤0,重复步骤(4A)、(4B)、(4C)、(4D),计算得到观星权重J2=1.0299和t2时刻星敏主光轴的单位方向矢量n2=[-0.5025 0.1146 -0.8569];
计算第三个观星时段时,在步骤4A)中写入F矩阵的恒星方向矢量e在满足式9)的同时,还要满足
Figure BDA0002477007530000195
重复步骤(4A)、(4B)、(4C)、(4D),计算得到观星权重J3=1.2151和t3时刻星敏主光轴的单位方向矢量n3=[-0.1855 0.8303 -0.5256];
计算第四个观星时段时,重复步骤(4A)、(4B)、(4C)、(4D),计算得到观星权重J4=1.7630和t4时刻星敏主光轴的单位方向矢量n4=[0.9611 -0.0737 -0.2664];
计算目标函数J=J1+J2+J3+J4=5.5202。
将目标函数J输入遗传算法,计算后优化算法给出一组优化结果[T1 T2 T3 T4]=[6 97 1849 1988],四个观星开始时刻的姿态即为n1、n2、n3、n4。找到时刻T1、T2、T3、T4观测到的最大折射角对应的折射星方向矢量
Figure BDA0002477007530000201
Figure BDA0002477007530000202

Claims (7)

1.一种基于惯性/天文组合导航应用的折射星优选方法,其特征在于,包括以下步骤:
1)利用下式生成满足星光折射星等要求的恒星子星库A:
Figure FDA0002477007520000011
其中,N1~Nn是满足星光折射星等要求的恒星编号,e1~en是与恒星编号相对应的恒星单位方向矢量;
2)利用恒星子星库A以及下式生成折射星库E:
Figure FDA0002477007520000012
其中,D1~Dn是可观星时段中每一时刻可持续观测Δtl时长的信息矩阵;其中,相邻时刻之间的间隔为
Figure FDA0002477007520000013
fr为轨迹信息的采样频率;
3)给出观星时长Δtobs和星敏感器调姿准备时长Δtatti,根据航天器飞行时长设置观星时段:优化变量设置为2k次观星开始时间为t1、t2、……、t2k,当1≤n≤k第n次观星开始时间的选择区间是[tua+(n-1)·(Δtobs+Δtatti),tud-(k-n)·Δtatti-(k-n+1)·Δtobs];当k+1≤n≤2k时,第n次观星开始时间的选择区间是[tda+(n-k-1)·(Δtobs+Δtatti),tdd-(2k-n)·Δtatti-(2k-n+1)·Δtobs],线性约束t1-t2≤-Δtobs-Δtatti、t3-t4≤-Δtobs-Δtatti;将2k次观星开始时间的选择区间和线性约束作为遗传算法的输入;其中t1、t2、……、t2k、Δtobs、Δtatti为非负整数;[tua,tud]为升弧段星敏感器可观星时段;[tda,tdd]为降弧段星敏感器可观星时段;由遗传算法给出一组符合选择区间和线性约束的观星开始时刻,判断给出的观星开始时刻t1是否可以匹配到E中有折射星的时刻,若否,则令第一个观星时段观星权重J1=M1;若是,则提取t1时刻的折射星单位方向矢量ei,i=1,2...n且i∈N+,其中N+为正整数集合;将星敏感器主光轴单位方向矢量n分别对准恒星方向ei,即令n=ei
4)分别计算2k次观星得到的权重J1、J2、……、J2k,令目标函数J=J1+J2+……+J2k
5)将目标函数J作为遗传算法的输入,得到一组优化结果[T1 T2 …… T2k],找到时刻T1、T2、……、T2k观测到的最大折射角对应的折射星方向矢量
Figure FDA0002477007520000021
2k个观星开始时刻的姿态即为n1、n2、……、n2k
2.根据权利要求1所述的基于惯性/天文组合导航应用的折射星优选方法,其特征在于,M1=10~60。
3.根据权利要求1所述的基于惯性/天文组合导航应用的折射星优选方法,其特征在于,步骤2)的具体实现过程包括:
1)间隔
Figure FDA0002477007520000022
遍历可观星时段[tua,tud]和[tda,tdd],计算恒星子星库A中恒星反方向的单位方向矢量-e与当前时刻航天器的位置矢量rn的地心夹角θ,以及地心夹角θ的极大值θmax和极小值θmin;筛选出恒星子星库A中地心夹角θ满足以下要求的恒星:θmin≤θ≤θmax;对于地心夹角θ满足要求的恒星,筛选出恒星星光折射高度hg满足以下条件的恒星:hmax,0≥hg≥hmin,0;其中,hmax,0、hmin,0分别为折射高度上限和折射高度下限;将满足恒星星光折射高度要求的恒星的轨迹时刻、星号、单位方向矢量、折射高度记录写入信息矩阵B:
Figure FDA0002477007520000031
其中tn是当前计算的轨迹时刻;Nn1~Nnm是tn时刻满足hg=|rn|sinθ-Re的恒星编号,en1~enm和hn1~hnm是与恒星编号Nn1~Nnm对应的恒星单位方向矢量和折射高度;Re为地球平均半径;
2)提取信息矩阵B中恒星的方向矢量e,根据下式计算恒星与太阳、月球的夹角是否满足强光源规避条件:
Figure FDA0002477007520000032
其中θsun是太阳规避角,θmoon是月球规避角,esun是太阳的地心矢径,emoon是月球的地心矢径;将B中符合强光源规避条件的恒星信息写入信息矩阵C:
Figure FDA0002477007520000033
其中,Na1~Nab是tn时刻符合强光源规避条件的恒星编号,ea1~eab和ha1~hab分别是与恒星编号Na1~Nab对应的恒星单位方向矢量和折射高度;
3)给出观星持续时间Δtl,判断信息矩阵C中tn对应的折射星编号集合S0和tn+Δtl时刻的恒星编号集合
Figure FDA0002477007520000034
是否相同:相同则tn时刻折射星信息不变,写入信息矩阵D;不相同则计算
Figure FDA0002477007520000035
将Sl中恒星编号对应的恒星信息写入D:
Figure FDA0002477007520000036
其中,D是tn时刻可持续观测Δtl时长的折射星信息矩阵,Nn1~Nnm、en1~enm和hn1~hnm分别是D内的折射星编号、恒星单位方向矢量和折射高度;
4)以
Figure FDA0002477007520000037
为间隔,遍历[tua,tud-Δtl]和[tda,tdd-Δtl]时段的所有时刻,将折射星信息写入折射星库E:
Figure FDA0002477007520000041
D1~Dn是可观星时段中每一时刻可持续观测Δtl时长的折射星信息矩阵。
4.根据权利要求1所述的基于惯性/天文组合导航应用的折射星优选方法,其特征在于,所述可观星时段[tua,tud]和[tda,tdd]符合Hmin≤H≤Hmax;其中,Hmax、Hmin分别为星敏感器工作的高度上限和下限。
5.根据权利要求3所述的基于惯性/天文组合导航应用的折射星优选方法,其特征在于,地心夹角
Figure FDA0002477007520000042
地心夹角θ的极大值θmax和极小值θmin的计算公式为:
Figure FDA0002477007520000043
6.根据权利要求1所述的基于惯性/天文组合导航应用的折射星优选方法,其特征在于,步骤5)的具体实现过程包括:
a)给出星敏感器视场角θc,将t1时刻满足条件
Figure FDA0002477007520000044
的恒星信息写入信息矩阵F:
Figure FDA0002477007520000045
其中,N1~Nn是t1时刻满足
Figure FDA0002477007520000046
的恒星编号,e1~en是与N1~Nn恒星编号对应的恒星单位方向矢量;
b)计算F中折射星的地心夹角θ,判断θmin≤θ≤θmax是否成立,成立则保留F中的折射星信息,并计算折射高度hg=rsinθ-Re;判断折射高度是否满足hmax≥hg≥hmin,将F中同时符合折射高度和地心夹角约束的恒星编号、单位方向矢量记入信息矩阵G:
Figure FDA0002477007520000051
其中,N1~Nm是t1时刻满足θmin≤θ≤θmax的恒星编号,e1~em和hg1~hgm分别是恒星编号N1~Nm对应的恒星单位方向矢量和折射高度;
c)判断G中恒星的方向矢量与强光源地心矢径的夹角是否满足强光源规避条件,计算符合强光源规避约束的恒星星光折射角:
Figure FDA0002477007520000052
其中ρ0是高度h0处的标准密度,H是密度标尺高度;将G中符合强光源规避约束的恒星编号,单位方向矢量和折射角写入信息矩阵I:
Figure FDA0002477007520000053
其中,N1~Nk是t1时刻满足
Figure FDA0002477007520000054
的恒星编号,e1~ek和ar1~ark分别是恒星编号对应的恒星单位方向矢量和折射角;c为大气密度模型的比例系数;k(γ)为折射因子,
Figure FDA0002477007520000055
λ是星敏感器观测折射星光的波长。
d)提取I中折射角的最大值ar,max,根据下式判断t1时刻观星权重值At1
Figure FDA0002477007520000056
e)以
Figure FDA0002477007520000057
为间隔,计算第一个观星时段[t1 t1+Δtobs]内所有时刻的观星权重值At,其中t∈N+,且t∈[t1 t1+Δtobs],则第一个观星时段平均观星效果
Figure FDA0002477007520000061
找到观星权重最大值A1,max和其对应的t1时刻星敏主光轴单位方向矢量n1,判断A1,max是否等于0:若是,则J1=M1;否则,
Figure FDA0002477007520000062
f)计算第二个观星时段时,写入F矩阵的恒星方向矢量e,在满足
Figure FDA0002477007520000063
的同时,还满足e·n1≤0,重复步骤a)~e),得到观星权重J2和t2时刻星敏主光轴的单位方向矢量n2
计算第三个观星时段时,写入F矩阵的恒星方向矢量e,在满足
Figure FDA0002477007520000064
的同时,还满足
Figure FDA0002477007520000065
重复步骤a)~e),计算得到观星权重J3和t3时刻星敏主光轴的单位方向矢量n3;依此类推,计算第2k个观星时段时,写入F矩阵的恒星方向矢量e,在满足
Figure FDA0002477007520000066
的同时,还满足
Figure FDA0002477007520000067
重复步骤a)~e),得到观星权重J2k和t2k时刻星敏主光轴的单位方向矢量n2k;则目标函数J=J1+J2+……+J2k;2k个观星开始时刻的姿态即为n1、n2、……、n2k
7.一种基于惯性/天文组合导航应用的折射星优选系统,其特征在于,包括计算机设备;所述计算机设备被编程或配置为执行权利要求1~6之一所述方法的步骤。
CN202010367026.5A 2020-04-30 2020-04-30 基于惯性/天文组合导航应用的折射星优选方法及系统 Active CN111578934B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010367026.5A CN111578934B (zh) 2020-04-30 2020-04-30 基于惯性/天文组合导航应用的折射星优选方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010367026.5A CN111578934B (zh) 2020-04-30 2020-04-30 基于惯性/天文组合导航应用的折射星优选方法及系统

Publications (2)

Publication Number Publication Date
CN111578934A true CN111578934A (zh) 2020-08-25
CN111578934B CN111578934B (zh) 2022-07-29

Family

ID=72109198

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010367026.5A Active CN111578934B (zh) 2020-04-30 2020-04-30 基于惯性/天文组合导航应用的折射星优选方法及系统

Country Status (1)

Country Link
CN (1) CN111578934B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114526726A (zh) * 2022-02-09 2022-05-24 中国人民解放军火箭军研究院科技创新研究中心 基于可观性分析的星光折射导航观星方案优化设计方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103616028A (zh) * 2013-11-29 2014-03-05 哈尔滨工程大学 一种基于单星敏感器的星光折射卫星自主导航方法
CN105352500A (zh) * 2015-10-21 2016-02-24 北京航空航天大学 带天体干扰的自适应选星方法及系统
CN106441280A (zh) * 2012-09-17 2017-02-22 常州工学院 用于星敏感器的筛选导航星的方法
CN108507569A (zh) * 2017-11-10 2018-09-07 中国人民解放军国防科技大学 用于星光/惯性复合制导的弹载恒星星库快速生成方法
US20190086209A1 (en) * 2016-03-17 2019-03-21 Qinetiq Limited Celestial navigation system
CN109579829A (zh) * 2018-11-29 2019-04-05 天津津航技术物理研究所 一种小视场星敏感器短波导航星识别方法
CN109813302A (zh) * 2019-01-29 2019-05-28 中国人民解放军国防科技大学 最佳可用导航星快速确定方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106441280A (zh) * 2012-09-17 2017-02-22 常州工学院 用于星敏感器的筛选导航星的方法
CN103616028A (zh) * 2013-11-29 2014-03-05 哈尔滨工程大学 一种基于单星敏感器的星光折射卫星自主导航方法
CN105352500A (zh) * 2015-10-21 2016-02-24 北京航空航天大学 带天体干扰的自适应选星方法及系统
US20190086209A1 (en) * 2016-03-17 2019-03-21 Qinetiq Limited Celestial navigation system
CN108507569A (zh) * 2017-11-10 2018-09-07 中国人民解放军国防科技大学 用于星光/惯性复合制导的弹载恒星星库快速生成方法
CN109579829A (zh) * 2018-11-29 2019-04-05 天津津航技术物理研究所 一种小视场星敏感器短波导航星识别方法
CN109813302A (zh) * 2019-01-29 2019-05-28 中国人民解放军国防科技大学 最佳可用导航星快速确定方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
NING XIAOLIN 等: "An Implicit UKF for Satellite Stellar Refraction Navigation System", 《IEEE TRANSACTIONS ON AEROSPACE》 *
王鼎杰等: "星光折射辅助惯性/天文紧组合高精度导航方法", 《中国惯性技术学报》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114526726A (zh) * 2022-02-09 2022-05-24 中国人民解放军火箭军研究院科技创新研究中心 基于可观性分析的星光折射导航观星方案优化设计方法

Also Published As

Publication number Publication date
CN111578934B (zh) 2022-07-29

Similar Documents

Publication Publication Date Title
CN105905317B (zh) 一种卫星对日定向控制系统及其控制方法
CN107655485B (zh) 一种巡航段自主导航位置偏差修正方法
CN101788296B (zh) 一种sins/cns深组合导航系统及其实现方法
WO2017113567A1 (zh) 火星探测器自主导航方法
CN102261921B (zh) 一种修正大气折射对星敏感器精度影响的方法
CN104457705B (zh) 基于天基自主光学观测的深空目标天体初定轨方法
CN107609267B (zh) 一种月球有限推力多次捕获轨道实现方法
CN113551668B (zh) 一种航天器惯性/恒星星光矢量/星光折射组合导航方法
CN103674032A (zh) 融合脉冲星辐射矢量和计时观测的卫星自主导航系统及方法
WO2023272559A1 (zh) 全球碳盘点卫星的轨道设计系统
CN105631095A (zh) 一种等间隔发射的多约束地月转移轨道簇搜索方法
CN112937918B (zh) 一种基于强化学习的多约束下的卫星姿态机动规划方法
CN103148856B (zh) 一种基于自适应尺度变化的借力飞行探测器自主天文导航方法
CN111578934B (zh) 基于惯性/天文组合导航应用的折射星优选方法及系统
CN110096726A (zh) 基于月球借力的geo卫星应急转移轨道快速优化设计方法
CN111207773B (zh) 一种用于仿生偏振光导航的姿态无约束优化求解方法
CN112525203A (zh) 一种基于角度约束辅助测量的航天器自主天文导航方法
CN116105730A (zh) 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法
CN104252548A (zh) 一种燃料最优的火星探测器入轨目标点设计方法
CN110162069B (zh) 一种近地轨道航天器阳光反射凝视期望姿态解析求解方法
Zhu et al. A high-accuracy SINS/CNS integrated navigation scheme based on overall optimal correction
CN108507569B (zh) 用于星光/惯性复合制导的弹载恒星星库快速生成方法
CN107677266B (zh) 基于自旋-仰角跟踪理论的星光导航系统及其解算方法
CN110595486A (zh) 基于双星在轨遥测数据的高精度半长轴偏差计算方法
CN115420280A (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