基于变结构多模型的SINS/DVL组合导航算法

对于无人水下航行器来说,SINS/DVL组合导航是其主要导航方式,由于DVL自身作用距离的限制,虽然它可以在水跟踪模式下工作,但洋流速度作为其测量误差会导致SINS/DVL组合导航性能下降甚至失败.针对上述问题,基于有向图切换方法,设置洋流速度模型群,利用所设置的模型群切换策略对子模型群进行激活和终止,通过变结构多模型...     

Variable structure multiple model fixed-interval smoothing

This paper focuses on fixed-interval smoothing for stochastic hybrid systems. When the truth-mode mismatch is encountered, existing smoothing methods based on fixed structure of model-set have significant performance degradation and are inapplicable. We develop a fixed-interval smoothing method based on forward- and backward-filtering in the Variable Structure Multiple Model (VSMM) framework in this paper. We propose to use the Simplified Equivalent model Interacting Multiple Model (SEIMM) in the forward and the backward filters to handle the difficulty of different mode-sets used in both filters, and design a re-filtering procedure in the model-switching stage to enhance the estimation performance. To improve the computational efficiency, we make the basic model-set adaptive by the Likely-Model Set (LMS) algorithm. It turns out that the smoothing performance is further improved by the LMS due to less competition among models. Simulation results are provided to demonstrate the better performance and the computational efficiency of our proposed smoothing algorithms.     

Geometrical entropy approach for variable structure multiple-model estimation

The variable structure multiple-model(VSMM) estimation approach, one of the multiple-model(MM) estimation approaches, is popular in handling state estimation problems with mode uncertainties.In the VSMM algorithms, the model sequence set adaptation(MSA) plays a key role.The MSA methods are challenged in both theory and practice for the target modes and the real observation error distributions are usually uncertain in practice.In this paper, a geometrical entropy(GE) measure is proposed so that the MSA is achieved on the minimum geometrical entropy(MGE) principle.Consequently, the minimum geometrical entropy multiple-model(MGEMM) framework is proposed, and two suboptimal algorithms, the particle filter k-means minimum geometrical entropy multiple-model algorithm(PF-KMGEMM) as well as the particle filter adaptive minimum geometrical entropy multiple-model algorithm(PF-AMGEMM), are established for practical applications.The proposed algorithms are tested in three groups of maneuvering target tracking scenarios with mode and observation error distribution uncertainties.Numerical simulations have demonstrated that compared to several existing algorithms, the MGE-based algorithms can achieve more robust and accurate estimation results when the real observation error is inconsistent with a priori.     

基于冗余伪观测的自适应滤波算法

现有的二阶互差分(SOMD)算法能够给出与状态估计误差解耦的观测噪声协方差估计，但是需要满足冗余测量的条件，但这一条件往往难以满足。 针对这一问题，提出了一种利用状态预测值构造相邻2个时刻伪观测的方法，将原SOMD算法扩展到具有单测量的系统中。使用目标跟踪问题对该算法的有效性进行验证。仿真结果表明，当采样周期较小时，该算法能够忽略状态估计误差的影响并给出较准确的观测噪声方差，在精度和鲁棒性方面优于其他参考算法。     

航空发动机全程滑态模型跟踪控制研究

 将全程滑态变结构模型跟踪控制首次应用于航空发动机系统,设计出了航空发动机全程滑态模型跟踪控制器。采用二次状态反馈法规划的参考模型不仅满足性能指标要求和完全跟踪的模型匹配条件,同时也实现了完全解耦。由于全程滑态变结构控制消除了能达阶段,故能克服定常滑态变结构控制系统在此阶段对扰动的敏感性,并且其控制律的设计可以改善系统的瞬态性能,克服扰动和未知参数摄动的影响。结果表明:所设计的系统能取得令人满意的控制效果,能有效地抑制干扰和参数摄动的影响, 具有强的鲁棒性。     

Novel Nonlinear Filtering & Prediction Method for Maneuvering Target Tracking

A new nonlinear filtering and prediction (NFP) algorithm with input es?imation is proposed for maneuvering target tracking. In the proposed method, the acceleration level is determined by a decision process, where a least squares (LS) estimator plays a major role in detecting target maneuvering within a sliding window. We first illustrate that the optimal solution to minimize the mean squared error (MSE) must consider a trade-off between the bias and error variance. For the application of target tracking, we then derive the MSE of target positions in a closed form by using orthogonal space decompositions. Then we discuss the NFP estimator, and evaluate how well the approach potentially works in the case of a set of given system parameters. Comparing with the traditional unbiased minimum variance filter (UMVF), Kalman filter, and interactive multiple model (IMM) algorithms, numerical results show that the newly proposed NFP method performs comparable or better in all scenarios with significantly less computational requirements.     

Ground target tracking with variable structure IMM estimator

