基于改进容积卡尔曼滤波的奇异避免姿态估计

 利用矢量进行卫星姿态估计可以归结为非线性滤波问题。为了提高卫星姿态估计的精度,利用龙贝格-马尔塔(LM)迭代算法改进了容积卡尔曼滤波(CKF)。继而,提出改进容积卡尔曼滤波与四元数结合的容积四元数估计器(CQE),有效地避免了卫星大角度机动出现的奇异现象。进一步,给出了一种与影子修正罗德里格参数切换的容积修正罗德里格参数估计器(CME)。仿真对比表明,初始误差较大时容积修正罗德里格参数估计器具有更好的收敛速度和鲁棒性。     

基于自适应SRCKF的空间非合作目标实时轨道确定

针对天基测角对非合作目标跟踪定轨的动力学模型简化误差问题,提出一种基于非线性预测滤波和SRCKF(Square Root Cubature Kalman Filter,平方根容积Kalman滤波)的自适应滤波方法.采用考虑地球J2摄动影响的轨道动力学模型作为状态方程,在跟踪滤波过程中,用NPF(Nonlinear Predictive Filter,非线性预测滤波)对动力学模型进行实时修正,利用SRCKF对修正后的动力学模型进行状态估计.将该方法应用于高轨航天器对非合作低轨目标的实时测角定轨任务中,进行数字仿真,仿真结果证明,该方法相比传统的滤波方法具有更高的精度、更强的鲁棒性和稳定性.     

自适应高阶容积卡尔曼滤波在目标跟踪中的应用

针对传统容积卡尔曼滤波(CKF)在系统状态发生突变时估计精度下降的问题,将强跟踪滤波(STF)算法与高阶容积卡尔曼滤波(HCKF)算法相结合,提出了一种自适应高阶容积卡尔曼滤波(AHCKF)方法。该算法采用高阶球面-相径容积规则,可获得高于传统CKF的估计精度,同时在HCKF算法中引入STF,通过渐消因子在线修正预测误差协方差阵,强迫残差序列正交,提高了算法的鲁棒性,增强了算法应对系统状态突变等不确定因素的能力。将提出的AHCKF算法应用于具有状态突变的机动目标跟踪问题并进行数值仿真,仿真结果表明,AHCKF算法在系统状态发生突变的情况下表现出良好的滤波性能,有效地避免了状态突变造成的滤波精度下降,较传统的CKF、HCKF、交互式多模型-容积滤波(IMM-CKF)和自适应容积卡尔曼滤波(ACKF)算法有更强的鲁棒性和系统自适应能力。     

基于卫星和星敏感器的冗余激光惯组在轨标定

采用高精度卫星导航速度、位置信息以及星敏感器提供的姿态信息设计十表冗余捷联惯组的标定模型,包含陀螺和加速度计的零次项和标度因数,对卫星和星敏感器辅助的冗余激光陀螺捷联惯组进行实时在轨标定.利用标准Kalman滤波和Sage-Husa自适应滤波作为估计算法,对十表冗余捷联惯组参数进行在线估计.数值仿真结果表明:参数标定精度均在7％以内,是一种实时的在轨标定方法,满足误差补偿要求.冗余惯组在轨标定方法为航天器高精度定姿和定轨提供了一种理论参考.     

绕月探测器的自主光学导航研究

提出了一种利用高斯-马尔科夫过程和Unscented卡尔曼滤波的绕月探测器自主光学导航算法。针对很难事先确定精确地绕月探测器轨道动力学模型问题,提出利用高斯-马尔科夫过程来近似轨道动力学中的无模型加速度,进而提高了轨道动力学模型的精度;考虑到基于扩展卡尔曼滤波的轨道确定存在的问题,提出利用基于Unscented卡尔曼滤波来估计探测器的位置、速度及无模型加速度,提高了轨道估计精度和保证了算法的稳定性。最后,通过数学仿真验证了自主光学导航算法的有效性。     

Adaptive cubature Kalman filter with the estimation of correlation between multiplicative noise and additive measurement noise

Mobile robots are often subject to multiplicative noise in the target tracking tasks, where the multiplicative measurement noise is correlated with additive measurement noise. In this paper,first, a correlation multiplicative measurement noise model is established. It is able to more accurately represent the measurement error caused by the distance sensor dependence state. Then, the estimated performance mismatch problem of Cubature Kalman Filter(CKF) under multiplicative noise is analyzed. An i...     

