基于四元数误差模型的捷联惯导系统对准方法

传统的小干扰方程并不能描述捷联惯导系统在大失准角下的误差传播特性 ,推导了姿态误差为大角度时的四元数误差方程 ,并指出当姿态误差为小量时 ,所推导的误差模型与小干扰方程是等价的。仿真结果表明在大失准角下的空中对准过程中 ,采用四元数误差方程以及非线性滤波技术能有效地提高对准精度     

Strapdown INS error model for multiposition alignment

The relationship between quaternion errors and tilt angles from true navigation frame to analytic platform frame is newly derived for strapdown inertial navigation system (SDINS). Using the relationship it is shown that the quaternion error model for attitude and velocity is equivalent to the conventional perturbation error model. Based upon the equivalency, the quaternion errors during a multiposition alignment are determined and analyzed. Furthermore, it is shown that the heading rotation of 180 deg achieves the minimal quaternion error for 2-position ground alignment     

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

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

Strapdown inertial navigation using dual quaternion algebra: error analysis

In a strapdown inertial navigation system (INS), the general displacement of a rigid body is traditionally separately modeled and analyzed, i.e., direction cosine matrix or quaternion for rotation analysis and vector for translation analysis. As a subsequent work of a companion paper (Wu et al., 2005), this paper adopts dual quaternion algebra, a most concise and unified mathematical tool for representing the general displacement of a rigid body, to analyze error characteristics of the strapdown INS. Two new error models in terms of quaternion algebra are developed: the additive dual quaternion error (ADQE) model and multiplicative dual quaternion error (MDQE) model. Both are expected to facilitate the future inertial navigation-based integrated navigation filter.     

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.     

Nonlinear robust observer design for strapdown INS in-flight alignment

A nonlinear observer is proposed for a strapdown inertial navigation system (SDINS) in-flight alignment problem using an H/sub /spl infin// filter Riccati equation and a freedom parameter. The proposed observer improves the filtering stability, convergence, and performance. The characteristics of the observer are analyzed using a Lyapunov function. Simulation results demonstrate a significant reduction in alignment errors by employing the proposed nonlinear observer. The observer is developed in general such that it can be applied to estimating nonlinear systems other than the SDINS in-flight alignment.     

Modeling quaternion errors in SDINS: computer frame approach

We propose new equivalent tilt error models which are applicable to the analysis of the terrestrial strapdown inertial navigation systems (SDINS), based on the quaternions. The currently available equivalent tilt error models, like the conventional Φ model of the gimbaled inertial navigation systems (GINS), are derived only by the true frame approach. The true frame approach has a computational disadvantage that it produces an error model where the attitude error equation is coupled with its position and velocity error equations. The motivation of this work is to solve this problem. As a result, two kinds of error models are derived. Among them, one is derived by the computer frame approach for practical onboard implementations. Thus, like the conventional GINS Ψ model, its attitude error equation is decoupled from the position and velocity error equations. The other is derived in order to show the relationship between the true frame approach and the computer frame approach which are applied to the quaternion-based SDINS. Thus, like the GINS δΘ model, it can be used to transform the error variables into each other which are calculated by the two different approaches     

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

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

大航向角误差情况下飞行中对准研究

为了解决飞行器在大航向角误差的情况下进行飞行中对准的难题,将一种线性大航向角误差模型应用于飞行器飞行中对准的过程.详细推导了线性大航向角误差模型,设计了飞行器在大航向角误差情况下进行飞行中对准的卡尔曼滤波模型,并进行了数字仿真.仿真结果表明,线性大航向角误差模型应用于飞行器飞行中对准,能够很好地解决飞行器在大航向角误差情况下进行对准的难点,并给出了适合于大航向角误差模型的机动方式.最后,提出了线性大航向角误差模型在工程应用中的几点建议     

Novel quaternion Kalman filter