In this paper we present the design of a Variable Structure Interacting Multiple Model (VS-IMM) estimator for tracking groups of ground targets on constrained paths using Moving Target Indicator (MTI) reports obtained from an airborne sensor. The targets are moving along a highway, with varying obscuration due to changing terrain conditions. In addition, the roads can branch, merge or cross-the scenario represents target convoys along a realistic road network with junctions, changing terrains, etc. Some of the targets may also move in an open field. This constrained motion estimation problem is handled using an IMM estimator with varying mode sets depending on the topography, The number of models in the IMM estimator, their types and their parameters are modified adaptively, in real-time, based on the estimated position of the target and the corresponding road/visibility conditions. This topography-based variable structure mechanism eliminates the need for carrying all the possible models throughout the entire tracking period as in the standard IMM estimator, significantly improving performance and reducing computational load. Data association is handled using an assignment algorithm. The estimator is designed to handle a very large number of ground targets simultaneously. A simulated scenario consisting of over one hundred targets is used to illustrate the selection of design parameters and the operation of the tracker. Performance measures are presented to contrast the benefits of the VS-IMM estimator over the Kalman filter and the standard IMM estimator, The VS-IMM estimator is then combined with multidimensional assignment to gain “time-depth.” The additional benefit of using higher dimensional assignment algorithms for data association is also evaluated     

Loopy belief propagation based data association for extended target tracking

The data association problem of multiple extended target tracking is very challenging because each target may generate multiple measurements. Recently, the belief propagation based multiple target tracking algorithms with high efficiency have been a research focus. Different from the belief propagation based Extended Target tracking based on Belief Propagation (ET-BP) algorithm proposed in our previous work, a new graphical model formulation of data association for multiple extended target tracking is proposed in this paper. The proposed formulation can be solved by the Loopy Belief Propagation (LBP) algorithm. Furthermore, the simplified measurement set in the ET-BP algorithm is modified to improve tracking accuracy. Finally, experiment results show that the proposed algorithm has better performance than the ET-BP and joint probabilistic data association based on the simplified measurement set algorithms in terms of accuracy and efficiency. Additionally, the convergence of the proposed algorithm is verified in the simulations.     

高精度甚低速系统的变结构控制方案研究

非线性接触摩擦普遍存在于一般伺服系统中,它引起的低速爬行会影响整个系统的正常工作。本文提出了一种变结构设计方案,能有效地克服低速爬行,消除斜坡信号作用下的系统静差,并获得较为简单的控制算法和系统结构。     

Minimal submodel-set algorithm for maneuvering target tracking

The variable structure multiple model (VSMM) approach to the maneuvering target tracking problem is considered. A new VSMM design, the minimal submodel-set switching (MSMSS) algorithm for tracking a maneuvering target is presented. The MSMSS algorithm adaptively determines the minimal set of models from the total model set and uses this to perform multiple models (MM) estimation. In addition, an iterative MSMSS algorithm with improved maneuver detection and termination properties is developed. Simulations results demonstrate that, compared with a standard interacting MM (IMM), the proposed algorithms require significantly lower computation while maintaining similar tracking performance. Alternatively, for a computational load similar to IMM, the new algorithms display significantly improved performance.     

On the Sensitivity of a Fixed-Point Smoothing Algorithm

This paper presents a simple approach to the derivation of sensitivity measures of smoothing algorithms. It is proposed that the known sensitivity results of the Kalman filtering algorithm be utilized along with the state augmentation approach for this purpose. The sensitivity measures so obtained are easier to compute than the ones available in the literature. It is then shown that the fixed-point smoothing algorithm, derived recently by Biswas and Mahalanabis [1], [2], is less sensitive to model parameter variations than the algorithm studied by Griffin and Sage [7], [8]. The case of a satellite tracking problem is presented by way of illustrating the results.     

基于模型预测静态规划的自适应轨迹跟踪算法

轨迹跟踪是飞机自主运动控制的关键问题之一。跟踪模型预测静态规划（T-MPSP）是一种新近发展的基于非线性模型的轨迹跟踪算法,但对于飞行器受损等情况下,模型参数相较于标称模型具有较大的偏差时,则可能导致轨迹跟踪效果不理想。提出了基于参数估计的自适应轨迹跟踪算法,在模型预测静态规划（MPSP）的框架下得出解析解,实现了对参数的实时估计,据此更新跟踪模型预测静态规划算法中所使用的模型后,可以有效扩大对参数偏离的适应性,并保留模型预测静态规划计算效率高的特点。通过仿真对比得出,相较于已有的跟踪模型预测静态规划,改进后的算法对模型参数偏离的容忍性明显提高,且算法迭代效率高,适于在线应用。     

Adaptive robust cubature Kalman filtering for satellite attitude estimation