Simultaneous spacecraft attitude and orbit estimation using magnetic field vector measurements

Based on magnetometer measurements only, three-axis attitude, rate, and orbit estimation are successfully achieved. A single Augmented Dynamics Extended Kalman Filter (ADEKF) is configured by combining the spacecraft nonlinear attitude dynamics and quaternion kinematics with orbital mechanics. The filter design is adopted for three-axis stabilized spacecraft in low Earth orbits where the aerodynamic drag is the dominant source of disturbances in addition to the spacecraft magnetic residuals. To reduce the computational burden, another Interlaced Extended Kalman Filter (IEKF) is developed to uncouple the attitude/rate from the orbit dynamics. Both filters are implemented using the magnetometer measurements and their corresponding time derivatives. As a part of EgyptSat-1 flight scenario, detumbling and standby modes are used for performance testing of the ADEKF. The concept of local observability is applied to the basic filter and the stability is investigated by incorporating extensive Monte Carlo simulations with uniformly distributed initial conditions. The filter shows the capability of estimating the attitude better than 5 deg and rate of order 0.03 deg/s in each axis. In orbit estimation, the filter is capable of estimating the position with accuracy less than 8 km and velocity upto 5 m/s in each axis.     

Second-order acceleration models for an MMAE target tracker

The performance of a multiple model adaptive estimator (MMAE) for an enhanced correlator/forward-looking-infrared tracker for airborne targets is analyzed in order to improve its performance. Performance evaluation is based on elemental filter selection and MMAE estimation error sizes and trends. The elemental filters are based on either first or second-order acceleration models. Improved filter selection is achieved by using acceleration models that separate the frequency content of acceleration power spectral densities into non-overlapping regions with second-order models versus the more traditional overlapping regions with first-order models. A revised tuning method is presented. The maximum a posteriori (MAP) versus the Bayesian MMAE is investigated. The calculation of the hypothesis probability calculation is altered to see how performance is affected. The impact of the ad hoc selection of a lower bound on the elemental filter probability calculation to prevent filter lockout is evaluated. Parameter space discretization is investigated     

基于序列图像的航天器自主导航降维滤波方法

非合作目标的运动感知与状态估计,是太空领域技术发展的重要组成部分。非合作目标相对状态的精确估计是相对导航的难点问题。传统的非合作目标扩展卡尔曼滤波算法需要结合非合作目标的质心位置,增加了状态变量的维数,提高了系统不确定性,从而会影响状态扩展卡尔曼滤波的收敛速度。提出了一种基于序列图像的非合作目标相对导航方法,该方法在不对质心进行估计的情况下首先对非合作目标姿态进行估计,在完成非合作目标姿态估计后再对其质心进行估计。本文推导了光学相机测量值与目标真实姿态的关系,构建了基于序列图像的测量模型,分别建立了不含有非合作目标质心位置的状态方程和基于非合作目标位置、速度矢量的状态方程,设计了适用于非合作目标状态估计的扩展卡尔曼滤波算法。仿真实验表明该方法可在10 Hz采样频率下经过50次采样（即5 s）内快速收敛,从而有利于空间飞行器的在轨服务与维护。     

基于对偶数的航天器多特征融合相对导航算法

针对基于视觉的航天器相对导航问题,利用对偶数推导并给出了航天器相对耦合动力学方程,该方程一体化描述了追踪航天器相对于目标航天器的姿态运动和轨道运动,且考虑了由非质心点引起的相对姿态与相对轨道之间的耦合影响。在对偶代数的框架内,统一描述了目标航天器上的特征点和特征线,并基于特征点、线在像平面的投影建立了多特征融合的单目视觉测量模型。最后通过对系统状态方程以及测量方程的线性化,应用迭代扩展卡尔曼滤波(IEKF)算法对非质心点的相对运动状态进行了估计。仿真结果表明,本文的算法能够对航天器非质心点的相对运动状态进行较高精度的估计。     

A method for improving extended Kalman filter performance forangle-only passive ranging

A relatively simple method is presented which eliminates previously reported (Oct. 1985) erratic estimation performance associated with Cartesian formulations of the extended Kalman filter (EKF) for the 2D angle-only emitter location problem. The technique is based on an initialization procedure which combines a priori probability density function (pdf) information with single measurement a posteriori pdf information in a manner which is more efficient than the EKF. Simulation results are presented which demonstrate the utility of the technique as compared with a previously offered modified gain EKF     

