Interlaced Kalman filtering of 3D angular motion based on Euler'snonlinear equations

A novel Kalman filtering technique is presented that reduces the mean-square-error (MSE) between three-dimensional (3D) actual angular velocity values and estimated ones by an order of magnitude (when compared with the MSE resulting from direct measurements) even under extremely low signal-to-noise ratio conditions. The filtering problem is nonlinear in nature because the dynamics of 3D angular motion are described by Euler's equations. This nonlinear set of differential equations state that the angular acceleration in one axis is proportional to the torque applied to that axis, and to the products of angular velocity components in the other two axes of rotation. Instead of using extended Kalman filtering techniques to solve this complex problem, the authors developed a new approach where the nonlinear Euler's model is decomposed into two pseudolinear models (primary and secondary). The first model describes the time progression of the state vector containing the linear terms, while the other characterizes the propagation of the state vector containing the nonlinearities. This makes it possible to run two interlaced discrete-linear Kalman filters simultaneously. One filter estimates the values of the state vector containing the linear terms, while the other estimates the values of the state vector containing the nonlinear terms in the system. These estimates are then recombined, solving the nonlinear estimation process without linearizing the system. Thus, the new approach takes advantage of the simplicity, computational efficiency and higher convergence speed of the linear Kalman filter form and it overcomes many of the drawbacks typical of conventional extended Kalman filtering techniques. The high performance and effectiveness of this method is demonstrated through a computer simulation case study     

基于B样条模型的参数化卡尔曼滤波器设计

以标准B样条函数为基础,建立了以位置、样条系数为状态变量的参数化卡尔曼滤波器,用于解决外测数据的实时滤波问题。按照时间更新跨节点与否,分2种情况给出了状态转移方程。在时间更新跨样条节点时,使用样条函数的一阶连续导数条件,估计新增样条节点系数,由此实现滤波器在跨节点处的平滑过渡。通过仿真数据对新方法进行验证,并与已有的2类典型滤波方法进行比较,结果表明,本方法的滤波精度与另一类直接基于弹道信号表示的样条递推滤波方法精度相当,且可表现出更优的收敛性。新方法具有样条参数化模型的相同优点,可对时域信号全时段建模,可利用先验信息设计弹道优选节点而实现滤波性能优化,缺点在于状态更新的策略较为复杂。     

Multiple-Model Probability Hypothesis Density Filter for Tracking Maneuvering Targets

Tracking multiple targets with uncertain target dynamics is a difficult problem, especially with nonlinear state and/or measurement equations. With multiple targets, representing the full posterior distribution over target states is not practical. The problem becomes even more complicated when the number of targets varies, in which case the dimensionality of the state space itself becomes a discrete random variable. The probability hypothesis density (PHD) filter, which propagates only the first-order statistical moment (the PHD) of the full target posterior, has been shown to be a computationally efficient solution to multitarget tracking problems with a varying number of targets. The integral of PHD in any region of the state space gives the expected number of targets in that region. With maneuvering targets, detecting and tracking the changes in the target motion model also become important. The target dynamic model uncertainty can be resolved by assuming multiple models for possible motion modes and then combining the mode-dependent estimates in a manner similar to the one used in the interacting multiple model (IMM) estimator. This paper propose a multiple-model implementation of the PHD filter, which approximates the PHD by a set of weighted random samples propagated over time using sequential Monte Carlo (SMC) methods. The resulting filter can handle nonlinear, non-Gaussian dynamics with uncertain model parameters in multisensor-multitarget tracking scenarios. Simulation results are presented to show the effectiveness of the proposed filter over single-model PHD filters.     

