Multiposition alignment of strapdown inertial navigation system

The authors demonstrate that the stationary alignment of strapdown inertial navigation system (SDINS) can be improved by employing the multiposition/technique. Using an observability analysis, it is shown that an optimal two-position alignment not only satisfies complete observability conditions but also minimizes alignment errors. This is done by analytic rank testing of the stripped observability matrix and numerical calculation of the error covariance. It is also shown that an optimal three-position alignment accelerates the convergence of the alignment error compared with two-position alignment     

鲁棒EKF在脉冲星导航系统中的应用

针对脉冲星导航系统的滤波问题,传统的扩展卡尔曼滤波(EKF)算法存在不能克服系统模型存在不确定性参数以及乘性噪声等缺陷,提出一种鲁棒EKF算法。首先,分析了状态预测误差方程和估计误差方程,利用统计学原理,得到了状态预测方差矩阵和状态估计方差矩阵计算等式。由于系统模型存在不确定性参数,状态预测协方差矩阵和状态估计协方差矩阵无法计算;因此,利用4个重要矩阵不等式,分析并找到预测方差矩阵和状态估计方差矩阵的上界。最后,利用状态估计误差协方差矩阵上界设计状态增益矩阵,使得状态估计协方差矩阵的迹最小。将该算法对脉冲星导航系统进行仿真,仿真结果验证了所提算法的有效性。     

基于奇异值分解的组合导航可观测度计算

以捷联惯组为主惯导的组合导航系统具有短时定位精度高、可靠性强等优点,但其依然存在长时间导航精度不高、运算量大、组合效率不高等问题。为更好地完善组合导航系统的误差补偿和抑制技术,对SINS/DVL组合导航系统的可观测性能进行了研究。在分段定常系统(Piece-wise Constant System,PWCS)的可观测性分析方法及基于奇异值分解的系统状态可观测度分析方法基础上,结合可观测性矩阵的遗传特性,提出了一种简化的状态量可观测性分析方法,并对该方法进行了理论仿真。为方便比较状态量的可观测程度,对各状态的可观测度进行了归一化处理。最后,通过湖面跑船实验设计了不同的航迹机动方式,计算了关键导航参数的可观测性能。实验证明,该方法可以实时计算组合导航参数的可观测度,根据可观测度设计的航迹可以有效提高导航精度,定位精度可提高1个量级,收敛速度也获得了明显提高。     

Ballistic missile track initiation from satellite observations

An algorithm is presented to initiate tracks of a ballistic missile in the initial exoatmospheric phase, using line of sight (LOS) measurements from one or more moving platforms (typically satellites). The major feature of this problem is the poor target motion observability which results in a very ill-conditioned estimation problem. The Gauss-Newton iterative least squares minimization algorithm for estimating the state of a nonlinear deterministic system with nonlinear noisy measurements has been previously applied to the problem of angles-only orbit determination using more than three observations. A major shortcoming of this approach is that convergence of the algorithm depends strongly on the initial guess. By using the more sophisticated Levenberg-Marquardt method in place of the simpler Gauss-Newton algorithm and by developing robust new methods for obtaining the initial guess in both single and multiple satellite scenarios, the above mentioned difficulties have been overcome. In addition, an expression for the Cramer-Rao lower bound (CRLB) on the error covariance matrix of the estimate is derived. We also incorporate additional partial information as an extra pseudomeasurement and determine a modified maximum likelihood (ML) estimate of the target state and the associated bound on the covariance matrix. In most practical situations, probabilistic models of the target altitude and/or speed at the initial point constitute the most useful additional information. Monte Carlo simulation studies on some typical scenarios were performed, and the results indicate that the estimation errors are commensurate with the theoretical lower bounds, thus illustrating that the proposed estimators are efficient     

传统组合导航中的实用Kalman滤波技术评述

在随机线性系统建模准确的情况下,Kalman滤波是线性最小方差无偏估计。针对传统惯导/卫导组合导航的实际应用,难以精确建模,给出了常用的建模方法、状态量选取原则、离散化方法及滤波快速计算方法。讨论了平方根滤波、自适应滤波、联邦滤波和非线性滤波等技术的适用场合,并给出了使用建议。针对前人研究可观测度中未考虑随机系统噪声的缺陷,提出了更加合理的以初始状态均方误差阵为参考的可观测度定义和分析方法。提出了均方误差阵边界限制方法,可有效抑制滤波器的过度收敛和滤波发散。该讨论可为工程技术人员提供一些有实用价值的参考。     

基于双捷联算法的POS误差在线标定方法

