CN112046793A - 复杂扰动下的空间相对状态快速确定方法 - Google Patents

复杂扰动下的空间相对状态快速确定方法 Download PDF

Info

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
Application number
CN201910484111.7A
Other languages
English (en)
Inventor
王晓亮
龚德仁
吴树范
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Jiaotong University
Original Assignee
Shanghai Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Jiaotong University filed Critical Shanghai Jiaotong University
Priority to CN201910484111.7A priority Critical patent/CN112046793A/zh
Publication of CN112046793A publication Critical patent/CN112046793A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude 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

复杂扰动下的空间相对状态快速确定方法
技术领域
本发明涉及的是一种卫星控制领域的技术,具体是一种复杂扰动下的空间相对状态快速确定方法。
背景技术
卫星编队飞行等空间任务主要用于对地观测、精确定位、天文观测以及电子侦察等领域,这些应用对空间相对状态确定精度的要求很高。而卫星在实际运行中会受到地球非球形引力、第三体引力、太阳光压、大气阻力等多种复杂干扰力的作用。在干扰影响下,编队飞行卫星的相对轨道会发生变化,虽然这些扰动力与地球中心引力相比非常小,但长期作用仍可使卫星轨道偏离任务要求。因此,在需要高精度轨道预报的卫星编队飞行研究中,这些扰动力不能被忽略,如何在复杂干扰下对空间相对状态进行快速确定成为亟需解决的问题。
发明内容
本发明针对现有技术对复杂干扰项采用高阶补偿方法处理,计算量大,占用星上有限资源,不适合航天任务星载处理要求的缺陷,提出一种复杂扰动下的空间相对状态快速确定方法,能够在空间扰动条件下对系统过程噪声进行在线实时估计,并将结果传递到相对状态确定步骤进行快速解算。
本发明是通过以下技术方案实现的:
本发明通过选取描述空间相对运动的动力学状态变量进行扩维,将运动过程和测量表述为非线性方程、将复杂空间扰动表述为非常规噪声;对动力学模型不准确引起的递推误差进行协方差矩阵的上界估计;采用自适应递推优化方法对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。
所述的空间相对运动动力学模型是指:
Figure BDA0002084801430000011
其中:xk∈Rn为k时刻空间相对状态,yk∈Rp为k时刻测量输出,f(xk-1)为k-1时刻系统非线性状态方程,G为过程噪声矩阵,wk为k时刻描述复杂空间扰动的非常规过程噪声,vk为k时刻测量噪声。
所述的上界估计是指:
Figure BDA0002084801430000012
其中:
Figure BDA0002084801430000013
为先验协方差矩阵,λk,α,β为待优化系数,tr(·)为矩阵求迹运算,I为单位矩阵。
所述的自适应递推优化方法是指:通过在测量信息获取后建立复杂扰动下的优化代价函数
Figure BDA0002084801430000021
根据递推模型
Figure BDA0002084801430000022
获取过程噪声的估计,经滤波后快速得到空间相对状态信息,其中:Sk为k时刻待优化值,
Figure BDA0002084801430000023
为k时刻输出预测协方差矩阵,
Figure BDA0002084801430000024
为k时刻过程噪声矩阵第m个对角元素,Ts为采样时间。
所述的测量信息获取是指:在滤波算法第k步获得测量输出yk
技术效果
与现有技术相比,本发明技术效果包括:
1)紧贴工程需求,解决过程明确,可实现性强:目前空间分布式航天器间的相对运动精确建模较为困难,对复杂扰动下的不确定性无法定量描述。本发明将扰动过程整合到相对状态的递推求解过程中进行实时上界估计,简洁高效的完成了相对状态信息输出。
2)空间相对状态获取精度高:本发明采用非线性估计方法对空间相对动力学模型进行处理,且考虑了复杂扰动条件,相比其他方法精度提升明显,相对位置估计精度能达到cm级别,相对速度精度达到mm/s级别。
3)处理过程计算量小:相比于传统处理方法,仅仅增加了空间复杂扰动的估计部分,相同条件下计算时间仅增加约20%。
附图说明
图1为实施例中无扰动下空间相对运动位置;
图2为实施例中实际复杂扰动下空间相对运动位置;
图3为采用传统方法和实施例方法相对位置误差对比;
图4为采用传统方法和实施例方法相对速度误差对比。
具体实施方式
本实施例涉及一种复杂扰动下的空间相对状态快速确定方法,包括以下步骤:
步骤1:复杂扰动下的空间相对状态描述,即将描述空间相对运动的动力学状态变量进行适当的选取与扩维,将运动过程和测量表述为非线性方程,对复杂空间扰动表述为非常规噪声;
步骤2:动力学递推误差上界估计,即将动力学建模不准确引起的递推误差进行评估,采用线性矩阵不等式理论,进行递推误差协方差矩阵的上界估计;
步骤3:复杂扰动和测量更新下的空间相对状态快速确定,即相对测量信息获取条件下,采用自适应递推优化方法,对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。
步骤1中的空间相对状态描述是指:
Figure BDA0002084801430000025
其中: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为外界扰动的上界,则得到动力学递推误差上界估计
Figure BDA0002084801430000031
其中:
Figure BDA0002084801430000032
为先验协方差矩阵,tr(·)为矩阵求迹运算,I为单位矩阵,λk,α,β为待优化系数,其满足
Figure BDA0002084801430000033
其中:
Figure BDA0002084801430000034
H为量测雅克比矩阵,单位矩阵,
Figure BDA0002084801430000035
为输出协方差矩阵的无偏估计且有
Figure BDA0002084801430000036
步骤3中自适应递推优化方法,通过以下步骤实现:
3.1)在测量获取后建立复杂扰动下的优化代价函数
Figure BDA0002084801430000037
,其中:Sk为k时刻待优化值,
Figure BDA0002084801430000038
为k时刻输出预测协方差矩阵,在代价函数的负梯度方向进行微分
Figure BDA0002084801430000039
则建立递推模型
Figure BDA00020848014300000310
获取过程噪声的估计,其中:
Figure BDA00020848014300000311
为k时刻过程噪声矩阵第m个对角元素,η为待调节参数,Ts为采样时间。
3.2)对
Figure BDA00020848014300000312
变换得到
Figure BDA00020848014300000313
其中:
Figure BDA00020848014300000314
其中:
Figure BDA00020848014300000315
Figure BDA00020848014300000316
这样复杂扰动下的空间相对状态模型误差上界得到优化估计。
3.3)采用传统滤波更新步骤快速获取空间相对状态信息。
本实施例通过以下仿真实现:
i)采用空间相对运动动力学模型:
Figure BDA0002084801430000041
其中:空间相对位置向量ξ=[xyz]T建立在主星当地水平坐标系,三个分量分别朝向径向、切向与法向,r,θ,μ分别为主星轨道半径、真近点角和引力系数,wx,wy,wz为空间扰动量;
ii)星间相对测量采用差分GPS方式,其模型为
Figure BDA0002084801430000042
其中:
Figure BDA0002084801430000043
为差分测量值,
Figure BDA0002084801430000044
为空间相对位置在视线方向投影,Δbc,d为钟差量,
Figure BDA0002084801430000045
为测量噪声,下标c,d为空间双星(主星chief、副星deputy)。
iii)当主星空间轨道根数为a=42096km,e=0.8,i=51.7deg,Ω=0deg,ω=0deg,M=0deg,空间相对状态选取为
Figure BDA0002084801430000046
仿真中采用如下初值: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.一种复杂扰动下的空间相对状态快速确定方法,其特征在于,通过选取描述空间相对运动的动力学状态变量进行扩维,将运动过程和测量表述为非线性方程、将复杂空间扰动表述为非常规噪声;对动力学模型不准确引起的递推误差进行协方差矩阵的上界估计;采用自适应递推优化方法对测量值中包含的扰动信息进行估计和剔除,从而得到空间相对状态信息。
2.根据权利要求1所述的方法,其特征是,所述的空间相对状态描述是指:
Figure FDA0002084801420000011
其中:xk∈Rn为k时刻系统状态,yk∈Rp为k时刻测量输出,f(xk-1)为k-1时刻系统非线性状态方程,G为过程噪声矩阵,wk为k时刻描述复杂空间扰动的非常规过程噪声,vk为k时刻测量噪声。
3.根据权利要求1所述的方法,其特征是,所述的运动动力学模型:
Figure FDA0002084801420000012
其中:空间相对位置向量ξ=[x y z]T建立在主星当地水平坐标系,三个分量分别朝向径向、切向与法向,r,θ,μ分别为主星轨道半径、真近点角和引力系数,wx,wy,wz为空间扰动量。
4.根据权利要求3所述的方法,其特征是,所述的上界估计是指:
Figure FDA0002084801420000013
其中:
Figure FDA0002084801420000014
为先验协方差矩阵,λk,α,β为待优化系数,tr(·)为矩阵求迹运算,I为单位矩阵。
5.根据权利要求1所述的方法,其特征是,所述的自适应递推优化方法是指:通过在测量获取后建立复杂扰动下的优化代价函数
Figure FDA0002084801420000015
根据递推模型
Figure FDA0002084801420000016
获取过程噪声的估计,经滤波后快速得到空间相对状态信息,其中:Sk为k时刻待优化值,
Figure FDA0002084801420000021
为k时刻输出预测协方差矩阵,
Figure FDA0002084801420000022
为k时刻过程噪声矩阵第m个对角元素,Ts为采样时间。
CN201910484111.7A 2019-06-05 2019-06-05 复杂扰动下的空间相对状态快速确定方法 Pending CN112046793A (zh)

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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112607064A (zh) * 2020-12-25 2021-04-06 上海交通大学 避免进入自旋状态的微纳卫星磁阻尼控制方法

Citations (6)

* Cited by examiner, † Cited by third party
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 杭州电子科技大学 一种基于观测噪声方差未知的自适应卡尔曼滤波方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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