利用Singer模型的无陀螺姿态和角速度估计

 给出了一种利用Singer跟踪模型的扩展卡尔曼滤波器 (ExtendedKalmanFilter) ,用于无陀螺姿态和姿态角速度估计。在滤波器中 ,姿态和姿态误差分别由姿态四元数和误差四元数表示 ,而姿态角加速度由一阶Markov过程描述 ,从而避免采用姿态动力学模型。利用数值仿真计算验证了滤波器的性能。在所有的仿真过程 ,滤波器显示出快速收敛能力。稳态估计误差主要由测量更新频率和精度决定。     

飞机的模型参考容错控制

 本文针对飞机内部元件或控制元件的故障,用检测滤波器理论设计了相应的故障检测器和故障参数估计器,并用Lyapunov稳定性理论设计了模型参考自适应容错控制律,从而保证了在内部故障情况下飞行控制系统的稳定性。     

基于时间推进的涡扇发动机整机通流数值模拟

为实现航空发动机整机流场与性能快速分析,基于准三维控制方程模型,开发了整机通流数值模拟程序。程序基于计算流体力学理论,并考虑了引气、冷却和喷油等发动机中的物理现象。为模拟叶片对气流偏转作用,推导了一种鲁棒的无粘叶片力模型,同时采用粘性力模型模拟粘性损失效应。采用该程序对某型双轴分排涡扇发动机一个地面试车工况点进行了整机数值仿真,并与实验数据进行了对比验证。结果表明,所发展程序求解稳定,能够自动捕捉激波,并且可以快速获得完全收敛的航空发动机整机准三维流场,单工况点计算时长不大于30min。其中计算截面平均参数与实验测量偏差不大于8%,符合工程应用精度需求。     

基于双视线测量的相对导航方法

对非合作目标自主交会中的中远程相对导航问题进行研究.首先,给出二阶近似的航天器相对轨道动力学方程,并对视线(LOS)导航方法的可观测性进行了分析.然后,提出基于双视线测量的相对导航方案.该导航方案中,系统过程噪声模型采用适用于航天器远距离相对运动的轨道动力学方程;量测量包括目标对两个追踪航天器的视线角和追踪航天器之间的...     

Nonlinear modeling of integrally actuated beams

A set of nonlinear, intrinsic equations describing the dynamics of beam structures undergoing large deformations is presented. The intrinsic kinematical equations are derived for the general case of a moving beam. Active force/strain terms are added to the equations to take into account active components. The equations are then discretized into finite elements, transformed into state-space form and finally decomposed into modes. Actuation and sensor models are established before implementing a simulation model in Matlab/SIMULINK. The model is validated by comparison with exact, analytical results and then used to analyze the dynamic behavior of an active helicopter blade in vacuum. Beside the analysis of the inherent dynamics of this system in terms of eigenvalues and vectors, the influence of centrifugal stiffening on the modal controllability of the blade is discussed. Finally, the design of a MIMO controller based on full-state optimal control (LQR approach) and optimal state estimation (Kalman filter) is presented with the aim to add vibrational damping to the weakly damped system. The closed loop properties are validated by both analytical methods and simulation runs.     

大型挠性充液卫星的动力学模型

研究了带有多个挠性附件和液体燃料贮箱的中继卫星系统的动力学建模问题。给出了微重力下小幅线性晃动等效模型基本参数，用混合坐标法描述中继卫星系统的构形，利用虚功原理推导出的矩阵形式的中继卫星动力学模型简洁且具有一般性，适用于许多开链飞行器系统。     

自适应无迹增量滤波方法

提出自适应无迹增量滤波(AUIF)的概念和定义,建立自适应无迹增量滤波模型及其分析方法,给出递推算法.传统的滤波方法极少关注量测方程的系统误差.在许多实际情况(如深空探测),量测方程由于受环境因素及测量设备不稳定等影响往往无法进行验证或校准而存在未知的系统误差,并且模型参数和噪声统计量也具有不确定性.这种不确定性会使递推过程产生较大误差,甚至导致发散,从而降低滤波精度.提出的AUIF能够成功消除这种未知的系统误差,也能够实时估计变化的噪声统计量,提高滤波精度.该方法计算简单,便于工程应用.      