This paper presents a novel Kalman filter (KF) for estimating the attitude-quaternion as well as gyro random drifts from vector measurements. Employing a special manipulation on the measurement equation results in a linear pseudo-measurement equation whose error is state-dependent. Because the quaternion kinematics equation is linear, the combination of the two yields a linear KF that eliminates the usual linearization procedure and is less sensitive to initial estimation errors. General accurate expressions for the covariance matrices of the system state-dependent noises are developed. In addition, an analysis shows how to compute these covariance matrices efficiently. An adaptive version of the filter is also developed to handle modeling errors of the dynamic system noise statistics. Monte-Carlo simulations are carried out that demonstrate the efficiency of both versions of the filter. In the particular case of high initial estimation errors, a typical extended Kalman filter (EKF) fails to converge whereas the proposed filter succeeds.     

空间飞行器大角度机动飞行的变结构姿态控制

研究了空间飞行器大角度机动飞行的变结构姿态控制。应用四元数来描述姿态运动，以消除大角度机动飞行时欧拉角描述所存在的奇异性。基于Lyapunov方法设计了变结构控制的切换函数，以保证系统的滑动模态．亦即四元数偏差的稳定性。基于所给切换函数，设计了变结构控制器。数值仿真的结果说明了设计方法的有效性。     

用于微机械捷联式航姿系统的四元素算法卡尔曼滤波器

介绍了一种卡尔曼滤波器 ,它适用于由微机械惯性传感器构成的捷联式航姿系统。文中阐述了系统构成和原理 ,基于四元素算法公式推导了姿态算法和系统误差模型 ,并设计了实时卡尔曼滤波器。仿真结果表明 ,当没有横向加速度干扰时系统精度优于 0 .0 4度 ,当出现 0 .1g/1Hz的横向交变加速度干扰时 ,精度降为 0 .4 4度。初步测试结果表明系统的静态精度为 :俯仰和横滚 /-0 .2度 ,航向 /- 0 .3度。     

基于对偶四元数的INS/GPS组合导航算法研究

在基于对偶四元数的捷联惯导解算方法的基础上,推导了以惯性系作为导航系的惯导误差方程,在此基础上设计了卡尔曼滤波组合导航算法。通过激光惯导跑车采集数据,进行了仿真分析,试验结果表明,该组合导航算法能有效的消除惯导累积的速度误差和位置误差,相比于目前广泛应用的INS/GPS组合导航算法,本文描述了INS/GPS组合导航的另一种实现方式,获得了相当的精度,具有一定的工程应用价值。     

Regularized Robust Filter for Spacecraft Attitude Determination

A modified regularized robust filter is proposed for spacecraft attitude determination in the presence of relative misalignment of attitude sensors. The filter is designed to minimize the worst-possible residual norm on condition that there is parametric uncertainty in the measurement model. The weighting matrix of the residual norm is designed to minimize the upper bound of the estimation error variance. The performance of the proposed attitude determination robust filter is illustrated with the use of real test data from a real three-floated gyroscope. Simulation results demonstrate that the attitude estimation accuracy is improved by using the proposed algorithm.     

挠性航天器的退步直接自适应姿态跟踪控制

针对参数不确定的挠性航天器姿态跟踪控制问题,提出了一种退步直接自适应控制算法。首先验证了挠性航天器动力学子系统的近似严格正实性,并设计了具有理想控制性能的参考模型;然后对以姿态四元数描述的运动学子系统设计常系数输出反馈中间控制律,使航天器姿态四元数输出渐近跟踪参考模型输出;最后退一步,对具有参数不确定特性的动力学子系统,基于非线性直接自适应控制理论和Lyapunov稳定性理论,设计了退步直接自适应姿态跟踪控制器,并证明了闭环系统的稳定性。仿真结果表明,所提控制方法能有效抑制挠性附件的振动,对挠性航天器的控制是有效的。     

基于变结构控制器的敏捷卫星姿态机动方法

