CN111102981B - 一种基于ukf的高精度卫星相对导航方法 - Google Patents
一种基于ukf的高精度卫星相对导航方法 Download PDFInfo
- Publication number
- CN111102981B CN111102981B CN201911248427.2A CN201911248427A CN111102981B CN 111102981 B CN111102981 B CN 111102981B CN 201911248427 A CN201911248427 A CN 201911248427A CN 111102981 B CN111102981 B CN 111102981B
- Authority
- CN
- China
- Prior art keywords
- satellite
- observation
- relative
- target
- ukf
- 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
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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Analysis (AREA)
- Data Mining & Analysis (AREA)
- Automation & Control Theory (AREA)
- Pure & Applied Mathematics (AREA)
- Algebra (AREA)
- Astronomy & Astrophysics (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Computing Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种基于UKF的高精度卫星相对导航方法,首先确定跟踪目标,由观测卫星搭载的CCD相机和激光测距仪对目标星进行组合观测,建立基于相对位置矢量观测的系统模型,然后实时计算系统能观度,根据能观度在线调整UKF算法的一步预测计算,从而实现对目标星的定位导航。本发明通过改进UKF方法对空间非合作目标进行相对导航,显著提高了相对导航精度,增强了系统鲁棒性,另外,在不显著增大计算量和占用星载计算机资源的前提下,缩短了滤波收敛时间,减少了系统复杂度,降低了成本。
Description
技术领域
本发明应用于非合作目标卫星观测和导航技术领域,涉及一种基于UKF的高精度卫星相对导航方法。
背景技术
随着各国航天活动的蓬勃发展,近年来航天任务对卫星的识别、观测、导航需求不断提高,空间非合作目标的精确导航,尤其是高精度相对导航技术成为相关任务卫星需具备的核心和基础能力之一。
空间非合作目标是指没有安装通讯应答设备或者主动标识传感器的空间目标,其他航天器无法通过通讯信号反馈对其进行识别和定位定姿。在卫星相对导航领域,指无法主动与观测卫星进行通信,且没有安装用于视觉测量的合作光标的卫星。
目前的星间相对导航技术有多种实现方式。对于绕飞跟踪和空间交会对接等近距离观测任务,一般采用CCD相机在轨对目标星进行连续成像,通过特征点识别和图像处理等手段解算出目标星在以观测星为基准的坐标系中的相对位置和姿态。对于中远距离目标观测任务,现有的相对导航方法包括:基于差分GPS的方法、雷达通信法、双视线角测量法、单视线角结合轨道机动法和视线角结合测距法。
其中,基于差分GPS的方法要求两个卫星均配备GPS模块且可相互通信,这种方法仅适用于编队卫星等合作目标,不适用于非合作目标的观测;雷达通信法通过在目标星和观测星上安装的依法多收雷达进行测角和测距,从而解算目标星相对位置;
双视线角测量法采用两个观测卫星同时对目标卫星进行观测,通过一个已知基线和两个视线角测量向量解算实现相对导航,此种方法需要两个观测卫星同时工作,成本较高且风险大;
单视线角结合轨道机动的方法需要观测卫星在抵近目标过程中进行一定的机动变轨,燃料消耗大,卫星无法实现长期在轨工作;视线角结合测距法一般应用于中远距离观测,通过敏感器测量得到相对距离,进而采用滤波方法得到三维相对位置。
现有文献大多采用联邦滤波(FKF),扩展卡尔曼滤波(EKF)或无迹卡尔曼滤波(UKF)等算法。其中FKF对测量数据的容错率较高,但是由于采用了分散式滤波方法,单独滤波器的收敛速度较慢;EKF步骤简单易行,但其线性化误差较大,估计误差相对较大,无法满足高精度相对导航需求;UKF的精度高于EKF,但其收敛性容易受初始误差影响,且定位精度会在系统能观性较差时下降。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出一种基于UKF的改进算法并将其应用于高精度卫星相对导航,可以实时、快速、准确的对非合作目标进行高精度位置评估,以满足在轨抵近交会和观测的需求。
本发明解决技术的方案是:
一种基于UKF的高精度卫星相对导航方法,该方法的步骤包括:
(1)由观测卫星导航制导控制分系统给出先验信息,然后星载计算机根据CCD相机光轴在惯性空间的指向,选定初始搜索区域,规划搜索路径,通过星载光电转台和CCD相机扫描成像,捕获目标卫星;确认目标卫星后,根据目标点距视场中心的偏移计算出脱靶量数据并控制光电转台进行闭环跟踪;
(2)探测到目标星并开始跟踪过程中,激光测距仪开机工作,为观测卫星提供目标星的距离信息,计算相对距离rot;
(4)根据已得到的距离信息与角位置信息,建立相对导航系统的状态模型和观测模型,模拟噪声特性,通过改进UKF算法解算目标星相对于观测星的三维位置和速度信息。
进一步的,步骤(4)中,相对导航系统的状态模型为:
其中:x,y,z为两卫星的相对位置矢量在So的轨道坐标系中的三维坐标,f(x)为状态函数,ro和ω分别为卫星So的地心距和角速度,μ为地球引力常数,w=[0 0 0 fx fy fz]T为系统噪声,fx,fy,fz为两卫星So和St除地球中心引力外的其他作用力的合力加速度在So轨道坐标系中的三轴分量。
进一步的,步骤(4)中相对导航系统的观测模型为:
进一步的,UKF算法改进方法为:
利用一种基于系统状态估计值的能观度表征方法计算双星相对导航系统的能观度,定义k时刻系统的状态估计误差为考虑在一步状态预测上加一个微小的误差增量用上标*表示加入误差增量后的状态量,有则加入误差增量后状态估计误差的变化量为
将k-1时刻系统能观度定义为
其中:I为单位矩阵,||·||F为矩阵的Frobenius范数;
定义一个能观度相关的缩放参数ρk-1为
其中:γ为大于0的常数,e为自然对数;
然后依据将k-1时刻的缩放参数ρk-1对标准UKF算法进行改进,将一步预测均方误差阵的计算修正为
从而得到了改进的UKF算法,根据当前系统能观度大小进行在线自适应调节,以提高位置估计的精度和鲁棒性。
本发明与现有技术相比的有益效果是:
(1)本发明通过改进UKF滤波方法,对空间非合作目标进行相对导航,提高了相对导航精度,增强了系统鲁棒性;
(2)本发明在不显著增大计算量和占用星载计算机资源的前提下,缩短了滤波收敛时间,减少了系统复杂度,降低了成本;
(3)本发明可靠性高,可准确快速地完成相对导航滤波解算过程。
附图说明
图1为本发明的两个卫星相对测量关系示意图;
图2为观测卫星与目标卫星相对运动关系示意图;
图3为观测卫星与目标卫星相对位置误差;
图4为观测卫星与目标卫星相对速度误差;
图5为本发明导航方法流程图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
本发明主要技术方案为:
(1)星载计算机根据先验信息规划搜索路径,通过CCD相机扫描成像,捕获目标卫星,进行闭环跟踪;
(2)探测到目标星并开始跟踪过程中,激光测距仪开机工作,为观测卫星提供目标的距离信息,计算相对距离rot;根据CCD相机图像计算得到目标星相对观测星的角位置;
(3)根据距离信息与角位置信息,建立相对导航的状态模型和观测模型,模拟噪声特性,实时计算系统能观度,通过改进UKF算法解算目标星相对于观测星的三维位置与速度。
本发明的相对导航方法具体包括如下步骤,如图5所示:
(1)捕获观测目标
由观测卫星GNC分系统给出先验信息,然后星载计算机根据CCD相机光轴在惯性空间的指向,选定初始搜索区域,规划搜索路径,通过星载光电转台和CCD相机扫描成像,捕获目标卫星;确认目标卫星后,根据目标点距视场中心的偏移计算出脱靶量数据并控制光电转台进行闭环跟踪;
(2)进行相对测量
探测到目标星并开始跟踪过程中,激光测距仪开机工作,为观测卫星提供目标的距离信息,计算相对距离rot;根据CCD相机图像,目标星在图像中的坐标位置结合相机分辨率与焦距得到目标星相对观测星的角位置,方位角与俯仰角θ;
(3)建立相对导航的状态模型和观测模型
如图1所示,O为地心,So为观测卫星,ro为其地心距矢量,St为目标星,St相对So的位置矢量为rot,设两卫星相对速度矢量为vot,相对加速度矢量为aot,上述矢量在So的轨道坐标系中的坐标分别设为:
其中:f(x)为状态函数,ro和ω分别为卫星So的地心距和角速度,可由So的瞬时轨道根数解算得到,是已知量;μ为地球引力常数;[fx fy fz]T为两卫星So和St除地球中心引力外的其他作用力的合力加速度在So轨道坐标系中的三轴分量。w=[0 0 0 fx fy fz]T为系统噪声,在滤波算法中一般认为其为零均值白噪声。
其中:h(x)为观测函数,v为观测噪声,在滤波算法中一般认为其为零均值白噪声。
(4)改进UKF算法
将系统状态方程和观测方程进行离散化,得到
改进UKF的具体运算过程如下:
1)选定滤波初值
其中:x0为初始状态向量。
2)计算k-1时刻的2n+1个sigma采样点
3)计算k时刻的一步预测模型值
其中:
4)计算k时刻的一步预测样本点
观测量的sigma采样点为
观测量一步预测均值与其协方差矩阵为
状态量与观测量的协方差矩阵为
5)计算增益矩阵
6)系统状态更新和协方差更新
7)能观度修正
k-1时刻的系统能观度定义为
其中:I为单位矩阵,||·||F为矩阵的Frobenius范数。
定义一个能观度相关的缩放参数ρk-1为
其中:γ为大于0的常数,e为自然对数。
然后依据将k-1时刻的缩放参数ρk-1对标准UKF算法进行改进,将一步预测均方误差阵的计算修正为
8)开始新的滤波,重复上述步骤。
(5)解算目标星相对于观测星的三维位置
根据测量到的星间相对位置矢量,用改进的UKF算法对相对导航系统进行滤波估计,可以解算出目标卫星的相对于观测卫星的三维位置和速度。
下面以一个双星相对导航解算实例来说明本发明提出方法的实施过程与优势。
针对空间非合作目标的相对导航应用场景,选取目标星St为地球同步轨道卫星,其轨道周期与地球自转周期相同,观测星So轨道为0倾角的圆轨道,轨道半长轴比目标星小20km,St在So的轨道坐标系中的相对俯仰角、方位角与两星相对距离如图2所示,应用本发明的方法的实际算例中,选取的两个卫星在抵近时段5min内的相对运动轨迹。相对距离从20km增长至180km,俯仰角由40°减少至5°,方位角由90°减少至5°。
设wk和vk为零均值的高斯白噪声序列,且互不相关,对应的噪声协方差矩阵为其中:σv=10-8km/s,σm=10-5km。仿真时间为300s,采样周期为50ms。采用蒙特卡洛(Monte Carlo)方法对以上相对导航系统进行500次独立仿真,改进UKF算法的滤波结果如图3与图4所示。图3为使用改进UKF算法对目标卫星相对于观测卫星的位置进行估计,并与真实值进行比较,得到的三轴相对位置误差。图4为与真实值进行比较,得到的三轴相对速度误差。
在同等仿真条件下,传统EKF的收敛时间为158s,位置误差精度为3.2m,速度误差精度为0.0049m/s;UKF的收敛时间为139s,位置误差精度为0.5m,速度误差精度为0.0009m/s;本发明提出的改进UKF的收敛时间为103s,位置误差精度为0.3m,速度误差精度为0.0004m/s。
由上述算例可得,本方法收敛速度更快,估计精度比传统方法有显著提升,且根据系统能观度进行实时调整,可靠性强,可以更好的适用于空间非合作目标导航实际系统中。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (3)
1.一种基于UKF的高精度卫星相对导航方法,其特征在于,该方法的步骤包括:
(1)由观测卫星导航制导控制分系统给出先验信息,然后星载计算机根据CCD相机光轴在惯性空间的指向,选定初始搜索区域,规划搜索路径,通过星载光电转台和CCD相机扫描成像,捕获目标卫星;确认目标卫星后,根据目标点距视场中心的偏移计算出脱靶量数据并控制光电转台进行闭环跟踪;
(2)探测到目标星并开始跟踪过程中,激光测距仪开机工作,为观测卫星提供目标星的距离信息,计算相对距离rot;
(4)根据已得到的距离信息与角位置信息,建立相对导航系统的状态模型和观测模型,模拟噪声特性,通过改进UKF算法解算目标星相对于观测星的三维位置和速度信息;
步骤(4)中,相对导航系统的状态模型为:
其中:x,y,z为两卫星的相对位置矢量在So的轨道坐标系中的三维坐标,f(x)为状态函数,ro和ω分别为卫星So的地心距和角速度,μ为地球引力常数,w=[0 0 0 fx fy fz]T为系统噪声,fx,fy,fz为两卫星So和St除地球中心引力外的其他作用力的合力加速度在So轨道坐标系中的三轴分量。
3.根据权利要求1所述的一种基于UKF的高精度卫星相对导航方法,其特征在于:
UKF算法改进方法为:
利用一种基于系统状态估计值的能观度表征方法计算双星相对导航系统的能观度,定义k时刻系统的状态估计误差为考虑在一步状态预测上加一个微小的误差增量用上标*表示加入误差增量后的状态量,有则加入误差增量后状态估计误差的变化量为
将k-1时刻系统能观度定义为
其中:I为单位矩阵,||·||F为矩阵的Frobenius范数;
定义一个能观度相关的缩放参数ρk-1为
其中:γ为大于0的常数,e为自然对数;
然后依据将k-1时刻的缩放参数ρk-1对标准UKF算法进行改进,将一步预测均方误差阵的计算修正为
从而得到了改进的UKF算法,根据当前系统能观度大小进行在线自适应调节,以提高位置估计的精度和鲁棒性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911248427.2A CN111102981B (zh) | 2019-12-09 | 2019-12-09 | 一种基于ukf的高精度卫星相对导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911248427.2A CN111102981B (zh) | 2019-12-09 | 2019-12-09 | 一种基于ukf的高精度卫星相对导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111102981A CN111102981A (zh) | 2020-05-05 |
CN111102981B true CN111102981B (zh) | 2022-03-04 |
Family
ID=70422156
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911248427.2A Active CN111102981B (zh) | 2019-12-09 | 2019-12-09 | 一种基于ukf的高精度卫星相对导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111102981B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112113557B (zh) * | 2020-07-29 | 2023-05-02 | 中国人民解放军军事科学院国防科技创新研究院 | 一种基于插值法的多无人机相对定位预测方法及装置 |
CN114383619B (zh) * | 2021-12-07 | 2023-09-05 | 上海航天控制技术研究所 | 一种高精度轨道计算方法 |
CN115326061B (zh) * | 2022-10-17 | 2023-01-17 | 中国人民解放军国防科技大学 | 一种基于已编目空间目标序贯观测的自主导航方法 |
CN116105694B (zh) * | 2022-12-09 | 2024-03-12 | 中国科学院上海技术物理研究所 | 一种多手段光学载荷复合的空间目标三维视觉测量方法 |
CN115792796B (zh) * | 2023-02-13 | 2023-06-06 | 鹏城实验室 | 基于相对观测等效模型的协同定位方法、装置及终端 |
CN117008498B (zh) * | 2023-08-02 | 2024-10-18 | 南京理工大学 | 用于多星智能协作控制的地面半物理仿真平台系统及方法 |
CN117570989B (zh) * | 2023-11-21 | 2024-08-09 | 苏州星幕航天科技有限公司 | 一种惯性坐标系准pi型zem制导闭环状态幅值解析计算方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2390730C1 (ru) * | 2009-04-06 | 2010-05-27 | Сергей Васильевич Стрельников | Способ эфемеридного обеспечения процесса управления космическими аппаратами глобальной навигационной спутниковой системы |
CN103438888A (zh) * | 2013-07-24 | 2013-12-11 | 西北工业大学 | 一种对空间非合作目标自主交会的相对导航方法 |
CN104316060B (zh) * | 2014-06-06 | 2018-09-11 | 清华大学深圳研究生院 | 空间非合作目标的交会对接方法与装置 |
CN108692729B (zh) * | 2018-05-04 | 2019-05-24 | 北京空间飞行器总体设计部 | 一种空间非合作目标相对导航协方差自适应修正滤波方法 |
CN109141368B (zh) * | 2018-07-19 | 2020-08-14 | 北京空间机电研究所 | 一种高定位精度星载成像系统及方法 |
-
2019
- 2019-12-09 CN CN201911248427.2A patent/CN111102981B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111102981A (zh) | 2020-05-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111102981B (zh) | 一种基于ukf的高精度卫星相对导航方法 | |
Trebi-Ollennu et al. | Design and analysis of a sun sensor for planetary rover absolute heading detection | |
CN109709537B (zh) | 一种基于卫星编队的非合作目标位置速度跟踪方法 | |
CN106595674B (zh) | 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法 | |
CN103852082B (zh) | 一种星间测量和陀螺的姿态轨道一体化滤波估计方法 | |
CN103900576B (zh) | 一种深空探测自主导航的信息融合方法 | |
CN101762273A (zh) | 一种深空探测器软着陆自主光学导航方法 | |
CN105698762A (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
CN107132542B (zh) | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 | |
CN105184002B (zh) | 一种数传天线指向角度的仿真分析方法 | |
Ely et al. | Altair navigation during translunar cruise, lunar orbit, descent, and landing | |
CN108663052B (zh) | 一种星上自主空间非合作目标相对导航相机指向控制方法 | |
Theil et al. | ATON (Autonomous Terrain-based Optical Navigation) for exploration missions: recent flight test results | |
CN109284904A (zh) | 用于成像任务有效规划的云层窗口自主感知决策方法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN112319857B (zh) | 一种用于远距离分布式卫星的组合姿态控制方法及系统 | |
Smith et al. | Operational constraint analysis of terrain relative navigation for landing applications | |
CN110146092B (zh) | 基于导航信息评价的双体小行星探测轨迹优化方法 | |
CN109186614B (zh) | 一种航天器间近距离自主相对导航方法 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
CN115388890A (zh) | 基于视觉的多无人机协同对地目标定位方法 | |
CN117630983A (zh) | 一种基于层次化任务分解的多载荷组网卫星目标跟踪方法 | |
Cao et al. | Dynamic lever arm compensation of SINS/GPS integrated system for aerial mapping | |
CN114435630B (zh) | 一种利用有限次视线测量对非合作目标进行相对定轨的方法 | |
WO2024015661A1 (en) | Onboard geolocation for images |
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 |