Alpha-beta filters in polar coordinates with accelerationcorrections

The use of polar coordinates is sometimes computationally advantageous for tracking, but complications arise because the position of constant velocity targets is no longer a linear function of time as it is for cartesian coordinates. However, this difficulty can be avoided by using pseudoacceleration correction factors which are added to the prediction equations to give approximately correct system dynamics, but at the expense of an increase in system noise. For alpha-beta tracking filters, these correction factors can be included with minimal degradation in the steady-state error performance of the filter while simultaneously providing substantial reductions in bias errors     

Discrete-time min-max tracking

The problem of optimal state estimation of linear discrete-time systems with measured outputs that are corrupted by additive white noise is addressed. Such estimation is often encountered in problems of target tracking where the target dynamics is driven by finite energy signals, whereas the measurement noise is approximated by white noise. The relevant cost function for such tracking problems is the expected value of the standard H/sub /spl infin// performance index, with respect to the measurement noise statistics. The estimator, serving as a tracking filter, tries to minimize the mean-square estimation error, and the exogenous disturbance, which may represent the target maneuvers, tries to maximize this error while being penalized for its energy. The solution, which is obtained by completing the cost function to squares, is shown to satisfy also the matrix version of the maximum principle. The solution is derived in terms of two coupled Riccati difference equations from which the filter gains are derived. In the case where an infinite penalty is imposed on the energy of the exogenous disturbance, the celebrated discrete-time Kalman filter is recovered. A local iterations scheme which is based on linear matrix inequalities is proposed to solve these equations. An illustrative example is given where the velocity of a maneuvering target has to be estimated utilizing noisy measurements of the target position.     

几何非线性机翼本征梁元素模型的高效化改进

 采用Hodges等提出的时间-空间离散化的几何精确非线性本征梁通用模型处理柔性机翼结构动力学问题时,当离散化的节点数增大时,该方法的未知数数量成倍地增长,而且方程组是严重病态的,因此数值模拟计算的速度非常缓慢。针对机翼中最常见的悬臂梁结构,根据空间离散化的边界条件,提出了空间缩聚法把空间离散差分方程缩聚为常系数矩阵格式,得到了只与时间相关的微分方程组,进一步推导得到了该方程组的雅可比矩阵,因而大大减少了方程组的数量以及求解过程的循环和迭代步数。采用Gear方法分别求解了原始的本征梁元素模型和本文提出的缩聚模型,结果表明空间缩聚模型在相同条件下可提高运算速度约5.1倍,而且对不同类型的外载荷都具有较好的通用性、稳定性和高效性。     

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.     

惯性参数不确定的自由漂浮空间机器人自适应控制研究

针对自由漂浮空间机器人系统惯性参数不确定问题,提出一种笛卡儿空间内的自适应轨迹跟踪控制方法。采用扩展机械臂模型建立了自由漂浮空间机器人关节空间动力学方程,进而推导笛卡儿空间中的自由漂浮空间机器人动力学方程。在基于逆动力学法的自由漂浮空间机器人自适应控制器设计中,利用标称控制器离线固定控制参数与补偿控制器在线补偿方法,既可以保证惯量矩阵可逆,又可以使控制参数实时估计。采用Lyapunov方法的稳定性分析表明系统是稳定且渐进收敛的。最后,应用该控制方法对两杆平面自由漂浮空间机器人进行了仿真研究。仿真结果显示自由漂浮空间机器人末端执行器在笛卡儿空间具有良好的轨迹跟踪能力。     

一种新的基于机动检测的机动目标跟踪算法

针对Kalman滤波跟踪机动目标发散和目前多数自适应Kalman滤波算法对运动模型适应性不强的问题,提出了一种新的基于机动检测的机动目标跟踪算法,通过实时自适应的改变滤波模型提高对机动目标跟踪精度。对这种方法与Kalman滤波算法进行了计算机仿真比较,结果表明,该方法计算量小,可实时精确地自适应匹配目标的运动模型,可实现对机动目标稳定可靠的跟踪。     