随着遥感卫星观测能力的逐步提升,对卫星敏捷机动能力提出了更高的要求。针对敏捷卫星大角度姿态机动问题,以6个单框架控制力矩陀螺(SGCMG)组成五棱锥构型的姿态控制系统执行机构,在构建敏捷卫星姿态运动数学模型以及设计SGCMG系统操纵律的基础上,对卫星绕Euler轴进行姿态机动的角轨迹进行规划,并设计了一种基于误差四元数与误差角速度的变结构控制器。仿真及在轨验证结果表明,该控制器能够完成规划轨迹的良好跟踪且具有较强的鲁棒性,研究成果对敏捷卫星姿态控制系统的设计具有重要的参考意义。     

一种非线性滤波器的误差分析及应用

针对一类具有未建模误差和扰动的非线性系统的状态估计问题,提出一种在线估计并补偿模型误差的非线性滤波算法,该算法利用非线性预测滤波(NPF)基于预测输出残差的方差最小的基本原则估计模型误差,冉利用扩展卡尔曼滤波(EKF)的思想对补偿后的模型进行状态估计;详细推导了状态估计误差及其方差阵的传播模型.以卫星姿态确定系统为例,...     

Installation error calibration for MEMS angular measurement system in hypersonic wind tunnel

The accuracy of model attitude measurement has an important impact on wind tunnel test results. Microelectromechanical System Inertial Measurement Unit (MEMS IMU) provides a feasible way to measure model attitudes with high accuracy. However, the installation error between MEMS IMU coordinate system and the body coordinate system of test models can make the accuracy of the model attitude measurement decrease. In wind tunnel tests, the installation error depends on the relationship between the IMU and the model mechanism before tests. Therefore, in-field calibration in wind tunnel tests is necessary to reduce installation errors. To improve attitude measurement accuracy, the least squares quaternion calibration method based on MEMS IMU and six-position calibration procedure are proposed. High-precision three-axis turntable tests are performed. The pitch accuracy after calibration is higher than that before calibration in the angle of attack sweeping tests. The Root-Mean-Square Errors (RMSE) in the roll and yaw are within 0.01°, which are smaller than those before calibration. In the roll sweeping tests, RMSE of three attitude angles decrease significantly. In hypersonic wind tunnel tests, the pitch errors before and after calibration are within 0.05° and 0.02° in the angle of attack sweeping tests without wind. In five angle of attack sweeping tests with wind, the deviation between the mean of the pitch and the pitch after the elastic angle correction is within 0.03° and the standard deviation of five tests is within 0.01°. The proposed method is confirmed to enhance the accuracy of attitude measurement effectively, which is convenient for engineering applications.     

一种基于NGA-QPF的航天器姿态估计方法

针对航天器姿态确定中的非线性非高斯的滤波问题,提出一种基于遗传算法的粒子滤波的航天器姿态估计方法。该方法将姿态四元数作为采样粒子进行粒子滤波,并将小生境遗传算法（NGA）引入粒子滤波算法中,以改善粒子滤波的性能;用遗传算法单独进行陀螺偏差估计,以减少粒子滤波的状态维数。该姿态估计方法保持了四元数的归一化性质,通过引入小生境遗传算法解决了重采样阶段的粒子退化问题,并且由于单独估计陀螺偏差避免了粒子滤波状态的扩展。该方法能够在较少粒子的情况下实现高效率高精度的定姿,仿真结果说明了方法的有效性。     

Performance Bounds for Continuous-time Filters in the Presence of Modeling Errors

We are concerned with obtaining bounds on the performance of Kalman-type, linear, continuous-time filters susceptible to modeling errors. Limiting the discussion to stationary performance, we obtain bounds on the performance index, the mean square error of estimates for suboptimal and optimal (Kalman) filters. The bounds are expressed in terms of the model matrices and the range of errors of the matrices. The results are useful to a designer in comparing the performance of a suboptimal filter with that of the optimal filter when he has information on the range of modeling errors. The tightness of the bounds is shown by an application of the results in the estimation of the motion of an aircraft carrier at sea.