Hard-constrained versus soft-constrained parameter estimation

The paper aims at contrasting two different ways of incorporating a priori information in parameter estimation, i.e., hard-constrained and soft-constrained estimation. Hard-constrained estimation can be interpreted, in the Bayesian framework, as maximum a posteriori probability (MAP) estimation with uniform prior distribution over the constraining set, and amounts to a constrained least-squares (LS) optimization. Novel analytical results on the statistics of the hard-constrained estimator are presented for a linear regression model subject to lower and upper bounds on a single parameter. This analysis allows to quantify the mean squared error (MSE) reduction implied by constraints and to see how this depends on the size of the constraining set compared with the confidence regions of the unconstrained estimator. Contrastingly, soft-constrained estimation can be regarded as MAP estimation with Gaussian prior distribution and amounts to a less computationally demanding unconstrained LS optimization with a cost suitably modified by the mean and covariance of the Gaussian distribution. Results on the design of the prior covariance of the soft-constrained estimator for optimal MSE performance are also given. Finally, a practical case-study concerning a line fitting estimation problem is presented in order to validate the theoretical results derived in the paper as well as to compare the performance of the hard-constrained and soft-constrained approaches under different settings     

一种鲁棒Sigma-point滤波算法及其在相对导航中的应用

研究了一种鲁棒Sigma-point滤波方法在无人机编队相对导航问题上的应用。该方法采用Huber估计方法,将Sigma-point滤波量测更新转化为求解线性回归问题,新的Sigma-point滤波方法是一种混合L1、L2范数最小估计,当量测噪声为受污染的高斯白噪声时,该方法具有一定的鲁棒性。给出了编队无人机相对惯导方程和相对视线矢量测量原理,应用鲁棒Sigma-point滤波方法融合相对惯导信息和相对视线矢量信息,估计出无人机之间的相对姿态、相对速度和相对位置。仿真结果表明,与扩展卡尔曼滤波和常规Sigma-point滤波相比,鲁棒Sigma-point滤波可以获得更高的估计精度。     

空间平台机动变轨自主导航研究

针对空间平台在高轨道机动变轨过程中自主导航的需求,采用了基于Kalman滤波器的捷联惯导与星敏感器的组合导航方案。结合Kalman滤波中协方差更新的误差分配分析方法,分析了影响空间平台状态估计误差的主要因素。采用适用于高轨道的球谐重力模型,运用STK工具包设计了变轨机动轨迹,将该轨迹应用于组合导航方案的仿真验证。仿真结果表明,量测噪声是影响空间平台姿态精度的主要因素,加速度计零偏对变轨过程速度精度有决定性影响,改善两者的精度可以实现空间平台机动变轨的高精度自主导航。     

考虑潜在威胁区的航天器最优规避机动策略

随着一系列轨道转移飞行器的工程化实施,航天器可能面临的非合作交会威胁日趋严重。针对该问题,根据交会机动的特点定义了新的规避机动指标——潜在威胁区,相较于传统的相对距离和碰撞概率等规避指标,潜在威胁区更适合航天器在面对非合作交会追踪器时进行规避机动,能够有效提升航天器的抗交会能力。首先,建立追踪器多脉冲最优交会模型,以此为基础给出潜在威胁区的定义与计算方法;然后,以潜在威胁区弧长为优化目标,建立了目标器最优规避模型,采用遗传算法进行目标优化;最后,根据所建立的双层优化模型进行数值仿真,以初始相距100km为初始条件进行仿真并计算得到了使潜在威胁区为零所需规避脉冲值,验证了文中模型的正确性,结果显示所定义的潜在威胁区弧长随着规避脉冲的增大呈严格的单调递减关系。研究为在轨航天器在面对非合作交会时提供了有效的规避策略,提升了航天器的空间生存能力。     

A novel optimal data fusion algorithm and its application for the integrated navigation system of missile

For Inertial Navigation System(INS)/Celestial Navigation System(CNS)/Global Navigation Satellite System(GNSS) integrated navigation system of the missile, the performance of data fusion algorithms based on the Cubature Kalman Filter(CKF) is seriously degraded when there are non-Gaussian noise and process-modeling errors in the system model. Therefore, a novel method is proposed, which is called Optimal Data Fusion algorithm based on the Adaptive Fading maximum Correntropy generalized high-degree...     

