CN114537712B - 一种利用仅测角估计非合作机动目标机动量的方法 - Google Patents
一种利用仅测角估计非合作机动目标机动量的方法 Download PDFInfo
- Publication number
- CN114537712B CN114537712B CN202210114579.9A CN202210114579A CN114537712B CN 114537712 B CN114537712 B CN 114537712B CN 202210114579 A CN202210114579 A CN 202210114579A CN 114537712 B CN114537712 B CN 114537712B
- Authority
- CN
- China
- Prior art keywords
- target
- cooperative
- coordinate system
- virtual
- sight
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/242—Orbits and trajectories
-
- 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/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/13—Differential equations
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Remote Sensing (AREA)
- Theoretical Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Combustion & Propulsion (AREA)
- Operations Research (AREA)
- Algebra (AREA)
- Chemical & Material Sciences (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种利用仅测角估计非合作机动目标机动量的方法,属于航天器导航制导与控制技术领域。首先构建了基于该绝对轨道信息构建虚拟坐标系,作为分析非合作目标相对运动的新基准;然后在此基准上重新描述非合作目标交会过程和视线测量信息,建立非合作目标相对运动状态;最后构建目标机动脉冲、追踪星机动脉冲以及视线信息之间的关联模型,实现利用有限次视线信息对非合作目标机动脉冲的直接求解。该方法仅需最少5次的有限次视线测量,就能够对非合作机动目标的未知机动进性较为精准的估计,不需要观测相机的连续开机观测,由此可以大幅减少相机的开机时间,降低了相机的工作难度;解决了非合作目标导航当中的目标未知机动估计的问题。
Description
技术领域
本发明涉及航天器导航制导与控制技术、航天器轨道动力学技术,具体为一种利用仅测角估计非合作机动目标机动量的方法。
背景技术
非合作目标指运动状态未知的、机动不配合的、目标特性未知的、与主动的追踪航天器之间没有信息沟通的航天器。由于非合作目标的这些特点,非合作目标的交会对接任务无法采用常规的导航方法确定非合作目标的轨迹及其运动状态。此外,非合作目标的交会对接任务中,主动的追踪航天器与非合作目标之间的相对距离往往较远,导致追踪航天器难以通过测量获取相对距离信息,仅能获取相对视线信息。
因此,在非合作目标交会任务中,往往采用仅测角的导航方法,包括基于测量相机偏置的仅测角导航方法、基于追踪器轨道机动的仅测角导航方法等等。然而,这些方法往往假设在追踪器对非合作目标进行导航确定的过程当中,非合作目标绕地球自由飞行,不进行任何未知的、主动的机动。但实际上,由于非合作目标机动不配合的特性,非合作目标的未知机动对导航精度有较大的影响,因此在导航过程中目标的未知机动是不能忽略的。
对于目标机动的估计,可以利用地面测量信息进行分析,但这样处理需要确保一定的测控弧段(测控时间),且一般需要在飞行1-2轨后才可以得到较为准确的结果,因此这种测量模式不但存在明显的滞后性,而且需要调动多个地面测站连续接力测量,需要对测量数据进行滤波估计等处理,还可能无法将机动信息及时反馈给追踪飞行器,出现时间滞后、耗费地面测控能力、信息反馈不及时等等缺点。
对比而言,交会过程中较为可靠的是追踪飞行器的仅测角信息,如果仅仅利用这个侧角信息即可估计目标机动,则无疑具有耗费测控能力低、自主及时的有点。
目前针对非合作机动目标的仅测角未知机动估计问题没有相关研究,非常值得进行技术探讨。
发明内容
要解决的技术问题
在对非合作目标进行相对导航的过程当中,非合作目标的未知机动对导航精度有较大的影响,因此非合作目标的未知机动是不能忽略的。然而目前针对非合作机动目标的仅测角未知机动估计问题没有相关研究。因此,设计了一种针对近地近圆轨道、基于追踪器轨道机动、仅利用有限次视线测量、对非合作机动目标进行未知机动量估计的方法,实现了只利用5次视线测量,就能够对非合作目标的机动量进行较准确的估计。该方法针对追踪器与非合作目标在相对距离较远(百公里量级)交会的情况也能适用。
技术方案
本发明充分利用了含有未知误差的非合作目标初始绝对轨道(含有绝对位置、绝对速度)测量数据,首先构建了基于该绝对轨道信息构建虚拟坐标系,作为分析非合作目标相对运动的新基准;然后在此基准上重新描述非合作目标交会过程和视线测量信息,建立非合作目标相对运动状态;最后构建目标机动脉冲、追踪星机动脉冲以及视线信息之间的关联模型,实现利用有限次视线信息对非合作目标机动脉冲的直接求解。
一种利用仅测角估计非合作机动目标机动量估计的方法,其特征在于步骤如下:
步骤1:建立虚拟坐标系
假设追踪器C在t0、t1、…、tn这n+1个时刻对非合作目标T进行了最少5次视线测量,n≥4,并且追踪器C在tC时刻施加了脉冲;其中,脉冲时刻tC需要满足t0<tC<tn,/>表示追踪器C相对于地心惯性系施加的脉冲量;
在初始时刻t0,追踪器C通过地面提供的信息对非合作目标T在地心惯性系下的初始状态进行了粗略的估计,鉴于地面测量有误差,该初始状态肯定与非合作目标T的真实位置不重合,但在该真实位置附近;假设有一个虚拟的目标航天器V绕地球自由飞行,其初始位置和速度就是这个初始状态,记为与/>令x、y、z、vx、vy、vz分别表示地心惯性系下三维位置分量和速度分量,则位置矢量和速度矢量分别为/>根据二体动力学模型,可以建立以x、y、z、vx、vy、vz为自变量的微分方程:
利用龙格库塔积分算法可以计算不同时刻自变量的数值;令时间步长为h,tk+1、tk分别表示时刻,二者满足tk+1=tk+h,为简单起见,用uk+1、uk分别表示u(tk+1),u(tk),这里u代表变量x、y、z、vx、vy、vz,采用龙格库塔积分的具体方法如下:
其中:
显然,通过迭代计算,可以获取不同时刻x、y、z、vx、vy、vz的数值,即不同时刻的数据;相当于利用积分能够由/>与/>计算得到t1、…、tn时刻这个虚拟的目标航天器V在地心惯性系下的运动状态/>与/> 其中μ代表地球引力常数,Re代表地球平均半径,J2代表地球非球形引力摄动的第二项系数;以该虚拟目标V为坐标原点,建立一个虚拟的LVLH轨道坐标系,称为虚拟坐标系,tm时刻该虚拟坐标系沿地心惯性系x、y、z三轴方向的单位方向矢量i(tm)、j(tm)、k(tm)分别满足下式,0≤m≤n;
步骤2:建立虚拟坐标系中的相对运动模型
在虚拟坐标系下,假设非合作目标T、虚拟目标V与追踪器C之间的彼此相对距离远小于虚拟目标V与地心之间的距离,并且假设三个飞行器绕地飞行的轨道为圆或近圆轨道,那么可以根据二体动力学模型(1)导出如下的动力学方程,描述非合作目标T或追踪器C在虚拟坐标系下相对于虚拟目标V的运动情况:
其中,rLVLH(tm)代表tm时刻非合作目标T或者追踪器C在虚拟坐标系下相对于虚拟目标V的位置,0≤m≤n,vLVLH(tm)则代表相对于虚拟目标V的速度;矩阵φrr(t)、φrv(t)、φvr(t)与φvv(t)分别满足:
其中ω代表虚拟目标V绕地球绕飞的旋转角速度:
步骤3:建立虚拟坐标系中的相对视线测量量
相对视线测量量是相机提供的目标视线角度值,或者根据角度信息对应的视线单位向量;
假设追踪器C在tm时刻对非合作目标T进行视线测量,0≤m≤n,得到了tm时刻本体坐标系下的视线仰角α(tm)与视线偏角β(tm)的测量值,由此得到tm时刻在本体坐标系下沿视线方向,即由追踪器C指向目标T方向的单位视线矢量ξb(tm):
ξb(tm)=[cosα(tm)·cosβ(tm) cosα(tm)·sinβ(tm) sinα(tm)]T (13)
步骤4:非合作机动目标脉冲机动量的估计
这里O3×(n+1)代表3×(n+1(的全零矩阵,E3代表3阶单位矩阵;其中,矩阵A满足:
A=[A1 A2 AT] (16)
这里O3×1代表3×1的全零矩阵;而列向量b满足:
其中,式(19)与(20)当中的矩阵δrv满足:
有益效果
本发明针对非合作机动目标的未知机动量估计的问题,提出了一种仅利用有限次(最少5次)视线测量,就能够对非合作机动目标的未知机动量进行估计的方法,解决了非合作目标导航当中的目标未知机动估计的问题。
具有以下四个有益效果:
1、该方法仅需最少5次的有限次视线测量,就能够对非合作机动目标的未知机动进性较为精准的估计,不需要观测相机的连续开机观测,由此可以大幅减少相机的开机时间,降低了相机的工作难度;相对于地面测站而言,只需要利用相机即可完成对目标机动量的估计,所需要支撑的人力、物理资源明显大幅下降,测量效费比大大提升。
2、该方法避免了复杂的滤波计算,相对于地面测站的工作模式,大大降低了运算量,特别适合星载导航计算;
3、该方法在追踪器与非合作机动目标之间的相对距离较远的情况下,仍可以适用;
4、该方法解决了目前无法仅通过视线测量估计非合作目标未知机动的问题,属于技术首创。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1非合作目标相对定轨误差分布打靶仿真结果图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图和实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。此外,下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
实施例1
实施过程和目的说明如下:
目标初始位置测量精度为3000m(1σ)/各轴,测量值在真实位置附近,将测量值设定为虚拟目标位置。简单起见,将初始时刻测量误差选定为3000m,即虚拟目标和真实目标之间的三维相对位置间距设定为3000m,虚拟目标位置和真实目标位置明显不重合。对于追踪飞行器而言,虚拟目标运动状态都是已知的。
利用本发明中的方法直接计算虚拟坐标系下真实目标的机动脉冲数值,并和实际脉冲数据作差,进行通过精度分析说明案例算法的有效性。
以绕地球做近圆绕飞、绕飞轨道高度为600km的卫星为对象进行蒙特卡洛数值打靶仿真方式验证本发明的相对定轨方法效果。追踪器C初始时刻在虚拟目标V的正后方20km处,沿侧向(虚拟坐标系的y方向)做幅值为1km的振荡运动。初始时刻追踪器C、真实目标T与虚拟目标V在惯性系下的初始位置、初始速度见表1:
表1追踪器、真实目标与虚拟目标在惯性系下的初始状态信息
其中:
相对视线测量存在量测误差,假设相机获取视线仰角α与视线偏角β存在量测误差,考虑为彼此独立的高斯白噪声,相关测量参数为:
针对上述仿真设置,进行2000次打靶仿真实验,利用和标准值的差值完成精度统计分析。打靶仿真结果如图1所示,通过5次视线测量,估计得到了非合作机动目标T的未知机动量,且估计的结果误差不超过0.1m/s,说明了方法的有效性。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (1)
1.一种利用仅测角估计非合作机动目标机动量估计的方法,其特征在于步骤如下:
步骤1:建立虚拟坐标系
假设追踪器C在t0、t1、…、tn这n+1个时刻对非合作目标T进行了最少5次视线测量,n≥4,并且追踪器C在tC时刻施加了脉冲;其中,脉冲时刻tC需要满足t0<tC<tn,/>表示追踪器C相对于地心惯性系施加的脉冲量;
在初始时刻t0,追踪器C通过地面提供的信息对非合作目标T在地心惯性系下的初始状态进行了粗略的估计,鉴于地面测量有误差,该初始状态肯定与非合作目标T的真实位置不重合,但在该真实位置附近;假设有一个虚拟的目标航天器V绕地球自由飞行,其初始位置和速度就是这个初始状态,记为与/>令x、y、z、vx、vy、vz分别表示地心惯性系下三维位置分量和速度分量,则位置矢量和速度矢量分别为/>根据二体动力学模型,可以建立以x、y、z、vx、vy、vz为自变量的微分方程:
利用龙格库塔积分算法可以计算不同时刻自变量的数值;相当于利用积分能够由与/>计算得到t1、...、tn时刻这个虚拟的目标航天器V在地心惯性系下的运动状态与/>其中μ代表地球引力常数,Re代表地球平均半径,J2代表地球非球形引力摄动的第二项系数;以该虚拟目标V为坐标原点,建立一个虚拟的LVLH轨道坐标系,称为虚拟坐标系,tm时刻该虚拟坐标系沿地心惯性系x、y、z三轴方向的单位方向矢量i(tm)、j(tm)、k(tm)分别满足下式,0≤m≤n;
步骤2:建立虚拟坐标系中的相对运动模型
在虚拟坐标系下,假设非合作目标T、虚拟目标V与追踪器C之间的彼此相对距离远小于虚拟目标V与地心之间的距离,并且假设三个飞行器绕地飞行的轨道为圆或近圆轨道,那么可以根据二体动力学模型(1)导出如下的动力学方程,描述非合作目标T或追踪器C在虚拟坐标系下相对于虚拟目标V的运动情况:
其中,rLVLH(tm)代表tm时刻非合作目标T或者追踪器C在虚拟坐标系下相对于虚拟目标V的位置,0≤m≤n,vLVLH(tm)则代表相对于虚拟目标V的速度;矩阵φrr(t)、φrv(t)、φvr(t)与φvv(t)分别满足:
其中ω代表虚拟目标V绕地球绕飞的旋转角速度:
步骤3:建立虚拟坐标系中的相对视线测量量
相对视线测量量是相机提供的目标视线角度值,或者根据角度信息对应的视线单位向量;
假设追踪器C在tm时刻对非合作目标T进行视线测量,0≤m≤n,得到了tm时刻本体坐标系下的视线仰角α(tm)与视线偏角β(tm)的测量值,由此得到tm时刻在本体坐标系下沿视线方向,即由追踪器C指向目标T方向的单位视线矢量ξb(tm):
ξb(tm)=[cosα(tm)·cosβ(tm) cosα(tm)·sinβ(tm) sinα(tm)]T (13)
步骤4:非合作机动目标脉冲机动量的估计
这里O3×(n+1)代表3×(n+1)的全零矩阵,E3代表3阶单位矩阵;其中,矩阵A满足:
A=[A1 A2 AT] (16)
这里O3×1代表3×1的全零矩阵;而列向量b满足:
其中,式(19)与(20)当中的矩阵δrv满足:
令时间步长为h,tk+1、tk分别表示时刻,二者满足tk+1=tk+h,为简单起见,用uk+1、uk分别表示u(tk+1),u(tk),这里u代表变量x、y、z、vx、vy、vz,采用龙格库塔积分的具体方法如下:
其中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210114579.9A CN114537712B (zh) | 2022-01-30 | 2022-01-30 | 一种利用仅测角估计非合作机动目标机动量的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210114579.9A CN114537712B (zh) | 2022-01-30 | 2022-01-30 | 一种利用仅测角估计非合作机动目标机动量的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114537712A CN114537712A (zh) | 2022-05-27 |
CN114537712B true CN114537712B (zh) | 2023-05-23 |
Family
ID=81672672
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210114579.9A Active CN114537712B (zh) | 2022-01-30 | 2022-01-30 | 一种利用仅测角估计非合作机动目标机动量的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114537712B (zh) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110823214A (zh) * | 2019-10-18 | 2020-02-21 | 西北工业大学 | 一种空间完全非合作目标相对位姿和惯量估计方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7142981B2 (en) * | 2003-08-05 | 2006-11-28 | The Boeing Company | Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous |
CN107883967A (zh) * | 2017-11-07 | 2018-04-06 | 南京航空航天大学 | 一种基于虚拟分布式与混合动力学的相对轨道确定方法 |
CN111367167B (zh) * | 2020-03-18 | 2022-09-06 | 中国人民解放军战略支援部队航天工程大学 | 一种有限时间约束的高轨目标抵近观测方法 |
CN113184220B (zh) * | 2021-04-21 | 2021-11-19 | 中国人民解放军63923部队 | 一种地球同步轨道通信卫星的轨道控制方法及装置 |
-
2022
- 2022-01-30 CN CN202210114579.9A patent/CN114537712B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110823214A (zh) * | 2019-10-18 | 2020-02-21 | 西北工业大学 | 一种空间完全非合作目标相对位姿和惯量估计方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114537712A (zh) | 2022-05-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Redding et al. | Vision-based target localization from a fixed-wing miniature air vehicle | |
Rönnbäck | Developement of a INS/GPS navigation loop for an UAV | |
Petrich et al. | On-board wind speed estimation for uavs | |
CN111102981A (zh) | 一种基于ukf的高精度卫星相对导航方法 | |
CN108919283B (zh) | 一种星上自主的非合作目标相对导航方法和*** | |
CN105241456A (zh) | 巡飞弹高精度组合导航方法 | |
CN109186614B (zh) | 一种航天器间近距离自主相对导航方法 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的*** | |
CN112797988B (zh) | 基于神经网络的未知机动航天器轨道确定方法 | |
CN114435630B (zh) | 一种利用有限次视线测量对非合作目标进行相对定轨的方法 | |
CN107807375B (zh) | 一种基于多gps接收机的无人机姿态追踪方法及*** | |
Huang et al. | Research on UAV flight performance test method based on dual antenna GPS/ins integrated system | |
CN114537712B (zh) | 一种利用仅测角估计非合作机动目标机动量的方法 | |
Qu et al. | Cooperative localization based on the azimuth angles among multiple UAVs | |
Wang et al. | Novel in-flight coarse alignment of low-cost strapdown inertial navigation system for unmanned aerial vehicle applications | |
Klein et al. | Squeezing position updates for enhanced estimation of land vehicles aided INS | |
Lu et al. | Analysis and application of geometric dilution of precision based on altitude-assisted INS/SAR integrated navigation | |
Saini et al. | Air-to-air tracking performance with inertial navigation and gimballed radar: a kinematic scenario | |
Radi et al. | GNSS Only Reduced Navigation System Performance Evaluation for High-Speed Smart Projectile Attitudes Estimation | |
Cho et al. | Fully automatic taxiing, takeoff and landing of a UAV only with a single-antenna GPS receiver | |
CN114526735B (zh) | 一种无人飞行器集群仅测距初始相对位姿确定方法 | |
EP4336145A1 (en) | Method and system for determining initial heading angle | |
RU2264598C1 (ru) | Способ определения координат летательного аппарата | |
Lelkov et al. | Integrated Navigation System for Ground Wheeled Robot | |
Christensen et al. | Spin-assisted angles-only navigation and control for SmallSats |
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 |