CN112046793A - 复杂扰动下的空间相对状态快速确定方法 - Google Patents
复杂扰动下的空间相对状态快速确定方法 Download PDFInfo
- Publication number
- CN112046793A CN112046793A CN201910484111.7A CN201910484111A CN112046793A CN 112046793 A CN112046793 A CN 112046793A CN 201910484111 A CN201910484111 A CN 201910484111A CN 112046793 A CN112046793 A CN 112046793A
- Authority
- CN
- China
- Prior art keywords
- disturbance
- time
- space relative
- noise
- space
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 239000011159 matrix material Substances 0.000 claims abstract description 26
- 238000005259 measurement Methods 0.000 claims abstract description 15
- 238000005457 optimization Methods 0.000 claims abstract description 7
- 238000001914 filtration Methods 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 3
- 230000003044 adaptive effect Effects 0.000 claims 1
- 238000004364 calculation method Methods 0.000 abstract description 5
- 230000026676 system process Effects 0.000 abstract description 2
- 238000004088 simulation Methods 0.000 description 4
- 230000015572 biosynthetic process Effects 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 238000007796 conventional method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
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
-
- 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/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种复杂扰动下的空间相对状态快速确定方法,通过选取描述空间相对运动的动力学状态变量进行扩维,将运动过程和测量表述为非线性方程、将复杂空间扰动表述为非常规噪声;对动力学模型不准确引起的递推误差进行协方差矩阵的上界估计;采用自适应递推优化方法对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。本发明能够在空间扰动条件下对系统过程噪声进行在线实时估计,并将结果传递到相对状态确定步骤进行快速解算。
Description
技术领域
本发明涉及的是一种卫星控制领域的技术,具体是一种复杂扰动下的空间相对状态快速确定方法。
背景技术
卫星编队飞行等空间任务主要用于对地观测、精确定位、天文观测以及电子侦察等领域,这些应用对空间相对状态确定精度的要求很高。而卫星在实际运行中会受到地球非球形引力、第三体引力、太阳光压、大气阻力等多种复杂干扰力的作用。在干扰影响下,编队飞行卫星的相对轨道会发生变化,虽然这些扰动力与地球中心引力相比非常小,但长期作用仍可使卫星轨道偏离任务要求。因此,在需要高精度轨道预报的卫星编队飞行研究中,这些扰动力不能被忽略,如何在复杂干扰下对空间相对状态进行快速确定成为亟需解决的问题。
发明内容
本发明针对现有技术对复杂干扰项采用高阶补偿方法处理,计算量大,占用星上有限资源,不适合航天任务星载处理要求的缺陷,提出一种复杂扰动下的空间相对状态快速确定方法,能够在空间扰动条件下对系统过程噪声进行在线实时估计,并将结果传递到相对状态确定步骤进行快速解算。
本发明是通过以下技术方案实现的:
本发明通过选取描述空间相对运动的动力学状态变量进行扩维,将运动过程和测量表述为非线性方程、将复杂空间扰动表述为非常规噪声;对动力学模型不准确引起的递推误差进行协方差矩阵的上界估计;采用自适应递推优化方法对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。
所述的空间相对运动动力学模型是指:其中:xk∈Rn为k时刻空间相对状态,yk∈Rp为k时刻测量输出,f(xk-1)为k-1时刻系统非线性状态方程,G为过程噪声矩阵,wk为k时刻描述复杂空间扰动的非常规过程噪声,vk为k时刻测量噪声。
所述的自适应递推优化方法是指:通过在测量信息获取后建立复杂扰动下的优化代价函数根据递推模型获取过程噪声的估计,经滤波后快速得到空间相对状态信息,其中:Sk为k时刻待优化值,为k时刻输出预测协方差矩阵,为k时刻过程噪声矩阵第m个对角元素,Ts为采样时间。
所述的测量信息获取是指:在滤波算法第k步获得测量输出yk。
技术效果
与现有技术相比,本发明技术效果包括:
1)紧贴工程需求,解决过程明确,可实现性强:目前空间分布式航天器间的相对运动精确建模较为困难,对复杂扰动下的不确定性无法定量描述。本发明将扰动过程整合到相对状态的递推求解过程中进行实时上界估计,简洁高效的完成了相对状态信息输出。
2)空间相对状态获取精度高:本发明采用非线性估计方法对空间相对动力学模型进行处理,且考虑了复杂扰动条件,相比其他方法精度提升明显,相对位置估计精度能达到cm级别,相对速度精度达到mm/s级别。
3)处理过程计算量小:相比于传统处理方法,仅仅增加了空间复杂扰动的估计部分,相同条件下计算时间仅增加约20%。
附图说明
图1为实施例中无扰动下空间相对运动位置;
图2为实施例中实际复杂扰动下空间相对运动位置;
图3为采用传统方法和实施例方法相对位置误差对比;
图4为采用传统方法和实施例方法相对速度误差对比。
具体实施方式
本实施例涉及一种复杂扰动下的空间相对状态快速确定方法,包括以下步骤:
步骤1:复杂扰动下的空间相对状态描述,即将描述空间相对运动的动力学状态变量进行适当的选取与扩维,将运动过程和测量表述为非线性方程,对复杂空间扰动表述为非常规噪声;
步骤2:动力学递推误差上界估计,即将动力学建模不准确引起的递推误差进行评估,采用线性矩阵不等式理论,进行递推误差协方差矩阵的上界估计;
步骤3:复杂扰动和测量更新下的空间相对状态快速确定,即相对测量信息获取条件下,采用自适应递推优化方法,对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。
步骤1中的空间相对状态描述是指:其中:xk∈Rn为k时刻系统状态,yk∈Rp为k时刻测量输出,f(xk-1)为k-1时刻系统非线性状态方程,G为过程噪声矩阵,wk,vk分别为k时刻过程噪声与测量噪声。
步骤2中的动力学递推误差上界估计,通过将空间相对状态描述中的状态方程进行改写为xk=f(xk-1)+Δf+Gwk-1,其中:||Δf||∞≤δ,δ≥0为外界扰动的上界,则得到动力学递推误差上界估计其中:为先验协方差矩阵,tr(·)为矩阵求迹运算,I为单位矩阵,λk,α,β为待优化系数,其满足其中:H为量测雅克比矩阵,单位矩阵,为输出协方差矩阵的无偏估计且有
步骤3中自适应递推优化方法,通过以下步骤实现:
3.3)采用传统滤波更新步骤快速获取空间相对状态信息。
本实施例通过以下仿真实现:
i)采用空间相对运动动力学模型:其中:空间相对位置向量ξ=[xyz]T建立在主星当地水平坐标系,三个分量分别朝向径向、切向与法向,r,θ,μ分别为主星轨道半径、真近点角和引力系数,wx,wy,wz为空间扰动量;
iii)当主星空间轨道根数为a=42096km,e=0.8,i=51.7deg,Ω=0deg,ω=0deg,M=0deg,空间相对状态选取为仿真中采用如下初值:X(t0)=[-0.500.200.0008000.0018419.2010.1]T,GPS初始仿真历元设置为2019年4月8日14:15:00,仿真在计算机硬件平台以及MATLAB环境下编译软件实现,硬件平台配置为:Intel Core 2 Duo 2.1GHz/4G/256G。
如图1和图2所示,为相同条件下,不考虑空间扰动和考虑实际空间复杂扰动条件下的卫星相对位置对比,可以看出在有扰动且无控条件下,副星会随着时间推移,逐渐偏离预定构型。
如图3和图4所示,为复杂扰动条件下,采用传统方法和本发明提出的快速确定方法的位置、速度确定误差对比图,可以看出传统方法在扰动下的相对状态确定误差会逐渐增大直至发散,而本方法则能够较好收敛并精度较好。
经过统计,本方法在收敛后相对位置确定精度能达到cm级别,相对速度精度达到mm/s级别,且相同条件下计算时间比传统方法仅增加约20%。
上述具体实施可由本领域技术人员在不背离本发明原理和宗旨的前提下以不同的方式对其进行局部调整,本发明的保护范围以权利要求书为准且不由上述具体实施所限,在其范围内的各个实现方案均受本发明之约束。
Claims (5)
1.一种复杂扰动下的空间相对状态快速确定方法,其特征在于,通过选取描述空间相对运动的动力学状态变量进行扩维,将运动过程和测量表述为非线性方程、将复杂空间扰动表述为非常规噪声;对动力学模型不准确引起的递推误差进行协方差矩阵的上界估计;采用自适应递推优化方法对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910484111.7A CN112046793A (zh) | 2019-06-05 | 2019-06-05 | 复杂扰动下的空间相对状态快速确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910484111.7A CN112046793A (zh) | 2019-06-05 | 2019-06-05 | 复杂扰动下的空间相对状态快速确定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112046793A true CN112046793A (zh) | 2020-12-08 |
Family
ID=73608519
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910484111.7A Pending CN112046793A (zh) | 2019-06-05 | 2019-06-05 | 复杂扰动下的空间相对状态快速确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112046793A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112607064A (zh) * | 2020-12-25 | 2021-04-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080152218A1 (en) * | 2006-10-27 | 2008-06-26 | Kabushiki Kaisha Toshiba | Pose estimating device and pose estimating method |
CN102040008A (zh) * | 2010-12-13 | 2011-05-04 | 北京航空航天大学 | 一种用于编队卫星在轨运行安全的防碰控制方法 |
US20140032167A1 (en) * | 2011-04-01 | 2014-01-30 | Physical Sciences, Inc. | Multisensor Management and Data Fusion via Parallelized Multivariate Filters |
CN105701297A (zh) * | 2016-01-14 | 2016-06-22 | 西安电子科技大学 | 一种基于多点自适应代理模型的反射面天线机电耦合设计方法 |
CN107179693A (zh) * | 2017-06-27 | 2017-09-19 | 哈尔滨工程大学 | 基于Huber估计的鲁棒自适应滤波和状态估计方法 |
CN109582916A (zh) * | 2019-01-28 | 2019-04-05 | 杭州电子科技大学 | 一种基于观测噪声方差未知的自适应卡尔曼滤波方法 |
-
2019
- 2019-06-05 CN CN201910484111.7A patent/CN112046793A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080152218A1 (en) * | 2006-10-27 | 2008-06-26 | Kabushiki Kaisha Toshiba | Pose estimating device and pose estimating method |
CN102040008A (zh) * | 2010-12-13 | 2011-05-04 | 北京航空航天大学 | 一种用于编队卫星在轨运行安全的防碰控制方法 |
US20140032167A1 (en) * | 2011-04-01 | 2014-01-30 | Physical Sciences, Inc. | Multisensor Management and Data Fusion via Parallelized Multivariate Filters |
CN105701297A (zh) * | 2016-01-14 | 2016-06-22 | 西安电子科技大学 | 一种基于多点自适应代理模型的反射面天线机电耦合设计方法 |
CN107179693A (zh) * | 2017-06-27 | 2017-09-19 | 哈尔滨工程大学 | 基于Huber估计的鲁棒自适应滤波和状态估计方法 |
CN109582916A (zh) * | 2019-01-28 | 2019-04-05 | 杭州电子科技大学 | 一种基于观测噪声方差未知的自适应卡尔曼滤波方法 |
Non-Patent Citations (6)
Title |
---|
GUANG Q. XING, SHABBIR A. PARVEZ: "Alternate forms of relative attitude kinematics and dynamics equations", 《THE SPACE CONTROL CONFERENCE》 * |
OU YANGWEI, ZHANG HONGBO, XING JIANJUN: "Autonomous Orbit Determination and Observability Analysis for Formation Satellites", 《PROCEEDINGS OF THE 35TH CHINESE CONTROL CONFERENCE》 * |
YUE XINCHENG, YANG YING, DUAN ZHISHENG, GENG ZHIYONG: "Parameter-Dependent Lyapunov Function Method Applied to Satellite Formation Keeping Control", 《PROCEEDINGS OF THE 27TH CHINESE CONTROL CONFERENCE》 * |
张发启: "《盲信号处理及应用》", 31 October 2016 * |
温洲,邵晓巍,陶久亮,龚德仁: "基于Lawden改进型方程的编队Unscented Kalman Filter滤波估计", 《航天控制》 * |
王晓亮,邵晓巍,龚德仁,段登平: "改进的量测噪声自适应滤波在空间非合作目标视觉导航中的应用", 《航天控制》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112607064A (zh) * | 2020-12-25 | 2021-04-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
CN112607064B (zh) * | 2020-12-25 | 2021-08-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Shen et al. | Novel variable structure measurement system with intelligent components for flight vehicles | |
CN111156987B (zh) | 基于残差补偿多速率ckf的惯性/天文组合导航方法 | |
CN109255096B (zh) | 一种基于微分代数的地球同步卫星轨道不确定演化方法 | |
Wang et al. | Central difference particle filter applied to transfer alignment for SINS on missiles | |
CN109032176B (zh) | 一种基于微分代数的地球同步轨道确定和参数确定方法 | |
Gross et al. | A comparison of extended Kalman filter, sigma-point Kalman filter, and particle filter in GPS/INS sensor fusion | |
CN110378012B (zh) | 一种考虑高阶重力场的严格回归轨道设计方法、系统及介质 | |
Lu et al. | Applied quaternion optimization method in transfer alignment for airborne AHRS under large misalignment angle | |
CN112161632B (zh) | 一种基于相对位置矢量测量的卫星编队初始定位方法 | |
CN110275193B (zh) | 一种基于因子图的集群卫星协同导航方法 | |
Pfeiffer et al. | A computationally efficient moving horizon estimator for ultra-wideband localization on small quadrotors | |
Shen et al. | Algorithms of constructing models for compensating navigation systems of unmanned aerial vehicles | |
Crassidis et al. | Efficient and optimal attitude determination using recursive global positioning system signal operations | |
CN110015445B (zh) | 一种地月L2点Halo轨道维持方法 | |
Yang et al. | Analysis of a neural-network-based adaptive controller for deep-space formation flying | |
Vandersteen et al. | Robust rocket navigation with sensor uncertainties: Vega launcher application | |
Austin et al. | Statistically linearized estimation of reentry trajectories | |
CN112046793A (zh) | 复杂扰动下的空间相对状态快速确定方法 | |
CN110736459B (zh) | 惯性量匹配对准的角形变测量误差评估方法 | |
Christian et al. | Integrated performance of an autonomous optical navigation system for space exploration | |
CN107702718B (zh) | 一种基于瞬间可观测度模型的机载pos机动优化方法与装置 | |
Li et al. | Sequential unbiased converted measurement non‐linear filter with range rate in ECEF coordinates | |
Shen et al. | Research on high-precision measurement systems of modern aircraft | |
CN115314101A (zh) | 一种基于并行计算的低轨通信卫星星座快速建模方法 | |
Xiao et al. | A fast convergence super‐twisting observer design for an autonomous airship |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20201208 |