空间非合作航天器抓捕后姿态抗干扰控制

针对空间非合作航天器抓捕后存在未知不确定惯性参数的柔性组合体姿态稳定控制问题,基于中间状态观测器设计方法提出了一种新的姿态稳定抗干扰控制方法,同时考虑了诸多扰动及控制输入受限问题。研究结果表明,传统的姿态稳定控制方法需要已知柔性航天器惯性参数信息及状态信息,上述信息未知情况下会使姿态难以高精度稳定控制,且容易导致控制输入不满足受限要求。针对该问题,考虑控制输入幅值及变化率受限前提,提出了一种基于中间状态观测器的抗干扰控制方法,通过引入辅助变量构造新型中间状态观测器,同时估计组合体状态信息及综合干扰,设计出了一种新的组合体姿态稳定抗干扰控制器。通过Lyapunov稳定性分析方法证明了所设计的控制器能够保证闭环系统的全局渐近稳定性。相比于已有的混合H₂/H_∞控制器,所提出的抗干扰控制器在应用时不需要柔性组合体的姿态及模态信息,并且也不需要惯性参数的辨识过程。最后,通过给定参数进行仿真对比,进一步验证了所设计控制器的有效性和优越性。     

Adaptive Two-Stage Extended Kalman Filter for a Fault-Tolerant INS-GPS Loosely Coupled System

The well-known conventional Kalman filter requires an accurate system model and exact stochastic information. But in a number of situations, the system model has an unknown bias, which may degrade the performance of the Kalman filter or may cause the filter to diverge. The effect of the unknown bias may be more pronounced on the extended Kalman filter (EKF), which is a nonlinear filter. The two-stage extended Kalman filter (TEKF) with respect to this problem has been receiving considerable attention for a long time. Recently, the optimal two-stage Kalman filter (TKF) for linear stochastic systems with a constant bias or a random bias has been proposed by several researchers. A TEKF can also be similarly derived as the optimal TKF. In the case of a random bias, the TEKF assumes that the information of a random bi?s is known. But the information of a random bias is unknown or partially known in general. To solve this problem, this paper proposes an adaptive two-stage extended Kalman filter (ATEKF) using an adaptive fading EKF. To verify the performance of the proposed ATEKF, the ATEKF is applied to the INS-GPS (inertial navigation system-Global Positioning System) loosely coupled system with an unknown fault bias. The proposed ATEKF tracked/estimated the unknown bias effectively although the information about the random bias was unknown.     

一种地理围栏内无人机航迹跟踪方法

针对UTM体制中无人机在地理围栏内的飞行监视问题,提出一种约束状态相关模态转换混合估计算法(CSDTHE)。采用随机线性混杂系统模型对无人机运动状态进行建模,利用CV、CT和CA三种模态描述无人机的飞行状态,以构建地理围栏内无人机运行的通用模态转换模型框架。利用飞行模态改变点(FMCP)定义相关模态转换参数,设计模态转换条件,生成模态转换概率矩阵,从而建立与状态相关的模态转换模型。运用约束卡尔曼滤波(CKF)方法对直线阶段和转弯阶段的无人机运动速度分别施加等式约束,并通过仿真实验验证了CSDTHE算法对无人机跟踪的有效性。     

Multi-EAP:Extended EAP for multi-estimate extraction for SMC-PHD filter

The ability to extract state-estimates for each target of a multi-target posterior, referred to as multi-estimate extraction (MEE), is an essential requirement for a multi-target filter, whose key performance assessments are based on accuracy, computational efficiency and reliability. The probability hypothesis density (PHD) filter, implemented by the sequential Monte Carlo approach, affords a computationally efficient solution to general multi-target filtering for a time-varying num-ber of targets, but leaves no clue for optimal MEE. In this paper, new data association techniques are proposed to distinguish real measurements of targets from clutter, as well as to associate par-ticles with measurements. The MEE problem is then formulated as a family of parallel single-estimate extraction problems, facilitating the use of the classic expected a posteriori (EAP) estima-tor, namely the multi-EAP (MEAP) estimator. The resulting MEAP estimator is free of iterative clustering computation, computes quickly and yields accurate and reliable estimates. Typical sim-ulation scenarios are employed to demonstrate the superiority of the MEAP estimator over existing methods in terms of faster processing speed and better estimation accuracy.