自适应增量粒子滤波方法

提出自适应增量粒子滤波(AIPF)的概念和定义,建立AIPF模型,给出了分析方法和主要的计算步骤.对于许多实际工程(如深空探测)中存在的由未知系统误差的影响而无法精确建立量测似然函数及滤波过程中的粒子匮乏等问题,通过增量粒子滤波模型对滤波过程中的粒子数进行自适应调整,从而消除这种未知系统和滤波粒子匮乏的影响,自动调整粒子,提高非线性滤波的精度.仿真计算中,滤波误差均值和方差分别降低为原来的3.8%和19.6%.该方法有效地改善了滤波效果,计算简单,便于工程应用.      

广义预测自适应控制器在导弹控制系统设计中应用

将一种新的广义预测自适应控制算法应用于快速时变的导弹控制系统设计中。讨论了设计参数对控制系统性能的影响;针对自适应控制信号过大,提出了改进方案,增强了系统的鲁棒性和抗干扰能力。大量的数字仿真结果表明:运用该方案设计的导弹控制系统具有很好的跟踪性能和强的抗干扰能力;对系统阶次、参数、时延和采样周期的变化具有很强的鲁棒性;自适应算法中,对验前知识要求少,实现起来也比较简单。     

Road-map assisted ground moving target tracking

Tracking ground targets with airborne GMTI (ground moving target indicator) sensor measurements proves to be a challenging task due to high target density, high clutter, and low visibility. The exploitation of nonstandard background information such as road maps and terrain information is therefore highly desirable for the enhancement of track quality and track continuity. The present paper presents a Bayesian approach to incorporate such information consistently. It is particularly suited to deal with winding roads and networks of roads. The target dynamics is modeled in quasi one-dimensional road coordinates and mapped onto ground coordinates using linear road segments taking road map errors into account. The case of several intersecting roads with different characteristics, such as mean curvature, slope, or visibility, is treated within an interacting multiple model (IMM) scheme. Targets can be masked both by the clutter notch of the sensor and by terrain obstacles. Both effects are modeled using a sensor-target state dependent detection probability. The iterative filter equations are formulated within a framework of Gaussian sum approximations on the one hand and a particle filter approach on the other hand. Simulation results for single targets taken from a realistic ground scenario show strongly reduced target location errors compared with the case of neglecting road-map information. By modeling the clutter notch of the GMTI sensor, early detection of stopping targets is demonstrated     

A Celestial Analytic Positioning Method by Stellar Horizon Atmospheric Refraction

This article, in allusion to the limitation of conventional stellar horizon atmospheric refraction based on orbital dynamics model and nonlinear Kalman filter in practical applications, proposes a new celestial analytic positioning method by stellar horizon atmospheric refraction for high-altitude flight vehicles, such as spacecraft, airplanes and ballistic missiles. First, by setting up the geometric connexion among the flight vehicle, the Earth and the altitude of starlight refraction, an expression for the relationship of starlight refraction angle and atmospheric density is deduced. Second, there are produced a novel measurement model of starlight refraction in a continuous range of altitudes (CRA) from 20 km to 50 km on the basis of the standard atmospheric data in stratosphere, and an empirical formula of stellar horizon atmospheric refraction in the same altitudes against the tangent altitude. Third, there is introduced a celestial analytic positioning algorithm, which uses the least square differential correction instead of nonlinear Kalman filter. The information about positions of a flight vehicle can be obtained directly by solving a set of nonlinear measurement equations. The stellar positioning algorithm adopts the characteristics of stellar horizon atmospheric refraction thereby removing needs for orbit dynamics models and priori knowledge of flight vehicles. The simulation results evidence the validity of the proposed stellar positioning algorithm.