CN114200491A - 一种基于导航数据的应急航天器星历确定方法及系统 - Google Patents
一种基于导航数据的应急航天器星历确定方法及系统 Download PDFInfo
- Publication number
- CN114200491A CN114200491A CN202010910094.1A CN202010910094A CN114200491A CN 114200491 A CN114200491 A CN 114200491A CN 202010910094 A CN202010910094 A CN 202010910094A CN 114200491 A CN114200491 A CN 114200491A
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- ephemeris
- navigation data
- vector
- value
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 135
- 239000013598 vector Substances 0.000 claims abstract description 81
- 238000001914 filtration Methods 0.000 claims abstract description 29
- 238000004364 calculation method Methods 0.000 claims abstract description 18
- 238000005259 measurement Methods 0.000 claims description 74
- 239000011159 matrix material Substances 0.000 claims description 28
- 230000008569 process Effects 0.000 claims description 22
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 239000011541 reaction mixture Substances 0.000 claims description 6
- 230000001174 ascending effect Effects 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 4
- 230000000630 rising effect Effects 0.000 claims description 3
- KWYHDKDOAIKMQN-UHFFFAOYSA-N N,N,N',N'-tetramethylethylenediamine Chemical compound CN(C)CCN(C)C KWYHDKDOAIKMQN-UHFFFAOYSA-N 0.000 claims 1
- 238000004088 simulation Methods 0.000 description 23
- 238000010586 diagram Methods 0.000 description 11
- 230000000694 effects Effects 0.000 description 6
- 238000004422 calculation algorithm Methods 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 230000006872 improvement Effects 0.000 description 3
- 230000000737 periodic effect Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 239000012634 fragment Substances 0.000 description 2
- 238000012804 iterative process Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- BTIJJDXEELBZFS-QDUVMHSLSA-K hemin Chemical compound CC1=C(CCC(O)=O)C(C=C2C(CCC(O)=O)=C(C)\C(N2[Fe](Cl)N23)=C\4)=N\C1=C/C2=C(C)C(C=C)=C3\C=C/1C(C)=C(C=C)C/4=N\1 BTIJJDXEELBZFS-QDUVMHSLSA-K 0.000 description 1
- 229940025294 hemin Drugs 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 206010037844 rash Diseases 0.000 description 1
- 239000000523 sample Substances 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/27—Acquisition or tracking or demodulation of signals transmitted by the system creating, predicting or correcting ephemeris or almanac data within the receiver
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/25—Acquisition or tracking or demodulation of signals transmitted by the system involving aiding data received from a cooperating element, e.g. assisted GPS
- G01S19/258—Acquisition or tracking or demodulation of signals transmitted by the system involving aiding data received from a cooperating element, e.g. assisted GPS relating to the satellite constellation, e.g. almanac, ephemeris data, lists of satellites in view
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Power Engineering (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于导航数据的应急航天器星历确定方法及系统,所述方法包括:从航天器的导航设备获取导航数据,所述导航数据包括:航天器飞行状态矢量;当导航数据不足,则基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历;否则,基于导航数据使用UKF方法计算得到航天器的星历;所述导航数据不足是指基于导航数据使用UKF方法无法收敛到所设定的精度。本发明的方法提出了快速有效的迭代和滤波解算方法,解算精度达到了两行轨道根数标准格式精度要求;本发明的方法可操作性强,步骤简单,且针对观测数据不足和充足两种情况均可解算航天器星历。
Description
技术领域
本发明涉及航天航空领域,具体涉及一种基于导航数据的应急航天器星历确定方法及系统。
背景技术
随着航天与空间技术的飞速发展,越来越多的航天器,包括卫星、载人飞船、空间站、深空探测器等,被发射到太空中,从而使得太空中的可用空间大大减小。据统计,截止2019年10月4日,地球上约有10779个直径超过10cm的空间物体在太空中,其中包括5181个航天器和14598个空间碎片。此外,空间中还存在着大量直径小于10cm的空间碎片。这些都对正常运行的航天器的安全构成了极大的威胁。因此,规避空间碎片已成为一项非常重要的应急航天任务。该任务的前提是确定航天器的星历,并预测其轨道,以确定它是否会与轨道附近的空间碎片相撞。如果有发生碰撞的危险,有必要及时进行轨道控制以避免危险。此外,当某些自然灾害发生时,例如火山爆发、地震和森林火灾等,无法在地面上观察到灾害现场。但是,诸如侦察卫星和遥感卫星之类的航天器却非常适合在这种应急空间侦察任务中对灾害现场进行空间观测,但前提也是要先确定其星历,以便计算这些卫星何时可以运行到灾害发生地方的上空从而进行侦察和探测。除了这些应急空间任务外,航天器还可能发生其他一些紧急情况。例如,导航设备无法提供足够的导航数据、数据包含较大的测量噪声或测量时间间隔较大等,进而导致导航数据不可用,难以解算确定航天器的星历。
关于应急航天器的星历确定,美国空军太空司令部(AFSPC)发布的两行轨道根数(Two Line Elements,TLE)可能是最准确的描述。TLE不是瞬时轨道根数,而是通过特殊方式消除周期性变化得到的平均轨道根数。另一方面,TLE具有标准化的格式,并且只能与SGP(Simplified General Perturbations)轨道模型配套使用。此外,应急航天任务还强调自主与实时性,以满足时效性的要求。一般地,传统的轨道确定方法将星上导航数据传输到地面站进行计算,然后再将结果传输到航天器。尽管其结果具有较高的精确度,但它占用大量计算资源,并且消耗大量的时间进行数据传输。因此,当考虑到实时性和星载计算能力时,传统的轨道确定方法对于应急航天任务是不可接受的。
实际上,大多数轨道模型,例如二体模型、J2摄动模型和高精度轨道预测(HighPrecision Orbit Prediction,HPOP)模型,都使用瞬时轨道根数进行轨道预报。但是, TLE的参数是“平均”轨道根数,与瞬时轨道根数不同,尽管这两种轨道根数非常相似,但是如果将TLE替换为瞬时轨道根数代入SGP模型进行轨道预报,将会造成很大的预报误差。因此,将瞬时轨道根数转换为TLE是非常必要的。但是,AFSPC并没有公布这两种轨道根数相互转换的方法。为了解决这个问题,必须建立模型解算可以用于SGP的两行轨道根数。
Ken Cranford在1970年建立了SGP4模型,并用于近地卫星轨道预报。将Lane 和Cranford的解析理论进行简化,将重力模型和空气动力学模型作为Brouwer和功率密度函数的解,便可以得到SGP4模型。该模型考虑了几个长期和长周期扰动项,以确保轨道预报的精度。例如,J2,J3和J4项以及和空气阻力等。但是由于未考虑短周期扰动项,SGP4模型的位置预报精度只能达到2km。Vallado根据TLE和SGP4 模型开发了一个轨道预报软件包。胡敏和李卫平等,提出了瞬时轨道根数和平均轨道根数之间的一种转换方法。为了提高太空飞行的安全性,韩蕾、史纪鑫等人,建立了基于SGP4和TLE的空间碎片轨道预测方法。但是,几乎所有这些研究都未考虑航天器的自主性和实时性。李梦奇提出了两种方法来修改TLE的阻力系数,并将 SGP4的预测精度提高了20%以上。陈俊宇等,对低地球轨道(Low EarthOrbit,LEO) 碎片的阻力系数进行研究,并估计了2000多个空间碎片的阻力系数来检验TLE的精度。Wesam等,运用批量最小二乘技术和测距率来校正历元时刻的TLE角度误差,提高了圆形轨道确定的准确性。由于这些研究仅研究了星历确定中TLE的部分元素,因此需要对其他元素的解算进行更多的研究。此外,这些方法也可能不适用于应急航天任务。因此,建立一种高效自主的航天器星历确定方法来解算应急航天器的星历则十分重要。
发明内容
本发明的目的在于克服上述技术缺陷,提出了两种基于卫星导航数据的方法来确定航天器星历。当导航数据有限时,则可利用迭代方法解算,因为仅依靠某一时刻的航天器飞行状态矢量即可执行迭代方法。如果导航数据足够多时,则可以利用滤波方法解算航天器星历。两种方法都具有很高的效率,并且可以满足TLE格式的精度要求。
为实现上述目的,本发明的实施例1提出了一种基于导航数据的应急航天器星历确定方法,所述方法包括:
从航天器的导航设备获取导航数据,所述导航数据包括:航天器飞行状态矢量;
当导航数据不足,则基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历;否则,基于导航数据使用UKF方法计算得到航天器的星历;所述导航数据不足是指基于导航数据使用UKF方法无法收敛到所设定的精度。
作为上述方法的一种改进,基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历,具体包括:
步骤S1)从导航设备获取航天器当前飞行状态矢量;将其转换到TEMED坐标系得到该坐标系下的飞行状态矢量ρ0=[r0 v0]T,r0为位置矢量,v0为速度矢量;迭代次数的初始值k=1;
步骤S2)根据轨道动力学理论,基于ρk-1计算航天器在第k次迭代下的瞬时轨道根数ik为轨道倾角,Ωk为升交点赤经,ek为偏心率,ωk为近地点角距,Mk为平近点角,nk为平均运动角速度,为大气阻力系数,为常数;
步骤S3)将计算得到的航天器瞬时轨道根数视为TLE并代入SGP4模型进行轨道预报,得到当前迭代步数下的航天器飞行状态矢量ρk=[rk vk]T;
步骤S4)利用误差参数δρ=ρk-ρ0修正航天器的飞行状态,得到ρk+1=ρk+δρ;
步骤S5)若误差参数|δρ|小于给定值;则αk为所求的平均轨道根数α0,即航天器的星历;否则,k加1后转入步骤S2)。
作为上述方法的一种改进,所述基于导航数据使用UKF方法计算得到航天器的星历,具体包括:
λ=α2(l+κ)-l
其中,ω(i)为权重,λ是缩放比例参数;l代表状态矢量的维数;α代表主要比例因子,该因子可控制选取的sigma点的分布状态,其取值范围是10-3≤α≤1;β代表次要比例因子,β≥0;κ代表三次比例因子,其值为零;
其中,Q为过程噪声协方差阵;
步骤T8)计算得到滤波增益矩阵Kk+1:
其中,Zk+1为第k+1的真实测量值;
作为上述方法的一种改进,所述获取星历状态初值X0和状态协方差初值P0,具体包括:
设航天器的当前飞行状态矢量为ρ0=[r0 v0]T,r0=[r01 r02 r03]为位置矢量,r01,r02,r03分别为三个方向的位置坐标值;v0=[v01 v02 v03]为速度矢量,v01,v02,v03分别为三个方向的速度值;则动量矩矢量h为:
h=[h1 h2 h3]T=r0×v0
h1,h2,h3为动量矩矢量h三个方向的标量;
动量矩大小h为:
则轨道倾角i为:
偏心率矢量e为:
其中,μ=3.986004356×1014为地球引力常数;e1,e2,e3为偏心率矢量e三个方向的标量;
则偏心率大小e为:
由此计算得到轨道半长轴a:
轨道平均运动角速度n为:
升交点矢量N为:
N=[N1 N2 N3]T=[0 0 1]T×h
其中,N1,N2,N3为升交点矢量N三个方向的标量;
升交点矢量的大小N为:
考虑到升交点赤经Ω的范围为0至360度,所以分两种情况计算,当N2≥0时,
当N2<0时,
近地点角距ω分两种情况,当e3≥0时,
当e3<0时,
当r03≥0时,升交点角距u为:
当r03<0时,升交点角距u为:
则真近点角f为:
f=u-ω
当f<180°时,偏近点角E为:
当f≥180°时,偏近点角E为:
则平近点角M为:
M=E-esin(E)
则星历状态初值X0为:
X0=[i Ω e ω M n B*]T
B*为大气阻力系数,根据经验值给定;
状态协方差初值P0为:
P0=diag([10-7 10-7 10-7 10-7 10-7 10-7 10-7])。
本发明的实施例2提供了一种基于导航数据的应急航天器星历确定系统,所述系统包括:数据获取模块和航天器星历计算模块;
数据获取模块,用于从航天器的导航设备获取导航数据,所述导航数据包括:航天器飞行状态矢量;
航天器星历计算模块,用于当导航数据不足,则基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历;否则,基于导航数据使用UKF方法计算得到航天器的星历;所述导航数据不足是指基于导航数据使用UKF方法无法收敛到所设定的精度。
本发明的优势在于:
1、本发明的方法提出了快速有效的迭代和滤波解算方法,解算精度达到了两行轨道根数标准格式精度要求;
2、本发明的方法可操作性强,步骤简单,且针对观测数据不足和充足两种情况均可解算航天器星历;
3、本发明的方法适用于应急航天器星历解算场景,占用星上计算资源少,自主性和实时性强。
附图说明
图1为本发明的迭代方法的流程图;
图2为本发明的UKF方法的流程图;
图3(a)为轨道倾角和迭代次数的示意图;
图3(b)为偏心率和迭代次数的示意图;
图4(a)为迭代算法(没有测量噪声)解算的星历进行轨道预报的位置误差的示意图;
图4(b)为迭代算法(没有测量噪声)解算的星历进行轨道预报的速度误差的示意图;
图5为测量噪声对迭代方法的影响的示意图;
图6(a)为不同测量噪声下的迭代方法的轨道预报的位置误差示意图;
图6(b)为不同测量噪声下的迭代方法的轨道预报的速度误差示意图;
图7为EKF和UKF结果的精度对比示意图;
图8(a)为EKF和UKF结果的轨道倾角滤波过程对比图;
图8(b)为EKF和UKF结果的偏心率滤波过程对比图;
图8(c)为EKF和UKF结果的平均运动角速度滤波过程对比图;
图8(d)为EKF和UKF结果的滤波残差滤波过程对比图;
图9(a)为EKF和UKF结果进行轨道预报的位置误差示意图;
图9(b)为EKF和UKF结果进行轨道预报的速度误差示意图;
图10(a)为3σ测量噪声对滤波算法的影响示意图;
图10(b)为10σ测量噪声对滤波算法的影响示意图;
图11(a)为3σ测量噪声下EKF和UKF进行轨道预报的位置误差示意图;
图11(b)为3σ测量噪声下EKF和UKF进行轨道预报的速度误差示意图;
图11(c)为10σ测量噪声下EKF和UKF进行轨道预报的位置误差示意图;
图11(d)为10σ测量噪声下EKF和UKF进行轨道预报的速度误差示意图。
具体实施方式
下面结合附图对本发明的技术方案进行详细说明。
本发明的实施例1提出了一种基于导航数据的应急航天器星历确定方法,包括:
1建模与坐标转换
SGP4模型的变量是两行轨道根数。两行轨道根数的元素为SGP类型的平均运动角速度n0,轨道倾角i0,偏心率e0,平近点角M0,近地点角距ω0,升交点赤经Ω0,平均运动角速度的一阶变化率平均运动角速度的二阶变化率和SGP类型的大气阻力系数所有变量都是通过特定方式消除周期性变化而获得的“平均”值。另外,它们是被定义在航天器进入其轨道的历元时刻。将TLE代入为SGP4模型可以预报飞行状态,包括航天器的位置和速度,可以描述如下:
其中s(t)、r(t)和v(t)都是行向量,S(·)代表SGP4模型,α0代表TLE的元素,t代表从历元时刻t0开始的时间间隔:
已知SGP4模型和TLE的参考坐标系为TEMED(True Equator and Mean Equinox ofDate)参考系统。但是,导航数据的参考坐标系是WGS84(World Geodetic System 1984)。因此,需要将导航数据经过两次坐标转换,从WGS84转换为J2000.0,再从J2000.0转换为TEMED。
2航天器星历迭代解算方法
导航数据是迭代方法和滤波方法解算航天器星历的输入。两种方法是基于导航数据不足和充足两种情况建立的。在正常情况下,导航数据是与时间匹配的连续数据集。当导航数据充足时,滤波方法和迭代方法都可以解算航天器星历。但是,当发生特殊情况(例如导航设备故障)时,导航数据可能不可用。因此,在这种情况下只有有限数量的导航数据可以利用,滤波方法可能会由于测量数据不足而无法收敛,导致无法解算出满足精度的航天器星历。相反,迭代方法却可以很好地工作,因为一组有效的导航数据即可执行迭代过程。因此,迭代方法在两种情况下均能有效地解算航天器星历,而滤波方法只有在导航数据充足时才能有效地解算航天器星历。
根据轨道动力学理论,利用包含航天器位置和速度的GPS导航数据,可以计算出航天器的瞬时轨道根数。但是由于消除周期性变化的特定过程未知,使得确定航天器的平均轨道根数也即星历变得非常困难。为了解决这个问题,将该过程视为“黑匣子”,利用“输出”来求解“输入”。航天器的星历为“输入”,航天器的飞行状态为“输出”,基于“黑匣子”的迭代方法过程如图1所示。
首先,从导航设备获取航天器当前飞行状态矢量然后,将其转换到TEMED坐标系得到ρ0=[r0 v0]T。接着,根据轨道动力学理论计算航天器在当前迭代步数下的瞬时轨道根数由于迭代方法无法解算大气阻力系数,因此根据经验值将设置为常数。然后,将计算得到的航天器瞬时轨道根数视为TLE并代入SGP4模型进行轨道预报,得到当前迭代步数下的航天器飞行状态矢量ρk=[rkvk]T,(k=1,2,3...)。接着,利用误差参数δρ=ρk-ρ0修正航天器的飞行状态,得到ρk+1=ρk+δρ。重复上述过程直到误差参数|δρ|小于给定值。则最后一次迭代的结果即为所求的平均轨道根数,也即航天器的星历。
3航天器星历滤波解算方法
3.1EKF解算方法
通过迭代方法,可以根据航天器任意时刻的飞行状态矢量解算得到星历。但是,迭代方法的缺点也不容忽视。首先,它不能充分利用所有导航数据。其次,由于在整个迭代过程中未更新用来对比的标准飞行状态矢量,因此无法消除测量噪声的影响。另外,它不能解算大气阻力系数。最后,一旦无法获得导航数据中的飞行状态矢量,其功能将无法实现。为了充分利用所有导航数据并消除测量噪声的影响,建立了扩展卡尔曼滤波方法来解算航天器星历。实际上,它是基于状态估计理论建立的,其中星历是状态变量,而飞行状态是测量变量。
Y=HX+V
其中Y=[x y z]T是测量变量,H是测量矩阵,V是服从高斯噪声理论的测量噪声。
由于SGP4模型的复杂性与非线性,因此无法使用来计算测量矩阵。但是可通过数值差商来计算测量矩阵H。首先,使用SGP4模型计算tk-1时刻的 Yk-1=[xk-1 yk-1zk-1]T。然后,分别给星历的元素增加一个小量。在这里,以轨道倾角为例:
Xk-1/i=[i+δi Ω e ω M n B*]T
然后利用SGP4模型预报航天器当前时刻的飞行状态Yk-1/i=[xk-1/i yk-1/i zk-1/i]T。进而可得到如下的数值差商:
其他六个元素的差商通过相同的方式获得,则测量矩阵为:
最后,即可建立完整的EKF(Extended Kalman Filter)滤波方程。
3.2UKF解算方法
尽管EKF方法可以有效消除测量噪声并充分利用导航数据,但仍存在一些不足。首先,它对非线性测量方程进行了线性化,导致存在线性化误差,这可能使滤波发散。此外,用数值差商代替偏导数会增加计算的复杂度,占用过多计算资源。因此,建立无迹卡尔曼滤波方法来弥补扩展卡尔曼滤波方法的不足。
UKF(Unscented Kalman Filter)最特殊优势的是利用无迹变换(UnscentedTransform,UT)而不是线性化来处理均值和协方差的传递。对于UT,为了获取原始状态矢量的均值和协方差,选择了一组选定的sigma点。然后,通过非线性模型进行映射。接着,计算sigma点的均值和协方差。这样,对于任意的非线性函数,均值和协方差可以达到二阶精度。
类似地,状态变量由X表示,状态转换矩阵也为单位矩阵。测量方程为:
由于导航数据是离散的,并且仅使用了位置矢量,因此可以将上述公式改为:
其中,S(X,k)r表示预测位置矢量,V表示测量噪声矢量。
sigma点及其权重通过以下方程计算:
λ=α2(l+κ)-l是缩放比例参数;l代表状态矢量的维数;α代表主要比例因子,该因子可控制选取的sigma点的分布状态,其经验取值范围是10-3≤α≤1;β代表次要比例因子,通常β≥0;κ代表三次比例因子,其值通常为零。
显然,UKF没有线性化。本质上,它实现了无迹变换以使sigma点的均值和协方差与原始特征相匹配。然后,利用sigma点的非线性映射得到状态量的概率密度函数。
具体地,UKF方法解算星历的步骤包括:
所述获取星历状态初值X0和状态协方差初值P0,具体包括:
设航天器的当前飞行状态矢量为ρ0=[r0 v0]T,r0=[r01 r02 r03]为位置矢量,r01,r02,r03分别为三个方向的位置坐标值;v0=[v01 v02 v03]为速度矢量,v01,v02,v03分别为三个方向的速度值;则动量矩矢量h为:
h=[h1 h2 h3]T=r0×v0
h1,h2,h3为动量矩矢量h三个方向的标量;
动量矩大小h为:
则轨道倾角i为:
偏心率矢量e为:
其中,μ=3.986004356×1014为地球引力常数;e1,e2,e3为偏心率矢量e三个方向的标量;
则偏心率大小e为:
由此计算得到轨道半长轴a:
轨道平均运动角速度n为:
升交点矢量N为:
N=[N1 N2 N3]T=[0 0 1]T×h
其中,N1,N2,N3为升交点矢量N三个方向的标量;
升交点矢量的大小N为:
考虑到升交点赤经Ω的范围为0至360度,所以分两种情况计算,当N2≥0时,
当N2<0时,
近地点角距ω分两种情况,当e3≥0时,
当e3<0时,
当r03≥0时,升交点角距u为:
当r03<0时,升交点角距u为:
则真近点角f为:
f=u-ω
当f<180°时,偏近点角E为:
当f≥180°时,偏近点角E为:
则平近点角M为:
M=E-esin(E)
则星历状态初值X0为:
X0=[i Ω e ω M n B*]T
B*为大气阻力系数,根据经验值给定;
状态协方差初值P0为:
P0=diag([10-7 10-7 10-7 10-7 10-7 10-7 10-7])。
λ=α2(l+κ)-l
其中,ω(i)为权重,λ是缩放比例参数;l代表状态矢量的维数;α代表主要比例因子,该因子可控制选取的sigma点的分布状态,其取值范围是10-3≤α≤1;β代表次要比例因子,β≥0;κ代表三次比例因子,其值为零;
其中,Q为过程噪声协方差阵;
步骤T8)计算得到滤波增益矩阵Kk+1:
其中,Zk+1为第k+1的真实测量值;
4数值仿真
方法和模型已经建立,下面将通过数值仿真来验证有效性和准确性。航天器的参数是从STK(Systems Tool Kit)的TLE数据库中选择的,而导航数据是由STK仿真模拟得到的。选择tle-00005航天器来实施仿真,它是STK软件包的TLE数据库中的一个航天器,是美国海军在1958年3月17日发射的,其名称为Vanguard1。它的平均运动为10.839419606圈/天,其偏心率为0.1852049。经过换算可知,它的周期约为133分钟,其轨道为椭圆轨道。它的这些特点与一些可执行应急航天任务的 LEO航天器相似。此外,当周期小于255min时,SGP4的性能更好。因此,选择了该航天器,其两行轨道根数如表1所示:
表1:tle-00005航天器两行轨道根数
4.1迭代方法仿真
利用STK仿真,得到航天器在WGS84系中的飞行状态。任意选择一组状态量,文中选取2007年5月18日12:00:19.609时刻的位置和速度矢量。表2列出了不含测量噪声的该航天器的位置和速度矢量。对位置和速度矢量进行坐标转换,得到 TEMED系下的飞行状态矢量,代入迭代方法进行仿真。结果如表3所示,以轨道倾角和偏心率的绝对误差来说明迭代过程,如图3(a)和图3(b)所示。
表2:tle-00005航天器的飞行状态参数(WGS84)
表3:迭代方法结果与STK值对比
根据表3中的比较,迭代方法具有很高的精度。当没有测量噪声时,四个角度的精度为至少10-6度,偏心精度为10-10,平均运动角速度精度为10-8圈/天。根据图2,大约3次迭代即可收敛,9次迭代可达到给定的精度要求。利用由迭代方法解算的TLE预报该卫星的位置和速度,并将其与STK仿真值进行比较,结果如图4(a) 和图4(b)所示。
在图4(a)和图4(b)中,我们可以看到一天内,三个方向上的位置预报误差都在1m以内,而速度误差都在10-3m/s以内。这表明在没有测量噪声的情况下,迭代方法是有效的,且解算精度很高。
如前所述,迭代方法容易受到测量噪声的影响。为了说明这种影响,在导航数据中叠加服从高斯噪声理论的随机误差。噪声的均值设置为零,而噪声的方差分别设置为10m,20m和30m。解算得到的TLE绝对误差如图5所示。根据图5,绝对误差随测量噪声增大而增大。然后,利用TLE预报航天器的位置和速度,并与STK 值进行比较。结果如图6(a)和图6(b)所示。
当测量噪声增大时,位置和速度预报误差也会增大。如果测量噪声的方差大于10m,则位置和速度预报误差将分别达到1000m和1m/s以上。由此可见,迭代方法确实容易受到测量噪声的影响。还可以看到位置和速度预报误差在400分钟左右最小,这是因为仿真使用的是2007年5月18日12:00:19.609时刻(仿真时刻)的数据来解算星历。根据图2中的迭代方法流程,当预报值与仿真时刻的值之间的误差小于给定参数时,迭代终止并输出结果。因此,通过迭代方法解算的星历与仿真时刻密切相关,且预报误差在仿真时刻时最小。该航天器TLE的初始时刻是 07138.20994918,也即2007年5月18日05:02:19.609,因此,初始时刻和仿真时刻的时间间隔约400分钟(418分钟)。
4.2滤波方法仿真
滤波参数的设置决定了滤波器的性能,因此,首先要仔细设置滤波器的参数。计算EKF测量矩阵的小量设置如下:
[δi δΩ δe δω δM δn δB*]T=[10-7 10-7 10-7 10-7 10-7 10-7 10-7]T
测量噪声参数设置如下:
R=diag(10,10,10)
通过设置过程噪声矩阵来调节滤波过程,避免滤波器发散。同样,我们根据这个原则设置EKF的过程噪声。以一天为预报时长,分别利用STK软件和本文的程序进行轨道预报,将STK预报值作为标准值,通过叠加小量到TLE上,使本文的程序预报值与标准值之间的位置误差约为1m(σ10),基于此,可以估计过程噪声矩阵。初始状态协方差的设置要避免滤波器发散,通过参考过程噪声来设置它。进而,给出过程噪声和初始状态协方差矩阵的值如下:
Q=diag(10-7,10-7,10-7,10-7,10-7,10-10,10-7)
P0=diag(10-7,10-7,10-7,10-7,10-7,10-7,10-7)
UKF的参数设置如下公式所示:
[n α κ β]=[7 0.05 0 1]
特别地,EKF和UKF方法的过程噪声、测量噪声和收敛条件均相同。测量数据也由STK仿真得到,且测量时间间隔设置为1分钟。
根据无测量噪声的导航数据,利用二体轨道预报模型计算滤波的初值,也即航天器星历的初始状态值,如下:
X0=[34.2502 178.4066 0.1855494 103.8038 277.4321 10.830012742 -1.1×10-4]T
然后进行仿真,结果如表4和图7所示。选择轨道倾角、偏心率、平均运动角速度和均方根误差(Root Mean Square Error, RMSE)的绝对误差来显示EKF和UKF的滤波过程,如图8(a)和图8(b)所示。
表4:EKF和UKF方法结果
从表4、图8(a)和图8(b)可以知道,EKF和UKF都能有效解算星历。当测量噪声为10m时,EKF结果中,四个角度的精度至少为10-5度,偏心率精度为10-9,平均运动角速度精度为10-9Rev/Day,大气阻力系数精度为10-7;UKF结果中,四个角度的精度至少为10-5度,偏心率精度为10-7,平均运动角速度精度为10-10Rev/Day,大气阻力系数精度为10-6。
此外,使用滤波方法解算的结果进行轨道预报并与STK值进行比较,结果如图 9(a)和图9(b)所示,位置误差均在5m以内,速度误差均在0.005m/s以内。可以推断,当测量噪声较小时,EKF和UKF的性能都很好,但EKF略优于UKF。
为了说明大噪声对滤波方法的影响,下面叠加噪声到导航数据中然后再进行仿真。类似地,噪声的均值设置为零,而方差分别设置为3σ(σ=10)和10σ。解算结果的绝对误差如图10(a)和图10(b)所示。将解算结果代入SGP4模型进行轨道预报并与STK值相比较,得到的位置和速度预报误差如图11(a)、图11(b)、图11 (c)和图11(d)所示。
可以知道,TLE的绝对误差以及位置和速度预报误差均随着噪声方差的增大而增大。但是在两个仿真算例中,位置预报误差均小于测量噪声的方差,且在大噪声条件下,UKF的性能优于EKF。
对于其他特殊情况,如较大的初始误差,同样进行了数值仿真。通过之前仿真,可以知道初始状态值是由二体模型在导航数据不包含测量噪声条件下计算得到的。在此,对用来计算初始状态的导航数据叠加噪声,然后再利用二体模型计算初始状态,从而进行较大初始误差情况的数值仿真。
测量噪声的均值设置为零,方差分别设置为10σ(σ=10)和100σ,其他参数设置与正常情况一致,仿真结果如表5和表6所示。
表5:大初始误差条件下的EKF和UKF结果(10σ)
表6:大初始误差条件下的EKF和UKF结果(100σ)
从表5和表6中可以看出,在较大初始误差条件下,EKF和UKF仍可以解算得到满足TLE格式精度的航天器星历。
本文研究了基于导航数据的航天器星历自主确定方法。通过建立迭代和滤波方法,实现了单点和多点导航数据情况下的航天器星历解算。对于迭代方法,在没有测量噪声的情况下,3次迭代后开始收敛,9次迭代则能收敛到给定精度。使用迭代方法解算的TLE进行轨道预报,在一天时间内,三个方向上的位置预报误差均在1m 之内,速度预报误差均在10-3m/s之内。但是,迭代方法容易受到测量噪声的影响,且测量噪声越大,绝对误差越大。对于滤波方法,在较小测量噪声条件下,EKF的性能要优于UKF。当测量噪声方差为10m时,EKF和UKF的解算结果,四个角度的精度为10-5度,偏心度精度为10-7,平均运动角速度精度为10-9Rev/Day,大气阻力系数精度为10-6。利用EKF和UKF解算的TLE进行轨道预报,在一天时间内,三个方向上的位置预报误差均在5m以内,速度预报误差均在0.005m/s以内。在某些特殊情况下,如较大初始误差和较大测量噪声,EKF和UKF仍然有效。UKF在大噪声条件下的性能优于EKF,而EKF在较大初始误差下的性能优于UKF。
对于实际应用,可以根据本文设置的仿真情况进行。当导航设备正常工作并可以获得连续有效的导航数据时,可以使用滤波方法或迭代方法解算星历,并根据需要实时更新以预报航天器的飞行状态。但是,迭代方法易受测量噪声的影响,而滤波方法在大噪声和大初始误差情况下仍能有效执行。因此,在正常、大噪声和大初始误差条件下,首先推荐滤波方法。当检测到某些严重的特殊情况,如导航设备出现故障,导航数据不连续,或者大量导航数据不可用时,建议使用迭代方法来解算航天器星历。
本发明的实施例2提供了一种基于导航数据的应急航天器星历确定系统,所述系统包括:数据获取模块和航天器星历计算模块;
数据获取模块,用于从航天器的导航设备获取导航数据,所述导航数据包括:航天器飞行状态矢量;
航天器星历计算模块,用于当导航数据不足,则基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历;否则,基于导航数据使用UKF方法计算得到航天器的星历;所述导航数据不足是指基于导航数据使用UKF方法无法收敛到所设定的精度。
最后所应说明的是,以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,对本发明的技术方案进行修改或者等同替换,都不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (5)
1.一种基于导航数据的应急航天器星历确定方法,所述方法包括:
从航天器的导航设备获取导航数据,所述导航数据包括:航天器飞行状态矢量;
当导航数据不足,则基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历;否则,基于导航数据使用UKF方法计算得到航天器的星历;所述导航数据不足是指基于导航数据使用UKF方法无法收敛到所设定的精度。
2.根据权利要求1所述的基于导航数据的应急航天器星历确定方法,其特征在于,基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历,具体包括:
步骤S1)从导航设备获取航天器当前飞行状态矢量;将其转换到TEMED坐标系得到该坐标系下的飞行状态矢量ρ0=[r0 v0]T,r0为位置矢量,v0为速度矢量;迭代次数的初始值k=1;
步骤S2)根据轨道动力学理论,基于ρk-1计算航天器在第k次迭代下的瞬时轨道根数ik为轨道倾角,Ωk为升交点赤经,ek为偏心率,ωk为近地点角距,Mk为平近点角,nk为平均运动角速度,为大气阻力系数,为常数;
步骤S3)将计算得到的航天器瞬时轨道根数视为TLE并代入SGP4模型进行轨道预报,得到当前迭代步数下的航天器飞行状态矢量ρk=[rk vk]T,rk为位置矢量,vk为速度矢量;
步骤S4)利用误差参数δρ=ρk-ρ0修正航天器的飞行状态,得到ρk+1=ρk+δρ;
步骤S5)若误差参数|δρ|小于给定值;则αk为所求的平均轨道根数α0,即航天器的星历;否则,k加1后转入步骤S2)。
3.根据权利要求1所述的基于导航数据的应急航天器星历确定方法,其特征在于,所述基于导航数据使用UKF方法计算得到航天器的星历,具体包括:
λ=α2(l+κ)-l
其中,ω(i)为权重,λ是缩放比例参数;l代表状态矢量的维数;α代表主要比例因子,该因子可控制选取的sigma点的分布状态,其取值范围是10-3≤α≤1;β代表次要比例因子,β≥0;κ代表三次比例因子,其值为零;
其中,Q为过程噪声协方差阵;
步骤T8)计算得到滤波增益矩阵Kk+1:
其中,Zk+1为第k+1的真实测量值;
4.根据权利要求3所述的基于导航数据的应急航天器星历确定方法,其特征在于,所述获取星历状态初值X0和状态协方差初值P0,具体包括:
设航天器的当前飞行状态矢量为ρ0=[r0 v0]T,r0=[r01 r02 r03]为位置矢量,r01,r02,r03分别为三个方向的位置坐标值;v0=[v01 v02 v03]为速度矢量,v01,v02,v03分别为三个方向的速度值;则动量矩矢量h为:
h=[h1 h2 h3]T=r0×v0
h1,h2,h3为动量矩矢量h三个方向的标量;
动量矩大小h为:
则轨道倾角i为:
偏心率矢量e为:
其中,μ=3.986004356×1014为地球引力常数;e1,e2,e3为偏心率矢量e三个方向的标量;
则偏心率大小e为:
由此计算得到轨道半长轴a:
轨道平均运动角速度n为:
升交点矢量N为:
N=[N1 N2 N3]T=[0 0 1]T×h
其中,N1,N2,N3为升交点矢量N三个方向的标量;
升交点矢量的大小N为:
考虑到升交点赤经Ω的范围为0至360度,所以分两种情况计算,当N2≥0时,
当N2<0时,
近地点角距ω分两种情况,当e3≥0时,
当e3<0时,
当r03≥0时,升交点角距u为:
当r03<0时,升交点角距u为:
则真近点角f为:
f=u-ω
当f<180°时,偏近点角E为:
当f≥180°时,偏近点角E为:
则平近点角M为:
M=E-esin(E)
则星历状态初值X0为:
X0=[i Ω e ω M n B*]T
B*为大气阻力系数,根据经验值给定;
状态协方差初值P0为:
P0=diag([10-7 10-7 10-7 10-7 10-7 10-7 10-7])。
5.一种基于导航数据的应急航天器星历确定系统,其特征在于,所述系统包括:数据获取模块和航天器星历计算模块;
所述数据获取模块,用于从航天器的导航设备获取导航数据,所述导航数据包括:航天器飞行状态矢量;
所述航天器星历计算模块,用于当导航数据不足,则基于导航数据使用航天器星历迭代解算方法计算得到航天器的星历;否则,基于导航数据使用UKF方法计算得到航天器的星历;所述导航数据不足是指基于导航数据使用UKF方法无法收敛到所设定的精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010910094.1A CN114200491A (zh) | 2020-09-02 | 2020-09-02 | 一种基于导航数据的应急航天器星历确定方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010910094.1A CN114200491A (zh) | 2020-09-02 | 2020-09-02 | 一种基于导航数据的应急航天器星历确定方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114200491A true CN114200491A (zh) | 2022-03-18 |
Family
ID=80644470
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010910094.1A Pending CN114200491A (zh) | 2020-09-02 | 2020-09-02 | 一种基于导航数据的应急航天器星历确定方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114200491A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115186521A (zh) * | 2022-09-14 | 2022-10-14 | 中国科学院空天信息创新研究院 | 空间目标轨道根数模拟仿真方法、装置、设备及介质 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109932734A (zh) * | 2019-04-09 | 2019-06-25 | 桂林电子科技大学 | 一种适用于伪卫星位置的计算方法 |
-
2020
- 2020-09-02 CN CN202010910094.1A patent/CN114200491A/zh active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109932734A (zh) * | 2019-04-09 | 2019-06-25 | 桂林电子科技大学 | 一种适用于伪卫星位置的计算方法 |
Non-Patent Citations (1)
Title |
---|
龚秋武: "基于天基导航的应急航天任务智能自主定轨技术", CNKI硕士学位论文, 15 February 2020 (2020-02-15), pages 10 - 49 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115186521A (zh) * | 2022-09-14 | 2022-10-14 | 中国科学院空天信息创新研究院 | 空间目标轨道根数模拟仿真方法、装置、设备及介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Giannitrapani et al. | Comparison of EKF and UKF for spacecraft localization via angle measurements | |
CN103528587A (zh) | 自主组合导航系统 | |
WO1998025156A2 (en) | Autonomous guidance system with position and velocity feedback using modern control theory | |
CN112161632A (zh) | 一种基于相对位置矢量测量的卫星编队初始定位算法 | |
Qin et al. | An innovative navigation scheme of powered descent phase for Mars pinpoint landing | |
CN114200491A (zh) | 一种基于导航数据的应急航天器星历确定方法及系统 | |
US6114995A (en) | Computer-implemented method and apparatus for autonomous position determination using magnetic field data | |
Vetrisano et al. | Navigating to the Moon along low-energy transfers | |
CN115392540A (zh) | 一种用于月球轨道交会制导的快速预报方法 | |
Nateghia et al. | Autoencoder-based thermospheric density estimation using gps tracking data | |
Ananthasayanam | Tuning of the Kalman filter using constant gains | |
Li et al. | A novel fifth‐degree Cubature Kalman filter for real‐time orbit determination by radar | |
Roscoe et al. | Force modeling and state propagation for navigation and maneuver planning for cubesat rendezvous, proximity operations, and docking | |
Leonard et al. | Liaison-supplemented navigation for geosynchronous and lunar l1 orbiters | |
Giordano et al. | Analysis and Optimization of Robust Trajectories in Cislunar Environment with Application to the LUMIO Cubesat | |
Hall et al. | A particle filtering approach to space-based maneuvering satellite location and estimation | |
Hippelheuser | Inertial orbit estimation using multiple space based observers: A new measurement model | |
Olson | Sequential estimation methods for small body optical navigation | |
Nanda et al. | Performance comparison of EKF and UKF for estimation of COE using Kozai mechanism | |
Serra et al. | Computational guidance and navigation for bearings-only rendezvous—methods and outcomes of GUIBEAR | |
McCullough et al. | Accuracy of numerical algorithms for satellite orbit propagation and gravity field determination | |
Kaderali | Detection and Characterisation of Unknown Spacecraft Maneuvers | |
Olson et al. | Precomputing process noise covariance for onboard sequential filters | |
Johnson | Approaches for modeling satellite relative motion | |
Kiani et al. | Spacecraft Attitude and System Identification via Marginal Modified UnscentedKalman Filter Utilizing the Sun and Calibrated Three-Axis-Magnetometer Sensors |
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 |