为了提升位置和姿态测量系统(POS)的精度,结合POS工作过程中典型的匀速直线运动,提出了一种准实时的POS误差在线标定方法。首先设计了基于双捷联算法的在线标定方案,对系统误差方程进行简化处理,求出中时期导航条件下的系统误差状态转移阵。然后根据POS的两段相邻匀速直线运动导航误差,对系统误差参数进行在线标定,并通过可观测性分析得出POS运动与系统误差在线标定效果之间的对应关系。车载试验和飞行试验结果表明,在POS正常遥感作业过程中,本文提出的在线标定方法能够有效提升系统精度。     

优化抗差自适应滤波器在深组合导航中的应用

为了提高惯性/卫星深组合导航系统的滤波性能,在抗差自适应滤波算法的 基础上,研究了一种优化抗差自适应滤波算法。该算法通过比较实际预测残差协方差矩 阵和理论协方差阵的差值来生成自适应因子,从而优化抗差自适应滤波。将所研究的算 法应用于惯性/卫星深组合导航系统, 在高动态环境下进行仿真验证, 并与常规卡尔曼 滤波、抗差自适应滤波进行比较。结果表明,优化算法能有效地控制观测异常和动态模 型异常对状态参数估值的影响,所得组合导航位置误差和速度误差明显减小,提高了组 合导航系统的滤波精度。     

Discrete-time state estimation of analog double integrators

The problem of minimum variance discrete-time state estimation of a continuous-time double integrator via noisy continuous-time measurements is considered. The error covariance matrices of this estimation are calculated and analyzed. The relations between these covariance matrices and the error covariance matrix of the optimal continuous-time filter are obtained, and a way for determining the required sampling period is proposed. A commonly used approximated model is investigated; it is shown to be inappropriate unless a specific improvement is introduced in the model     

跟飞编队卫星相对导航自适应EKF算法研究

针对跟踪星对目标星跟飞编队的相对导航问题,提出了基于自适应扩展卡尔曼滤波（EKF）的相对导航算法。以线性离散化的椭圆参考轨道相对动力学模型为导航状态方程．设计了虚拟测量量及相应的测量矩阵,避免了求解雅可比矩阵的复杂计算。为了适应构型尺寸变化引起的模型误差变化,提出了模型误差在线估计算法。仿真显示,算法具有较快的收敛速度和较高的估计精度。该研究成果可作为卫星编队应用的有益参考。     

多渐消因子Kalman滤波器在SINS初始对准中的应用(英文)

针对系统模型和统计信息不能精确已知的条件下Kalman滤波无法给出最优解这一问题,单一渐消因子Kalman滤波算法对于简单的系统是有效的,但是对于复杂的多变量系统,仅仅利用单个的渐消因子是不够的。本文提出了一种多渐消因子滤波算法,通过利用开窗法计算新息序列协方差的无偏估计获得渐消因子矩阵。利用渐消因子矩阵调节一步预测均方误差矩阵k|k1P,对不同的滤波通道提供不同的渐消速率。将该方法应用于SINS的初始对准中,仿真和试验结果表明:当真实系统噪声统计特性同设定参数不一致时,对准精度明显高于其他滤波算法。其对不确定性噪声具有较低的敏感度,对系统参数具有较好的滤波效果。因而,在实际应用中具有重要的参考价值。     

双轴连续旋转调制捷联惯导系统大失准角初始对准技术

由于可以补偿惯性器件在三个轴向上的输出误差，双轴旋转调制技术被广泛应用于捷联惯导系统(SINS)。选择了一种合理且实用的十六次序双轴转位方案，并对其调制原理和误差进行了分析。初始对准技术是捷联惯导系统的一项重要技术，其对准精度直接决定了后续导航的精度。在粗对准完成后，当姿态误差角较大时，后续的精对准误差模型呈非线性特性，故选择了滤波精度高、稳定性强的平方根容积Kalman滤波算法(SCKF)来解决这一问题。考虑到在实际对准过程中，量测噪声的统计特性易发生变化，将SCKF算法与Sage-Husa算法相结合，在传统Sage-Husa SCKF算法的基础上提出了一种改进的自适应滤波算法(ASCKF)。该算法采用QR分解来完成对噪声协方差的平方根矩阵估计，从而避免了传统Sage-Husa SCKF算法中所估噪声协方差矩阵不正定的问题。最后，通过仿真证实了ASCKF算法可被很好地应用于量测噪声统计特性发生变化的初始对准中。     

系统误差条件下的多运动站无源定位性能分析

 系统误差的存在可能对无源定位的性能带来较大影响。针对多运动站得到的含有系统误差的观测量信息,推导了定位误差的克拉美-罗下限(CRLB)。首先根据具体系统误差模型推导测量误差的统计信息,然后根据系统误差导致不同时刻观测量相关的特点,将非对角矩阵的误差协方差矩阵写为分块矩阵的形式,并在此基础上推导其递推计算式,最后以系统误差情况下多运动站只测角无源定位为例进行定位性能的仿真分析。仿真结果表明系统误差的存在对定位误差CRLB影响较大,在定位中需要重点考虑。     

