CN111272178B - 基于扩张观测器与辅助信息估计的机动目标相对导航方法 - Google Patents
基于扩张观测器与辅助信息估计的机动目标相对导航方法 Download PDFInfo
- Publication number
- CN111272178B CN111272178B CN202010176307.2A CN202010176307A CN111272178B CN 111272178 B CN111272178 B CN 111272178B CN 202010176307 A CN202010176307 A CN 202010176307A CN 111272178 B CN111272178 B CN 111272178B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- relative
- target
- target aircraft
- stars
- 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/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
Abstract
基于扩张观测器与辅助信息估计的机动目标相对导航方法,包括如下步骤:步骤一、建立两星的轨道动力学状态方程和观测方程;步骤二、根据操控飞行器和目标飞行器之间的绳系作用力解算绳系拖曳力造成的目标飞行器加速度;步骤三、将两星相对加速度作为增加的状态量,建立扩张观测器;步骤四、求解扩张观测器,实现在对目标飞行器机动加速度未知的情况下对两星相对位置速度的准确估计。本发明在不需要增加跟瞄设备测量信息的前提下,实现对机动目标位置速度的准确估计,提高了采用绳系装置对空间碎片进行拖曳过程中的相对导航精度。
Description
技术领域
本发明涉及一种采用绳系装置对空间碎片进行拖曳过程中的相对导航方法,尤其涉及一种基于扩张观测器与辅助信息融合估计的机动目标相对导航方法,属于非合作机动目标相对导航领域。
背景技术
GEO轨道因其相对地面静止的特殊性具有广泛的应用价值,是一项非常重要的稀缺资源,在各航天国的空间战略中具有举足轻重的地位。随着各国对通信、广播、气象、导航等领域需求的增长,进入这一有限空间内的飞行器越来越多,愈加拥挤,GEO轨道垃圾清除的需求显得尤为迫切。
空间碎片的存在严重地威胁着在轨运行航天器的安全,它们和航天器的碰撞将改变航天器的性能,造成表面器件损伤,导致航天器系统故障,影响航天器寿命。通过飞网捕获目标并将目标拖曳至坟墓轨道,是一种新兴的清理轨道垃圾的方案,并且由于其适应性强,可重复使用等特点受到了广泛的关注和研究。
绳网捕获目标后,操控飞行器和目标飞行器构成以系绳为连接介质的柔性组合体,如何有效将空间碎片拖至目标轨道,同时保证操控飞行器的安全涉及到轨道动力学的一系列复杂问题,对目标的导航是其中关键的一环。空间碎片作为一个非合作目标,在拖曳过程中产生未知机动,操控飞行器如果无法及时识别目标的机动情况,会严重影响系统的导航精度。目前对机动目标导航应用的方法多基于没有物理连接的两飞行器,因此所依靠的信息有限,只能通过建立复杂的状态方程或者观测方程估计目标机动情况,导致系统的导航精度低。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供一种基于扩张观测器与辅助信息估计的机动目标相对导航方法,在不增加测量信息的情况下实现对机动目标位置速度的准确估计,提高了采用绳系装置对空间碎片进行拖曳过程中的相对导航精度。
本发明的技术解决方案是:
基于扩张观测器与辅助信息估计的机动目标相对导航方法,包括如下步骤:
步骤一、建立两星的轨道动力学状态方程和观测方程,所述两星是指操控飞行器和目标飞行器;
步骤二、根据操控飞行器和目标飞行器之间的绳系作用力解算绳系拖曳力造成的目标飞行器加速度;
步骤三、将两星相对加速度作为增加的状态量,建立扩张观测器;
步骤四、求解扩张观测器,实现在对目标飞行器机动加速度未知的情况下对两星相对位置速度的准确估计。
所述步骤一中,对两星进行相对运动动力学建模,建立轨道动力学状态方程;
近圆轨道下,目标飞行器第二轨道坐标系下两星相对运动动力学方程如下:
简写后,得到两星的轨道动力学状态方程:
所述步骤一中,按照如下方法建立观测方程:
设ρ、α、β分别为两星的相对距离、高低角、方位角,则
Z=h(X)+W
式中,W为观测噪声,
将Z=h(X)线性化得观测方程:
Z=HX+W
根据上述状态方程和观测方程建立如下线性系统:
所述步骤二的实现方式如下:
目标飞行器受到的拖曳力的方向是从绳结点指向目标飞行器质心,目标飞行器受到的拖曳力大小FT=-FS,FS为操控飞行器受到的绳子的拉力,建模时假设力的方向沿目标飞行器的质心指向操控飞行器质心,再结合目标飞行器的质量,利用如下公式计算出绳系拖曳力造成的目标飞行器加速度
设操控飞行器的质量为mS,推力器对组合体施加的力为Fzong,加表测得的组合体的加速度为azong;
所述步骤三的实现方式如下:
实际的目标飞行器可能会进行主动机动,即产生未知的加速度,因此U是一个时变的非线性函数,设U=f(X),并将其作为系统的一个状态量,忽略观测噪声,则根据状态方程和观测方程建立的线性系统
忽略观测噪声,变为如下非线性系统:
B1=I3×3
对该系统构建得到如下扩张观测器:
其中Z1、Z2、Z3分别是X1、X2、U的估计值,e为状态量的估计误差,β01、β02、β03为常数参数,函数fal(e,ε,δ)满足
β01=100,β02=β03=200。
所述步骤四的实施方式如下:
利用步骤三建立的扩张观测器对X1、X2、U进行估计,
采用欧拉积分法,即令扩张观测器的初始值为Z1(0)=0、Z2(0)=0、Z3(0)=0,然后把扩张观测器离散化成如下递推公式:
其中h为采样周期,δ=0.01,采用上述递推公式,即可对状态量X1、X2、U进行估计。
与现有技术相比,本发明具有如下有益效果:
由于本发明采用了基于绳系作用力和建立扩张观测器结合的方法,在不需要增加跟瞄设备测量信息的前提下,利用绳系作用力对目标飞行器受到的拖曳力进行估计,再将两种方法计算出的加速度进行融合后引入导航滤波算法中,从而降低模型误差,提高相对导航的精度。
附图说明
图1为本发明方法流程图。
具体实施方式
本发明为基于扩张观测器与绳系辅助信息估计的机动目标相对导航方法,不需增加观测信息,目标机动状态估计准确。
如图1所示,本发明包括如下的步骤:
步骤一、建立两星的轨道动力学状态方程和观测方程,所述两星是指操控飞行器和目标飞行器;
步骤二、根据操控飞行器和目标飞行器之间的绳系作用力解算绳系拖曳力造成的目标飞行器加速度;
步骤三、将两星相对加速度作为增加的状态量,建立扩张观测器;
步骤四、求解扩张观测器,实现在对目标飞行器机动加速度未知的情况下对两星相对位置速度的准确估计。
上述步骤一具体的实现步骤如下:
a)对两星进行相对运动动力学建模,建立轨道动力学状态方程
近圆轨道下,目标航天器第二轨道坐标系下两星相对运动动力学方程如下:
对两星进行相对运动动力学建模,建立轨道动力学状态方程:
b)建立观测方程
设ρ、α、β分别为两星的相对距离、高低角、方位角,则
Z=h(X)+W
式中,W为观测噪声,
将Z=h(X)线性化得观测方程:
Z=HX+W
根据上述状态方程和观测方程可建立如下线性系统:
上述步骤二的具体实现过程如下:
理论上,对于式(3)所示的状态方程,有
两飞行器之间由于绳系拖曳的作用,目标飞行器的控制加速度不能简单假设为0,其控制加速度包括了两部分:一是自身可能机动导致的加速度,二是绳系拖曳力造成的加速度;
设操控飞行器的质量为mS,操控飞行器受到的绳子的拉力为FS,推力器对组合体施加的力为Fzong,加表测得的组合体的加速度为azong;
目标飞行器受到的拖曳力的方向是从绳结点指向目标飞行器质心,但实际飞行中只知道力的大小FT=-FS,无法测得该力的方向,建模时假设力的方向沿目标飞行器的质心指向操控飞行器质心,再结合目标飞行器的质量,利用如下公式计算出目标飞行器的加速度
将式(9)、(10)带入式(7)中,提高了状态方程的准确性
上述步骤三,建立扩张观测器具体步骤如下:
上面计算了目标飞行器由于操控飞行器的拖曳作用导致的加速度,这里将对目标飞行器自身机动产生的加速度进行估计。通过将两星相对加速度作为系统的状态量,构建扩张观测器,使得机动加速度在未知的情况下也能被较为准确地估计出。
对一般的非线性系统:
状态观测器的形式为:
其中z1、z2分别是x1、x2的估计值,e为状态量的估计误差,β01和β02为适当的常数参数,函数fal(e,ε,δ),当ε=0.5,δ=0.01时为:
同理,对于线性系统(此处为了表达简明,略去下标)
方程是在假设U=[ax ay az]T(两星相对加速度)为常值的条件下建立的,实际的目标飞行器可能会进行主动机动,即产生未知的加速度,因此U是一个时变的非线性函数,设U=f(X),并将其作为系统的一个状态量,则上述线性系统变为如下非线性系统:
B2=I3×3
对该系统构建得到如下扩张观测器:
上述步骤四,将机动加速度引入相对导航的状态方程,对目标的位置速度进行准确估计。具体步骤如下:
采用式(18)所示的扩张观测器对X1、X2、U进行估计。
采用欧拉积分法,即令状态观测器的初始值为Z1(0)=0、Z2(0)=0、Z3(0)=0,然后把系统离散化成如下递推公式,取δ=0.01:
取采样周期h=0.01,采用上述递推公式,即可对状态量X1、X2、U进行估计。
空间碎片作为一种非合作目标,在拖曳过程中会产生未知机动,降低导航精度。本发明针对操控飞行器采用绳网对空间碎片移除过程中的相对导航提出了一种基于扩张观测器与辅助信息估计的机动目标相对导航方法,在不需要增加跟瞄设备测量信息的前提下,利用操控飞行器和空间飞行器(空间碎片)之间绳系作用力以及双方的运动关系对空间碎片的机动加速度进行估计,与此同时采用扩张观测器估计出目标的加速度,再将两种方法计算出的加速度进行融合后引入导航滤波算法中,从而降低模型误差,使两星相对运动方程建模更加准确,提高相对导航的精度,导航效果更好。
本发明说明书中未详细描述的内容属于本领域专业技术人员的公知技术。
Claims (9)
1.基于扩张观测器与辅助信息估计的机动目标相对导航方法,其特征在于包括如下步骤:
步骤一、建立两星的轨道动力学状态方程和观测方程,所述两星是指操控飞行器和目标飞行器;
对两星进行相对运动动力学建模,建立轨道动力学状态方程;
近圆轨道下,目标飞行器第二轨道坐标系下两星相对运动动力学方程如下:
简写后,得到两星的轨道动力学状态方程:
步骤二、根据操控飞行器和目标飞行器之间的绳系作用力解算绳系拖曳力造成的目标飞行器加速度;
步骤三、将两星相对加速度作为增加的状态量,建立扩张观测器;
步骤四、求解扩张观测器,实现在对目标飞行器机动加速度未知的情况下对两星相对位置速度的准确估计。
8.如权利要求7所述的基于扩张观测器与辅助信息估计的机动目标相对导航方法,其特征在于:β01=100,β02=β03=200。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010176307.2A CN111272178B (zh) | 2020-03-13 | 2020-03-13 | 基于扩张观测器与辅助信息估计的机动目标相对导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010176307.2A CN111272178B (zh) | 2020-03-13 | 2020-03-13 | 基于扩张观测器与辅助信息估计的机动目标相对导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111272178A CN111272178A (zh) | 2020-06-12 |
CN111272178B true CN111272178B (zh) | 2022-03-04 |
Family
ID=70997865
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010176307.2A Active CN111272178B (zh) | 2020-03-13 | 2020-03-13 | 基于扩张观测器与辅助信息估计的机动目标相对导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111272178B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113607164B (zh) * | 2021-07-25 | 2024-01-30 | 西北工业大学 | 一种最少传感器布局下的大尺度柔性系绳三维摆角高精度估计方法 |
CN113790727A (zh) * | 2021-09-07 | 2021-12-14 | 中国西安卫星测控中心 | 一种基于辅助状态参数的脉冲机动检测方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105700536A (zh) * | 2016-01-21 | 2016-06-22 | 北京航空航天大学 | 基于绳系拖曳系统的主动星姿态和系绳摆振联合控制方法 |
CN108181914A (zh) * | 2017-12-11 | 2018-06-19 | 西北工业大学 | 一种中性浮力机器人姿态与轨迹自抗扰控制方法 |
CN110196445A (zh) * | 2019-06-07 | 2019-09-03 | 西北工业大学 | 系绳约束下的空间三体系统多传感器精确定位方法 |
CN110597063A (zh) * | 2019-09-24 | 2019-12-20 | 燕山大学 | 基于非线性扩张状态观测器的主动悬挂输出反馈控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9975632B2 (en) * | 2016-04-08 | 2018-05-22 | Drona, LLC | Aerial vehicle system |
CN108279703A (zh) * | 2018-01-26 | 2018-07-13 | 河南工程学院 | 一种用于非合作机动目标拦截的轨道控制方法 |
-
2020
- 2020-03-13 CN CN202010176307.2A patent/CN111272178B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105700536A (zh) * | 2016-01-21 | 2016-06-22 | 北京航空航天大学 | 基于绳系拖曳系统的主动星姿态和系绳摆振联合控制方法 |
CN108181914A (zh) * | 2017-12-11 | 2018-06-19 | 西北工业大学 | 一种中性浮力机器人姿态与轨迹自抗扰控制方法 |
CN110196445A (zh) * | 2019-06-07 | 2019-09-03 | 西北工业大学 | 系绳约束下的空间三体系统多传感器精确定位方法 |
CN110597063A (zh) * | 2019-09-24 | 2019-12-20 | 燕山大学 | 基于非线性扩张状态观测器的主动悬挂输出反馈控制方法 |
Non-Patent Citations (3)
Title |
---|
Anti-sway control of tethered satellite systems using attitude control of the main satellite;Yousefian, Peyman 等;《Acta Astronautica》;20151231;第111卷;第300-307页 * |
基于扩张状态观测器的机动目标加速度估计;姚郁等;《系统工程与电子技术》;20091130;第31卷(第11期);第2682-2684+2692页 * |
基于扩张状态观测器的空间飞网捕捉系统参数估计;刘志新等;《宇航学报》;20140228;第35卷(第02期);第200-206页 * |
Also Published As
Publication number | Publication date |
---|---|
CN111272178A (zh) | 2020-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107270933B (zh) | 一种基于多星协同的空间碎片运动状态联合确定方法 | |
CN111272178B (zh) | 基于扩张观测器与辅助信息估计的机动目标相对导航方法 | |
CN111207745B (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN109683628B (zh) | 一种基于有限时间分布式速度观测器的航天器相对位置控制方法 | |
CN108375904B (zh) | 一种非合作目标航天器交会对接最终段饱和控制方法 | |
Zhang et al. | Entry guidance for high-L/D hypersonic vehicle based on drag-vs-energy profile | |
Park | Wind and airspeed error estimation with GPS and pitot-static system for small UAV | |
Singh et al. | Guidance and control design for powered descent and landing on Mars | |
CA2699137A1 (en) | Hybrid inertial system with non-linear behaviour and associated method of hybridization by multi-hypothesis filtering | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
Wise | Flight testing of the X-45A J-UCAS computational alpha-beta system | |
Crocoll et al. | Quadrotor inertial navigation aided by a vehicle dynamics model with in-flight parameter estimation | |
Madyastha et al. | A novel INS/GPS fusion architecture for aircraft navigation | |
Lugo et al. | Integrated Precision Landing Performance Results for a Human-Scale Mars Landing System | |
Lee et al. | Flight test results of UAV automatic control using a single-antenna GPS receiver | |
Anderson et al. | Attitude determination and control system simulation and analysis for low-cost micro-satellites | |
CN113932803B (zh) | 适用于高动态飞行器的惯性/地磁/卫星组合导航系统 | |
Lugo et al. | Integrated Precision Landing Performance and Technology Assessments of a Human-Scale Mars Lander Using a Generalized Simulation Framework | |
CN111596678B (zh) | 一种航天器逼近空间翻滚目标的相对位置自适应控制方法 | |
CN109305394B (zh) | 航天器近距离交会试验简化方法 | |
Lorenz et al. | Robustness analysis related to the control design of the SHEFEX-II hypersonic canard control experiment | |
Lee et al. | Estimation of aircraft states and wind exposure | |
CN113984042B (zh) | 一种适用高动态飞行器串联组合导航方法 | |
CN113859565B (zh) | 基于ladrc的伸缩套臂式无人机空基回收对接控制方法 | |
Schutte et al. | Integrated simulation and state estimation for precision landing on titan |
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 |