This paper is concerned with the adaptive robust cubature Kalman filtering problem for the case that the dynamics model error and the measurement model error exist simultaneously in the satellite attitude estimation system. By using Hubel-based robust filtering methodology to correct the measurement covariance formulation of cubature Kalman filter, the proposed filtering algorithm could effectively suppress the measurement model error. To further enhance this effect and reduce the impact of the dynamics model error, two different adaptively robust filtering algorithms, one with the optimal adaptive factor based on the estimated covariance matrix of the predicted residuals and the other with multiple fading factors based on strong tracking algorithm, are developed and applied for the satellite attitude estimation. The quaternion is employed to represent the global attitude parameter, and three-dimensional generalized Rodrigues parameters are introduced to define the local attitude error. A multiplicative quaternion error is derived from the local attitude error to maintain quaternion normalization constraint in the filter. Simulation results indicate that the proposed novel algorithm could exhibit higher accuracy and faster convergence compared with the multiplicative extended Kalman filter, the unscented quaternion estimator, and the adaptive robust unscented Kalman filter.     

Diffusion analysis of track loss in clutter

In tracking a target through clutter, the selection of incorrect measurements for track updating causes track divergence and eventual loss of track. The plot-to-track association algorithm is modeled as a Markov process and the tracking error is modeled as a diffusion process in order to study the mechanism of track loss analytically, without recourse to Monte Carlo simulations, for nearest-neighbor association in two space dimensions. The time evolution of the error distribution is examined, and the connection of the approach with diffusion theory is discussed. Explicit results showing the dependence of various performance parameters, such as mean time to lose track and track half-life, on the clutter spatial density are presented. The results indicate the existence of a critical density region in which the tracking performance degrades rapidly with increasing clutter density. An optimal gain adaptation procedure that significantly improves the tracking performance in the critical region is proposed     

航空发动机全程滑态变结构控制研究

一种新的滑模变结构控制方法-全程滑态变结构控制首次应用于航空发动机控制系统，该控制方法能有效地缩短系统状态到达滑动模态的时间，避免了定常滑态变结构控制系统在能达阶段对扰动的敏感性，且其控制律的设计可以改善系统的瞬态性能，克服未知参数摄动的影响，仿真结果表明，基于全程滑态变结构控制所设计的发动机控制系统，其鲁棒性要优于发动机定常滑态结构控制系统。     

基于声波传播时间估计的气流速度测量方法

 为实现对亚声速和超声速气流速度的统一测量,提出了一种基于声传感器的新型测量方法。首先,根据声波在亚声速和超声速气流中的传播特性,利用特定的测量装置建立了声波传播时间与气流速度之间的数学模型,从而将气流速度的测量问题转化为声波传播时间的测量问题。然后,在此基础上,利用计时法和最大似然估计(MLE)方法来估计声波传播时间;其中,计时法在实时性上优势明显,而MLE方法则在可靠性上优于前者。最后,分别从阵元位置扰动性、计时误差和克拉美-罗界(CRB)3个方面对所提算法的性能进行了分析与仿真验证。结果表明,该算法能够实现对亚声速和超声速气流速度的精确测量。     

Interacting multiple model fixed-lag smoothing algorithm forMarkovian switching systems

We investigate a suboptimal approach to the fixed-lag smoothing problem for Markovian switching systems. A fixed-lag smoothing algorithm is developed by applying the basic Interacting Multiple Model (IMM) approach to a state-augmented system. The computational load is roughly d (the fixed lag) times beyond that of filtering for the original system. In addition, an algorithm that approximates the “fixed-lag” mode probabilities given measurements up to current time is proposed. The algorithm is illustrated via a target tracking simulation example where a significant improvement over the filtering algorithm is achieved at the cost of a time delay (i.e., data up to time k are used to produce the smoothed state estimate at time k-d where the fixed large d>0). the IMM fixed-lag smoothing performance for the given example is comparable to that of an existing IMM fixed-interval smoother. Compared with fixed-interval smoothers, the fixed-lag smoothers can be implemented in real-time with a small delay     

基于改进SURF和P-KLT算法的特征点实时跟踪方法研究

 针对视频序列中运动目标的实时跟踪问题,提出一种基于改进SURF算法和金字塔KLT算法相结合的特征点跟踪方法。首先人工标定目标区域,利用改进的SURF算法分块快速提取具有高鲁棒性、独特性的特征点;然后在后续帧中应用金字塔KLT匹配算法对特征点进行稳定跟踪,采用基于统计的方法剔除错误匹配对;最后利用Greedy Snake分割算法提取轮廓确定更加精准的位置信息,更新目标区域。为使算法更具鲁棒性,还设计了离散点筛选、自适应更新策略。利用飞行视频数据库进行了大量的仿真,结果表明:该算法适用于多尺度图像序列中位置、姿态发生快速变化且结构简单的飞行器的稳定跟踪。帧平均时间为31.8 ms,比SIFT+P-KLT跟踪算法减少47.1%;帧几何中心、目标轮廓面积平均误差分别为5.03像素、16.3%,分别比GFTT+P-KLT跟踪算法减少27.2%、56.9%,比SIFT跟踪算法减少38.6%、68.4%。