Analytical Results for the x, y Kalman Tracking Filter

A two-dimensional x, y Kalman tracking filter is analyzed for a track-while-scan (TWS) operation when the radar sensor measures range and bearing (r, ?) at uniform sampling intervals T seconds apart. This development explicitly considers the coupling between the quantities measured by the sensor (r, ?) and the Cartesian x, y coordinate system selected for the tracking operation. The steadystate components of the gain and error covariance matrixes are analytically determined under the assumption of a white noise maneuver acceleration model in two dimensions. These results are verified by computer calculation of the Kalman filter matrix equations.     

Observability analysis of piece-wise constant systems. I. Theory

For pt.II see ibid., vol.28, no.4, p.1068-75, Oct. 1992. A method for analyzing the observability of time-varying linear systems which can be modeled as piece-wise constant systems (PWCS) is presented. An observability matrix for such systems is developed for continuous and discrete time representations. A stripped observability matrix (SOM) is introduced which simplifies the analysis in cases where the use of this matrix is legitimate. The observability analysis is presented as a step-by-step procedure     

高空长航时无人机SINS/CNS组合导航系统仿真研究

根据高空长航时无人机的特点研究了SINS/CNS组合导航系统并进行了仿真。研究了分段定常系统(PWCS)的可观测性分析方法和基于奇异值分解的系统状态可观测度分析问题,并提出了一种改进的状态可观测度分析方法,在求状态变量的可观测度时,抛开了观测量,只利用可观测矩阵进行分析,然后将该理论应用到SINS/CNS组合导航系统中,证明了其合理性与可行性,进一步根据可观测度分析的结果对系统进行反馈校正,通过仿真结果证明导航精度得到了提高。     

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.     

Kalman filtering for matrix estimation

A general discrete-time Kalman filter (KF) for state matrix estimation using matrix measurements is presented. The new algorithm evaluates the state matrix estimate and the estimation error covariance matrix in terms of the original system matrices. The proposed algorithm naturally fits systems which are most conveniently described by matrix process and measurement equations. Its formulation uses a compact notation for aiding both intuition and mathematical manipulation. It is a straightforward extension of the classical KF, and includes as special cases other matrix filters that were developed in the past. Beyond the analytical value of the matrix filter, it is shown through various examples arising in engineering problems that this filter can be computationally more efficient than its vectorized version.     

离散不确定系统的优化鲁棒滤波方法及在飞行试验中的应用

提出了一种离散系统的优化鲁棒滤波方法。为了得到滤波的逼近计算式，通过优化加权矩阵得到了上界不等式逼近和等效系统矩阵，得到了鲁棒滤波的时间更新算法；通过优化加权矩阵得到了下界不等式逼近和等效观测矩阵，得到了鲁棒滤波的测量更新算珐，并且给出了鲁棒滤波算法收敛的条件。飞行试验数据处理的结果表明，提出的方法是有效的。     

基于改进联邦Kalman滤波的组合校准方法研究

联邦滤波器广泛应用于多传感器信息融合领域,联邦滤波中的信息分配原则影响滤波精度.针对联邦Kalman滤波器进行改进,采用基于估计协方差阵奇异值动态确定信息分配系数.对子滤波器进行重置时,采用新的重置方法,保证了子滤波器误差协方差阵的对称性,确保Kalman滤波器的一致收敛稳定性.新的联邦滤波算法允许每个状态分量拥有不同的动态信息分配因子,从而改进了联邦滤波信息融合的精度.设计了SINS/GPS/电子罗盘组合导航系统,仿真结果说明,与传统联邦滤波算法相比,改进的联邦滤波器估计精度得到了提高,可以更好地对SINS误差进行校准,提高系统的精度.     

基于FPGA的自适应阵列协方差矩阵特征分解的实现

卫星导航抗干扰的过程中，对空间信号波达方向估计、干扰个数检测、最优权矢量的求解直接影响着导航接收机的抗干扰性能，而协方差矩阵的特征分解是这些算法实现的核心部分。根据自适应阵列天线获得的协方差矩阵的特性，基于双边并行Jacobi算法，实现了基于FPGA的协方差矩阵特征值和特征向量的求解，并通过在信号波达方向估计的应用进行了验证。另外，在实现的过程中对直接调用CORDIC IP核的方式进行了精度误差分析，并用一种双精度浮点的方式进行修正，提高了矩阵特征分解FPGA的实现精度，为导航抗干扰接收机性能的提升提供了有效的工程基础。