CN108917764A - 一种双星编队仅测距相对导航方法 - Google Patents
一种双星编队仅测距相对导航方法 Download PDFInfo
- Publication number
- CN108917764A CN108917764A CN201810481185.0A CN201810481185A CN108917764A CN 108917764 A CN108917764 A CN 108917764A CN 201810481185 A CN201810481185 A CN 201810481185A CN 108917764 A CN108917764 A CN 108917764A
- Authority
- CN
- China
- Prior art keywords
- relative
- satellite
- ranging
- double
- navigation
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
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)
- Position Fixing By Use Of Radio Waves (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明一种双星编队仅测距相对导航方法,能够在卫星不进行特殊轨道机动,也不增加星载数据链接收天线的情况下,仅依靠天线接收机的偏离质心安装和姿态机动辅助,就能实现双星编队的自主相对导航。其以双星编队中双星的相对轨道运动方程为导航状态方程进行相对轨道进行演化,以偏离卫星质心安装的星载数据链天线接收机测量的相对距离信息,通过迭代算法求解相对位置和相对速度,完成双星编队仅测距相对导航。通过引入天线接收机偏离卫星质心安装的偏心效应,获得仅测距相对导航解的可观测能力;采用姿态机动辅助提升可观测度,并通过迭代求解方式获得相对位置和速度。
Description
技术领域
本发明属于空间自主相对导航领域,涉及一种双星编队仅测距相对导航方法。
背景技术
随着空间技术的发展和空间环境的日益恶化,空间任务的复杂程度日益提升。以往通过单颗昂贵精密卫星就能完成的任务,因为其代价高、研制周期长、可维护性差、工作寿命限制等问题,很大一部分将逐步被分布式卫星***所取代。
分布式卫星***工作的重要环节之一便是卫星编队飞行,而高精度的相对导航则是编队飞行的关键前提。常用的微波雷达因为其***复杂、造价昂贵、能耗巨大等原因,往往只能在诸如飞船等大型航天器上安装使用;激光雷达同样***复杂、功耗较高,结构和能源方面的限制使得激光雷达难以大量普及使用;光学相机对测量环境要求较高,因为存在目标处于背阴弧段时太暗无法进行可见光成像,目标和相机都处于向阳弧段时强光使得曝光失败导致测量失效的问题,所以光学相机的有效测量弧段相当受限;而采用星载数据链测距导航的方式,不需要增加额外的硬件设备,也不增加额外的能源消耗,利用卫星相互通讯时的副产品“时标信息”测距导航具有独特的优势。而通过“时标信息”测距的测量方式只能获得相对距离信息,缺乏相对方位信息,带来了相对轨道的可观测性问题。
目前国内外解决该问题主要有两类方案:1、轨道机动方案,通过卫星进行特殊轨道机动引入新的距离信息实现定轨,而在相对轨道不明确的情况下实施轨道机动可能会对编队卫星的安全性和燃料消耗产生重要影响。2、双天线方案,该方案卫星平台安装两个天线信号接收器,利用两个接收器的基线获得相对轨道可观测性,而该方案需要额外的硬件设备。因此,现有技术中,双星编队仅测距相对导航,均需要通过卫星平台轨道机动或者需要多个接收机协同测量完成相对导航,不仅操作复杂,安全性不高,而且燃料消耗大,可观测性低。
发明内容
针对现有技术中存在的问题,本发明提供一种双星编队仅测距相对导航方法,设计合理,操作简单,能够在卫星不进行特殊轨道机动,也不增加星载数据链接收天线的情况下,仅依靠天线接收机的偏离质心安装和姿态机动辅助,就能实现双星编队的自主相对导航。
本发明是通过以下技术方案来实现:
一种双星编队仅测距相对导航方法,以双星编队中双星的相对轨道运动方程为导航状态方程进行相对轨道进行演化,以偏离卫星质心安装的星载数据链天线接收机测量的相对距离信息,通过迭代算法求解相对位置和相对速度,完成双星编队仅测距相对导航。
优选的,具体包括如下步骤,
步骤1、建立天线接收机偏离卫星质心安装情况下的相对距离测量模型;
步骤2、通过线性化的Clohessy-Wiltshire相对运动动力学,由状态转移方式,对编队双星之间的相对轨道进行演化;
步骤3、将状态转移方式引入到相对距离测量模型中,得到相对距离测量量与测量时间、初始轨道、天线接收机偏心安装矢量的关系表达式;该关系表达式是以相对距离测量量ρi和对应测量时刻ti为输入,以相对位置和速度x0、y0、z0,和六个量为未知数的非线性方程组;
步骤4、采用修正的牛顿迭代法对m次测量的相对距离测量模型进行迭代求解得到双星相对位置和相对速度,完成双星编队仅测距相对导航。
进一步,步骤1中,建立天线接收机偏离卫星质心安装情况下的相对距离测量模型如下;
其中,ρ(i)为ti时刻由TOA方式测量得到的相对距离,r(i)为ti时刻两卫星之间的相对位置,为ti时刻从卫星本体系c到第二轨道坐标系LVLH的坐标转换矩阵,dc是天线接收机在卫星本体系下的位置矢量。
再进一步,步骤2中,由如下的状态转移方式,对编队双星之间的相对轨道进行演化;
x(i)=Φ(i)x(0) (2)
其中,x(i)是由ti时刻的相对位置r(i)和速度v(i)组成的列向量,Φ(i)是Clohessy-Wiltshire相对运动动力学从t0时刻到ti时刻的状态转移矩阵。
再进一步,步骤3中,将状态转移方式引入到相对距离测量模型中时,将公式(2)带入公式(1)中,得到相对距离测量量与测量时间、初始轨道、天线接收机偏心安装矢量的关系表达式;
其中,系数c1~c9如下:
其中,x0、y0和z0,和分别是初始相对位置r(0)和速度v(0)的三轴分量;dx、dy和dz分别是天线接收机安装矢量dc在第二轨道坐标系(LVLH,Local Vertical LocalHorizontal)下投影的三轴分量。
再进一步,步骤4中所述迭代的算法如下:
其中,
再进一步,采用卫星姿态机动改变天线接收机的指向,改变大小随卫星的姿态而改变的dx、dy和dz,实现多方位测距定轨导航。
与现有技术相比,本发明具有以下有益的技术效果:
本发明通过双星编队中,卫星偏心安装的星载数据链通讯天线接收机和卫星的姿态机动就能实现双星编队飞行的近程解析定轨导航,引入天线接收机偏离卫星质心安装的偏心效应,获得仅测距相对导航解的可观测能力;采用姿态机动辅助提升可观测度,并通过迭代求解方式获得相对位置和速度。具体的以航天器相对轨道运动方程为导航状态方程,以数据链到达时标测量的相对距离信息作为量测量,以姿态机动作为辅助,解析计算出编队双星之间的相对位置和相对速度。
附图说明
图1是本发明方法的测量几何示意图;
图2是本发明方法进行相对轨道确定获得的相对距离估计误差曲线;
图3是本发明方法进行相对轨道确定获得的相对距离估计误差标准差曲线。
具体实施方式
下面结合具体的实施例对本发明做进一步的详细说明,所述是对本发明的解释而不是限定。
本发明一种双星编队仅测距相对导航方法,针对目前实现双星编队的仅距角相对导航方法中,需要通过多个数据链天线协同测量方式或者卫星平台通过特殊轨道机动,来解决仅测距相对导航的状态模糊性问题;提出的方法以姿态机动辅助,通过星载数据链通信天线偏心安装,实现仅测距相对导航,能够适用于对双星编队的近程相对导航。
本发明以双星编队飞行任务为背景,以线性化的相对运动方程进行相对轨道进行演化,以星载数据链偏离卫星质心安装的接收天线TOA(Time of Arrival)仅测距的方式进行相对测量,以卫星姿态机动辅助提高可观测性,通过迭代的方式计算出相对位置和速度,从而实现双星编队飞行的自主相对导航。
具体的,本发明方法主要分成三个部分:
1、如图1所示,建立天线接收机偏离卫星质心安装情况下的相对距离测量模型:
其中,ρi为ti时刻由TOA方式测量得到的相对距离,r(i)为ti时刻两卫星之间的相对位置,为ti时刻从卫星本体系c到第二轨道坐标系(LVLH,Local Vertical LocalHorizontal)的坐标转换矩阵,dc是天线接收机在卫星本体系下的位置矢量。
2、通过线性化的Clohessy-Wiltshire相对运动动力学对编队双星之间的相对轨道进行演化,由如下的状态转移方式进行:
x(i)=Φ(i)x(0) (2)
其中,x(i)是由ti时刻的相对位置r(i)和速度v(i)组成的列向量,Φ(i)是Clohessy-Wiltshire相对运动动力学从t0时刻到ti时刻的状态转移矩阵,如下:
其中,ω是目标轨道角率。
3、将公式(2)带入公式(1)中,得到相对距离测量量与测量时间、初始轨道、天线接收机偏心安装矢量的关系表达式
其中,系数c1~c9如下。
其中,xo、yo和zo,和分别是初始相对位置r(0)和速度v(0)的三轴分量;dx、dy和dz分别是天线接收机安装矢量dc在第二轨道坐标系lvlh下投影的三轴分量,其大小随卫星的姿态改变。
4、如式(3)所示是以相对距离测量量ρi和对应测量时刻ti为输入,以相对位置和速度x0、y0、z0,和六个量为未知数的非线性方程组,那么至少需要6次测量才能求解出这六个未知数。
5、采用修正的牛顿迭代法对m次测量的测量模型(3)进行迭代求解,迭代算法如下:
其中,
同时,为了加快迭代收敛速度、提高相对轨道的可观测性,采用卫星姿态机动在一定程度上改变天线接收机的指向,姿态机动方向只需要改变惯性飞行时数据链TOA测量到的相对距离即可。
本发明方法的实例:结合图2和图3说明本发明的实例验证,设定如下计算条件和技术参数:
1)编队卫星A的轨道半长轴为6795km,偏心率为0.001,轨道倾角为51.65°,近地点幅角为37.39°,升交点赤经为281.65°,真近点角为322.76°;
2)编队卫星B相对于A的初始位置为[0;100;0]m,初始速度为[0;0.00525;0]m/s;
3)初始时刻数据链天线的安装矢量在LVLH系下的投影为[0;0;1]m;
4)数据链TOA测距常值误差为0.01m,噪声均方差0.01m;
5)卫星B绕速度方向轴线做轨道面外往复的正弦姿态运动,幅度为15°,周期为1.5h;
6)Monte Carlo打靶次数200;
基于本发明的相对导航方法与上述设置的计算条件和技术参数,采用Matlab软件进行仿真验证,仿真时间8000s。如图2和图3所示分别是姿态机动/无机动辅助情况下的定轨误差曲线,由图中曲线对比可知,姿态机动条件下定轨精度明显提高。在姿态机动辅助条件下,可以达到米级的相对定轨精度。
因此,采用本发明方法,仅依靠星载通讯数据链偏心安装TOA测距+姿态机动辅助就能实现双星编队的相对导航任务。
Claims (7)
1.一种双星编队仅测距相对导航方法,其特征在于,以双星编队中双星的相对轨道运动方程为导航状态方程进行相对轨道进行演化,以偏离卫星质心安装的星载数据链天线接收机测量的相对距离信息,通过迭代算法求解相对位置和相对速度,完成双星编队仅测距相对导航。
2.根据权利要求1所述的一种双星编队仅测距相对导航方法,其特征在于,具体包括如下步骤,
步骤1、建立天线接收机偏离卫星质心安装情况下的相对距离测量模型;
步骤2、通过线性化的Clohessy-Wiltshire相对运动动力学,由状态转移方式,对编队双星之间的相对轨道进行演化;
步骤3、将状态转移方式引入到相对距离测量模型中,得到相对距离测量量与测量时间、初始轨道、天线接收机偏心安装矢量的关系表达式;该关系表达式是以相对距离测量量ρi和对应测量时刻ti为输入,以相对位置和速度x0、y0、z0,和六个量为未知数的非线性方程组;
步骤4、采用修正的牛顿迭代法对m次测量的相对距离测量模型进行迭代求解得到双星相对位置和相对速度,完成双星编队仅测距相对导航。
3.根据权利要求2所述的一种双星编队仅测距相对导航方法,其特征在于,步骤1中,建立天线接收机偏离卫星质心安装情况下的相对距离测量模型如下;
其中,ρ(i)为ti时刻由TOA方式测量得到的相对距离,r(i)为ti时刻两卫星之间的相对位置,为ti时刻从卫星本体系c到第二轨道坐标系LVLH的坐标转换矩阵,dc是天线接收机在卫星本体系下的位置矢量。
4.根据权利要求3所述的一种双星编队仅测距相对导航方法,其特征在于,步骤2中,由如下的状态转移方式,对编队双星之间的相对轨道进行演化;
x(i)=Φ(i)x(0) (2)
其中,x(i)是由ti时刻的相对位置r(i)和速度v(i)组成的列向量,Φ(i)是Clohessy-Wiltshire相对运动动力学从t0时刻到ti时刻的状态转移矩阵。
5.根据权利要求4所述的一种双星编队仅测距相对导航方法,其特征在于,步骤3中,将状态转移方式引入到相对距离测量模型中时,将公式(2)带入公式(1)中,得到相对距离测量量与测量时间、初始轨道、天线接收机偏心安装矢量的关系表达式;
其中,系数c1~c9如下:
其中,x0、y0和z0,和分别是初始相对位置r(0)和速度v(0)的三轴分量;dx、dy和dz分别是天线接收机安装矢量dc在第二轨道坐标系(LVLH,Local Vertical LocalHorizontal)下投影的三轴分量。
6.根据权利要求5所述的一种双星编队仅测距相对导航方法,其特征在于,步骤4中所述迭代的算法如下:
其中,
7.根据权利要求5所述的一种双星编队仅测距相对导航方法,其特征在于,采用卫星姿态机动改变天线接收机的指向,改变大小随卫星的姿态而改变的dx、dy和dz,实现多方位测距定轨导航。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810481185.0A CN108917764B (zh) | 2018-05-18 | 2018-05-18 | 一种双星编队仅测距相对导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810481185.0A CN108917764B (zh) | 2018-05-18 | 2018-05-18 | 一种双星编队仅测距相对导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108917764A true CN108917764A (zh) | 2018-11-30 |
CN108917764B CN108917764B (zh) | 2020-11-27 |
Family
ID=64402820
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810481185.0A Active CN108917764B (zh) | 2018-05-18 | 2018-05-18 | 一种双星编队仅测距相对导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108917764B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109885087A (zh) * | 2019-03-12 | 2019-06-14 | 中国人民解放军军事科学院国防科技创新研究院 | 微纳卫星的双星近距离编队方法 |
CN110186463A (zh) * | 2019-05-08 | 2019-08-30 | 南京航空航天大学 | 一种基于一致性滤波的航天器集群仅测距相对导航方法 |
CN110954092A (zh) * | 2019-11-28 | 2020-04-03 | 上海航天控制技术研究所 | 基于相对测量信息辅助的协同导航方法 |
CN111924132A (zh) * | 2020-07-23 | 2020-11-13 | 上海卫星工程研究所 | 用于绕飞编队的激光星间链路终端自主接力方法及*** |
CN114396955A (zh) * | 2021-12-29 | 2022-04-26 | 西安电子科技大学 | 量子测距结合星间测角双星定轨方法、***、计算机设备 |
CN114526735A (zh) * | 2022-04-24 | 2022-05-24 | 南京航空航天大学 | 一种无人飞行器集群仅测距初始相对位姿确定方法 |
CN115096317A (zh) * | 2022-06-16 | 2022-09-23 | 中国科学院空间应用工程与技术中心 | 一种地月空间dro航天器编队相对导航方法和*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2546674A1 (en) * | 2011-07-15 | 2013-01-16 | Astrium GmbH | Plarform relative navigation using range measurements |
CN102998687A (zh) * | 2012-11-30 | 2013-03-27 | 北京控制工程研究所 | 一种基于地球卫星和月球卫星联合测距的自主导航方法 |
CN103438888A (zh) * | 2013-07-24 | 2013-12-11 | 西北工业大学 | 一种对空间非合作目标自主交会的相对导航方法 |
CN106154298A (zh) * | 2016-08-12 | 2016-11-23 | 浙江大学 | 基于星间测距增强的卫星编队gps相对导航***和方法 |
CN107883967A (zh) * | 2017-11-07 | 2018-04-06 | 南京航空航天大学 | 一种基于虚拟分布式与混合动力学的相对轨道确定方法 |
-
2018
- 2018-05-18 CN CN201810481185.0A patent/CN108917764B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2546674A1 (en) * | 2011-07-15 | 2013-01-16 | Astrium GmbH | Plarform relative navigation using range measurements |
CN102998687A (zh) * | 2012-11-30 | 2013-03-27 | 北京控制工程研究所 | 一种基于地球卫星和月球卫星联合测距的自主导航方法 |
CN103438888A (zh) * | 2013-07-24 | 2013-12-11 | 西北工业大学 | 一种对空间非合作目标自主交会的相对导航方法 |
CN106154298A (zh) * | 2016-08-12 | 2016-11-23 | 浙江大学 | 基于星间测距增强的卫星编队gps相对导航***和方法 |
CN107883967A (zh) * | 2017-11-07 | 2018-04-06 | 南京航空航天大学 | 一种基于虚拟分布式与混合动力学的相对轨道确定方法 |
Non-Patent Citations (1)
Title |
---|
倪淑燕等: "仅测距信息可用的编队卫星自主相对导航简化无损卡尔曼滤波方法", 《科学技术与工程》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109885087A (zh) * | 2019-03-12 | 2019-06-14 | 中国人民解放军军事科学院国防科技创新研究院 | 微纳卫星的双星近距离编队方法 |
CN110186463A (zh) * | 2019-05-08 | 2019-08-30 | 南京航空航天大学 | 一种基于一致性滤波的航天器集群仅测距相对导航方法 |
CN110954092A (zh) * | 2019-11-28 | 2020-04-03 | 上海航天控制技术研究所 | 基于相对测量信息辅助的协同导航方法 |
CN110954092B (zh) * | 2019-11-28 | 2023-09-15 | 上海航天控制技术研究所 | 基于相对测量信息辅助的协同导航方法 |
CN111924132A (zh) * | 2020-07-23 | 2020-11-13 | 上海卫星工程研究所 | 用于绕飞编队的激光星间链路终端自主接力方法及*** |
CN111924132B (zh) * | 2020-07-23 | 2021-10-26 | 上海卫星工程研究所 | 用于绕飞编队的激光星间链路终端自主接力方法及*** |
CN114396955A (zh) * | 2021-12-29 | 2022-04-26 | 西安电子科技大学 | 量子测距结合星间测角双星定轨方法、***、计算机设备 |
CN114396955B (zh) * | 2021-12-29 | 2024-06-14 | 西安电子科技大学 | 量子测距结合星间测角双星定轨方法、***、计算机设备 |
CN114526735A (zh) * | 2022-04-24 | 2022-05-24 | 南京航空航天大学 | 一种无人飞行器集群仅测距初始相对位姿确定方法 |
CN114526735B (zh) * | 2022-04-24 | 2022-08-05 | 南京航空航天大学 | 一种无人飞行器集群仅测距初始相对位姿确定方法 |
CN115096317A (zh) * | 2022-06-16 | 2022-09-23 | 中国科学院空间应用工程与技术中心 | 一种地月空间dro航天器编队相对导航方法和*** |
Also Published As
Publication number | Publication date |
---|---|
CN108917764B (zh) | 2020-11-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108917764A (zh) | 一种双星编队仅测距相对导航方法 | |
CN103674032B (zh) | 融合脉冲星辐射矢量和计时观测的卫星自主导航***及方法 | |
CN109613583B (zh) | 基于单星与地面站测向及联合测时差的无源目标定位方法 | |
CN108957509A (zh) | 一种双星编队周期相对运动仅测距相对导航解析方法 | |
CN109633724B (zh) | 基于单星与多地面站联合测量的无源目标定位方法 | |
CN107132542B (zh) | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 | |
CN103674034B (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN105737858B (zh) | 一种机载惯导***姿态参数校准方法与装置 | |
CN103256928B (zh) | 一种分布式惯性导航***及其姿态传递对准方法 | |
CN105184002B (zh) | 一种数传天线指向角度的仿真分析方法 | |
KR20130093526A (ko) | 다중 전자기적 신호들로부터 본체의 공간적 방위 정보를 판단 | |
CN111427002B (zh) | 地面测控天线指向卫星的方位角计算方法 | |
CN103389099B (zh) | 基于x射线脉冲星的航天器姿态和位置测量***及方法 | |
CN104374388A (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN104457748A (zh) | 一种嵌入式瞄准吊舱测姿***及其传递对准方法 | |
CN107300700B (zh) | 敏捷合成孔径雷达卫星聚束模式姿态机动需求计算方法 | |
CN102520728B (zh) | 一种采用双天线gps实现可控翼伞精确定点回收的方法 | |
CN108981750A (zh) | X射线脉冲双星光子序列仿真方法 | |
CN108562295A (zh) | 一种基于同步卫星二体模型的三站时差定轨方法 | |
CN106672265B (zh) | 一种基于光流信息的小天体定点着陆制导控制方法 | |
CN110186463A (zh) | 一种基于一致性滤波的航天器集群仅测距相对导航方法 | |
Wang et al. | Absolute navigation for Mars final approach using relative measurements of X-ray pulsars and Mars orbiter | |
Barczyk | Nonlinear state estimation and modeling of a helicopter UAV | |
Li et al. | Fast fine initial self-alignment of INS in erecting process on stationary base | |
CN114063054A (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 |