CN105737834B - 一种基于轨道平根数的相对导航鲁棒滤波方法 - Google Patents
一种基于轨道平根数的相对导航鲁棒滤波方法 Download PDFInfo
- Publication number
- CN105737834B CN105737834B CN201410744882.2A CN201410744882A CN105737834B CN 105737834 B CN105737834 B CN 105737834B CN 201410744882 A CN201410744882 A CN 201410744882A CN 105737834 B CN105737834 B CN 105737834B
- Authority
- CN
- China
- Prior art keywords
- relative
- equation
- star
- mean element
- represent
- 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
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于轨道平根数的相对导航鲁棒滤波方法,包括:步骤1、根据编队卫星相对运动学导出相对导航状态方程,由CDGPS测量星间实时相对位置和速度,经过EKF算法对测量数据进行滤波,得到相对轨道平根数;步骤2、待滤波稳定之后,输出编队构形参数;步骤3、根据相对位置速度和构形参数之间关系,对卫星的相对位置进行预测和递推。
Description
技术领域
本发明涉及一种基于轨道平根数的相对导航鲁棒滤波技术。
背景技术
卫星编队飞行实现对地干涉测量的关键是编队飞行时维持在所需的空间编队构形状态,而编队维持控制依赖于导航、制导与控制(导航、制导与控制,简称为:GNC)系统所确定的编队构形参数,即要实现高精度的星间实时相对导航。目前,星间的相对位置和速度测量一般采用GPS载波相位差分(GPS载波相位差分,简称为:CDGPS)方法实现,但该方法所获取的信息是一个个独立的位置点,并不是编队的构形参数,因此需要高精度、高鲁棒性的相对导航滤波技术。
一般情况下,GNC系统需要根据相对运动学方程和CDGPS的测量信息通过滤波算法得到编队构形参数。但是由于相对运动学和观测量的误差,以及实时测量数据的不稳定,数据长时间无效等方面容易造成滤波发散或者错误,严重时还可能会引起编队控制系统的误喷气操作以及关乎卫星安全的基于星间相对关系的防撞策略失效。本文根据编队运动学和双星近距离编队的特点,提出了基于轨道平根数的相对导航鲁棒滤波方法,该方法能够克服相对导航滤波不稳定和较长时间的测量数据无效情况,确保了卫星编队构形确定的稳定性以及卫星安全。
根据卫星相对运动动力学方程的分量形式:
,其中:
x,y,z分别表示辅星相对主星的三轴位置(编队坐标系下,下同);
,,分别表示辅星相对主星的三轴速度;
,,分别表示辅星相对主星的三轴速度;
为主星的地心位置矢量的模;
,e,f表示主星偏心率和真近点角;
、和分别表示控制加速度在各轴上的分量;
、和分别表示空间其它摄动加速度在各轴上的分量。
基于一些假设可以简化动力学模型,假设如下:
1)假设地球为均质圆球体,而且不考虑其他摄动因素;
2)主星和伴随卫星的轨道偏心率为0或者极小;
伴随卫星到主星的距离远小于它们的轨道半径,不妨假设为几百米到几公里。
对方程可进行线性化处理,有«1(为辅星相对主星的位置矢量),可将地球引力项线性化,并且先不考虑摄动加速度和控制加速度,则方程变为:,有、,进一步线性化,方程可简化为 ,式中,为主星平均轨道角速度,而上式称为C-W方程或Hill方程。
由于C-W方程给出了相对运动与瞬时轨道根数的关系,因而,这种基于瞬时根数的描述方式对初始参数非常敏感,当初始参数稍有偏差,就会造成实际的相对运动与真实值偏差很大,同时瞬时根数具有随时间误差累计明显的特点,因此不利于进行编队卫星的相对导航。
发明内容
现有卫星编队相对导航技术按照滤波算法分类包括最小二乘、多项式差值、EKF、UKF以及粒子滤波等,但是状态方程和滤波输出都是相对位置和相对速度,对相对导航敏感器(如GPS)的数据精度、稳定性依赖性较强,自主递推和抗干扰能力有限。
针对现有技术存在的不足,本发明解决的技术问题是提出一种基于轨道平根数方法,它能够实现近圆非赤道轨道条件下的编队卫星相对鲁棒导航。
为解决上述技术问题,本发明是通过以下的技术方案实现的,其具体包括如下步骤:
(1)采用EKF算法对导航敏感器的测量数据进行滤波;状态变量为相对平均轨道根数:
,其中,,,,,,,而a、e、i、、ω、M表示半长轴、偏心率、轨道倾角、升交点赤经、近地点辐角和平近点角,下标2表示辅星,下标1表示主星。
状态方程为:
,其中有
,,
,
,滤波器的状态变量为相对轨道根数,而测量值为相对位置,测量方程表示两者之间的转换关系,测量方程为:
,滤波计算过程如下:
,其中:Zk表示的是当前时刻的观测量;表示上一时刻的状态估计值;表示状态预测量,g(x)表示根据状态方程的递推算法;h(X)表示的是测量方程,Hk为测量矩阵(测量方程的线性化表示);为状态矩阵;Pk-1表示前一时刻的状态误差协方差阵;Q为系统状态噪声协方差阵;R为测量噪声协方差阵。
(2)建立直接测量两星相对位置、速度与编队构形参数的映射关系,计算编队构形参数。
根据卫星的运动学方程,可以得到速度与相对轨道参数的关系如式:
,,,
结合主星的绝对轨道根数,可以获得编队控制所需的编队构形参数p、s、L、。
(3)在无相对位置信号输入时,根据相对位置速度、和构形参数之间关系,对卫星的相对位置进行预测和递推。
(4)当GPS数据不稳定或长时间无效不可用时,进行基于平根数的编队构形参数递推计算。
首先两星根据拟平均根数法进行轨道递推,获得两星平根数,公式如下所示;
,
然后根据相对轨道根数描述的相对运动方程计算,预测下一时刻卫星的相对位置信息:
, 其中和分别是矢量的大小和相位;和分别是矢量的大小和相位;编队卫星的主星轨道半长轴,为主星的纬度辐角,为主星的轨道倾角。其中,半长轴,偏心率,轨道倾角,近地点辐角,升交点赤经,平近点角(k=1(主星),2(辅星)),分别表示两颗卫星的开普勒轨道根数。为了形成稳定的编队构形,构形参数设计中需要满足,因此可以取。
本发明采用的方法与现有技术相比,其优点和有益效果是:
1、鲁棒性、安全性,这种方法不仅从滤波算法上采用EKF算法保证滤波效果,同时考虑了导航敏感器故障条件下利用基于轨道平根数进行递推获得稳定编队构形参数,这对编队构形控制以及防撞控制具有重要意义;
2、稳定性,单星的绝对轨道根数递推往往采用“常值+长期部分+短期部分”的方式来保证足够的精度,由于编队卫星往往采用近距离编队构形(两星之间的距离≤5km)与轨道半长轴(约7000km)相比是一个很小的量(<0.00072),因此两星的摄动环境是相似的,由摄动引起的短周期部分可以认为相同。这样计算相对轨道根数时只需要求两星“常值+长期部分“差值即可,而两星的“常值+长期部分“在目前国内每天地面上注1次参数条件下可以认为是不随时间累积误差,即使经过长期运行后也可以通过地面注数修正参数的手段保证其精度,这样即简化计算,又能保证导航数据的精度和稳定性;
3、冗余性,实现了基于GPS测量数据(瞬时参数)得到相对轨道根数和星上基于轨道平根数差进行递推得到的相对轨道根数结合,提高了相对导航的冗余性。
4、节省燃料,在编队控制可以接受的误差范围内,由于忽略了短周期项对编队构形的影响,这样就减少了由于短周期项干扰影响而产生的燃料消耗。
附图说明
以下将结合附图和实施例对本发明作进一步说明。
图1为本发明涉及的系统原理图,图2为本发明涉及的技术流程图。
具体实施方式
步骤1根据C-W方程导出相对导航状态方程, 由CDGPS测量的实时相对位置,经过EKF算法,可以得到在有观测量情况下的相对位置和速度;
步骤2待滤波稳定之后,再根据相对位置速度和构形参数之间关系,计算相对轨道根数,输出导航数据:
步骤3:当GPS不能提供稳定的有效数据时,采用拟平根数法,计算轨道平根数,进行星上递推,输出导航数据;
步骤4:当需要长时间采用步骤3的方式进行相对导航时,可以采用地面注数的方式保证其长期精度。
前述公式中需要主星的绝对轨道根数,如果GPS数据有效则采用根据GPS数据计算的轨道根数;如果GPS数据长期无效则采用拟平根数法递推的轨道根数。
补充说明滤波稳定的判据:
取滤波计算得到的相对轨道参数,与前N拍滤波计算得到的相对轨道参数的参考值进行比对,如果误差满足取值范围约束,则认为滤波器已经稳定工作;
1)参考值的计算方法如下:
,
其中:代表状态变量的当前拍计算结果;代表状态变量的前一拍计算结果。
2)取值范围约束:
由于绝对轨道参数有计算误差,该误差会反映到相对轨道参数的计算中,由于绝对轨道参数误差对相对轨道根数的关系复杂,难以得到解析解。因此该取值约束范围需要结合目前我国的实际地面测轨精度与仿真的方法得到。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (4)
1.一种基于轨道平根数的相对导航鲁棒滤波方法,其特征在于,包括:
步骤1、根据编队卫星相对运动学导出相对导航状态方程,由CDGPS测量星间实时相对位置和速度,经过EKF算法对测量数据进行滤波,得到相对轨道平根数;
步骤2、待滤波稳定之后,输出编队构形参数;
所述步骤1包括:
步骤1.1、建立相对平均轨道根数表达式:
其中,,,,,,,而a、e、i、、ω、M表示半长轴、偏心率、轨道倾角、升交点赤经、近地点辐角和平近点角,下标2表示辅星,下标1表示主星;
步骤1.2、相对导航状态方程为:
其中有
,,
,
;
步骤1.3 ,滤波计算过程为:
其中:Xk表示的是当前时刻的两星相对位置;表示上一时刻的状态估计值;表示状态预测量,g(x)表示根据状态方程的递推算法;h(X)表示的是测量方程,Hk为测量矩阵;为状态矩阵;Pk-1表示前一时刻的状态误差协方差阵;Q为系统状态噪声协方差阵;R为测量噪声协方差阵,
测量方程为,,
X=(x,y,z)为两星相对位置。
2.依据权利要求1所述的基于轨道平根数的相对导航鲁棒滤波方法,其特征在于,步骤二包括:根据卫星的运动学方程,得到速度与相对轨道参数的关系如下式:
,,。
3.依据权利要求1所述的基于轨道平根数的相对导航鲁棒滤波方法,其特征在于,还包括:步骤3、 在无相对位置信号输入时,根据相对位置、速度和编队构形参数之间关系,对卫星的相对位置进行预测和递推。
4.依据权利要求1所述的基于轨道平根数的相对导航鲁棒滤波方法,其特征在于,还包括:步骤4、当GPS数据不稳定或长时间无效不可用时,进行基于平根数的编队构形参数递推计算,包括:
步骤4.1、两星根据拟平均根数法进行轨道递推,获得两星平根数,公式如下所示;
;
步骤4.2、根据相对轨道根数描述的相对运动方程计算,预测下一时刻卫星的相对位置信息:
其中和分别是矢量的大小和相位;
和分别是矢量的大小和相位;。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410744882.2A CN105737834B (zh) | 2014-12-09 | 2014-12-09 | 一种基于轨道平根数的相对导航鲁棒滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410744882.2A CN105737834B (zh) | 2014-12-09 | 2014-12-09 | 一种基于轨道平根数的相对导航鲁棒滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105737834A CN105737834A (zh) | 2016-07-06 |
CN105737834B true CN105737834B (zh) | 2018-06-26 |
Family
ID=56237860
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410744882.2A Active CN105737834B (zh) | 2014-12-09 | 2014-12-09 | 一种基于轨道平根数的相对导航鲁棒滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105737834B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106681138B (zh) * | 2016-12-02 | 2019-06-21 | 上海航天控制技术研究所 | 一种编队卫星系统燃料消耗均衡在轨实现方法 |
CN107450578B (zh) * | 2017-07-26 | 2020-06-30 | 中国人民解放军空军工程大学 | 一种绕地球同步轨道卫星分布式共轨飞行的卫星群轨道设计方法 |
CN108490973B (zh) * | 2018-04-19 | 2021-04-13 | 哈尔滨工业大学 | 航天器编队相对轨道确定方法及装置 |
CN110553653B (zh) * | 2019-08-23 | 2021-04-23 | 上海航天控制技术研究所 | 基于多源数据驱动的航天器轨道确定方法 |
CN114529602B (zh) * | 2022-04-24 | 2022-07-05 | 北京开运联合信息技术集团股份有限公司 | 一种空间多目标态势监视方法及装置 |
CN116552817B (zh) * | 2023-07-12 | 2023-09-08 | 银河航天(北京)网络技术有限公司 | 优化卫星轨道控制的方法、设备和存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102878995A (zh) * | 2012-10-24 | 2013-01-16 | 北京控制工程研究所 | 一种静止轨道卫星自主导航方法 |
CN103453906A (zh) * | 2013-08-09 | 2013-12-18 | 清华大学 | 卫星轨道的预测方法 |
CN104048664A (zh) * | 2014-07-01 | 2014-09-17 | 南京航空航天大学 | 一种导航卫星星座自主定轨的方法 |
-
2014
- 2014-12-09 CN CN201410744882.2A patent/CN105737834B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102878995A (zh) * | 2012-10-24 | 2013-01-16 | 北京控制工程研究所 | 一种静止轨道卫星自主导航方法 |
CN103453906A (zh) * | 2013-08-09 | 2013-12-18 | 清华大学 | 卫星轨道的预测方法 |
CN104048664A (zh) * | 2014-07-01 | 2014-09-17 | 南京航空航天大学 | 一种导航卫星星座自主定轨的方法 |
Non-Patent Citations (2)
Title |
---|
分布式卫星编队构形控制研究;郝继刚;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20071115(第5期);正文第99-100,128-129页 * |
基于滤波算法的拟平均轨道根数自主实时确定方法;孙兆伟等;《宇航学报》;20130930;第34 卷(第9期);第1231-1238页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105737834A (zh) | 2016-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105737834B (zh) | 一种基于轨道平根数的相对导航鲁棒滤波方法 | |
CN102692225B (zh) | 一种用于低成本小型无人机的姿态航向参考系统 | |
Rhudy et al. | Evaluation of matrix square root operations for UKF within a UAV GPS/INS sensor fusion application | |
US10101174B2 (en) | Air data aided inertial measurement unit | |
CN102175260B (zh) | 一种自主导航系统误差校正方法 | |
Hiliuta et al. | Fuzzy corrections in a GPS/INS hybrid navigation system | |
EP2578995B1 (en) | Modified Kalman filter for generation of attitude error corrections | |
Hajiyev et al. | Robust estimation of UAV dynamics in the presence of measurement faults | |
Xu et al. | A reliable hybrid positioning methodology for land vehicles using low-cost sensors | |
RU2380656C1 (ru) | Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах | |
EP3527948B1 (en) | Air data aided inertial measurement unit | |
CN111189442B (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN103148849A (zh) | 基于地月卫星联合测距和紫外敏感器的组合导航方法 | |
Lei et al. | An adaptive navigation method for a small unmanned aerial rotorcraft under complex environment | |
RU2382988C1 (ru) | Бесплатформенная инерциальная система ориентации на "грубых" чувствительных элементах | |
CN103344245A (zh) | 火星进入段imu和甚高频无线电组合导航的ud-skf方法 | |
de Celis et al. | Attitude determination algorithms through accelerometers, GNSS sensors, and gravity vector estimator | |
Emran et al. | Hybrid low-cost approach for quadrotor attitude estimation | |
Emran et al. | A cascaded approach for quadrotor's attitude estimation | |
Valizadeh et al. | Improvement of navigation accuracy using tightly coupled kalman filter | |
Edwan et al. | A new loosely coupled DCM based GPS/INS integration method | |
Lu et al. | Analytic coarse alignment and calibration for inertial navigation system on swaying base assisted by star sensor | |
Wang et al. | Attitude estimation for UAV with low-cost IMU/ADS based on adaptive-gain complementary filter | |
CN115420280A (zh) | 一种航天器脉冲星/星光折射组合导航方法 | |
de Celis et al. | An estimator for UAV attitude determination based on accelerometers, GNSS sensors, and aerodynamic coefficients |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |