The integration of strap-down INS and GPS based on adaptive error damping

The concept and results of integration of a strap-down inertial navigation system (INS) based on low-accuracy inertial sensors and the global positioning system (GPS) have been presented in this paper. This system is aimed for the purposes of navigation, automatic control, and remote tracking of land vehicles. The integration is made by the implementation of an extended Kalman filter (EKF) scheme for both the initial alignment and navigation phases. Traditional integration schemes (centralized and cascaded) are dominantly based on the usage of high-accuracy inertial sensors. The idea behind the suggested algorithm is to use low-accuracy inertial sensors and the GPS as the main source of navigation information, while the acceptable accuracy of INS is achieved by the proper damping of INS errors. The main advantage of integration consists in the availability of reliable navigation parameters during the intervals of absence of GPS data. The influence of INS error damping coefficients is different depending on the fact whether the moving object is maneuvering or is moving with a constant velocity at that time. It is proposed that INS error damping gain coefficients generally should take higher values always when GPS data are absent, while at the same time their values in the error model (EKF prediction phase) can be additionally adapted according to the actual values of vehicle acceleration. The analysis of integrated navigation system performances is made experimentally. The data are acquired along the real land vehicle’s trajectory while the intervals of absence of GPS data are introduced artificially on the parts characterized both by maneuver and by constant velocity.     

一种模糊QR滤波及在组合导航中的仿真研究

总结了常用的自适应滤波的方法，并提出了一种基于模糊逻辑的自适应卡尔曼滤波技术，用模糊逻辑自适应推理器来“在线”修正卡尔曼滤波系统噪声协方差Q和测量噪声协方差R，从而使滤波器不断执行最优估计。仿真结果表明该方法可以提高GPS／INS组合导航系统的精度和可靠性。     

基于组合EKF的自主水下航行器SLAM

针对标准扩展卡尔曼滤波(EKF)在噪声统计特性不准确、系统模型与实际模型无法完全匹配情况下滤波精度严重下降的问题,提出了一种基于Sage-Husa自适应EKF和强跟踪EKF组合的SLAM(同步定位与地图构建)算法.首先建立了AUV(自主水下航行器)的动力学模型、特征模型以及传感器的测量模型,然后通过Hough变换进行特征提取,最终采用组合EKF实现了自主水下航行器的同步定位与地图构建.海试数据仿真试验表明本文所提方法降低了噪声统计特性时变以及模型不精确对系统的影响,提高了SLAM系统的精确性和鲁棒性.     

自适应卡尔曼滤波在组合导航中的应用研究

对惯性导航系统（INS）与全球导航系统（GPS）分别进行了具体探讨,对比了两者的优缺点,针对INS／GPS组合导航系统中由于模型不准或因量测噪声的复杂多变造成的发散问题,引入了一种基于输出相关法的自适应卡尔曼滤波技术。通过在自适应滤波算法中推算最优稳态增益来调整量测噪声,抑制滤波器的发散,为GPS／INS组合导航系统实现高精度导航提供了有效的途径。仿真结果表明该算法能很好地对系统状态进行最优估计并适应系统噪声的变化,具有比常规卡尔曼滤波更高的导航精度。     

基于粒子滤波的AUV组合导航方法

讨论了粒子滤波器和RB(Rao-Blackwellised)粒子滤波器两种滤波方法在组合导航中的应用,给出了组合导航算法用于自治水下航行器(AUV)的具体数学模型,并且与拓展卡尔曼滤波器的导航结果进行比较.利用AUV湖上试验验证了3种算法的导航性能,试验结果表明RBPF组合导航算法能够获得最好的导航精度;然而通过对算法进行分析,发现其计算复杂度高于其余两种滤波算法.     

The stability analysis of the adaptive fading extended Kalman filter using the innovation covariance

The well-known conventional Kalman filter gives the optimal solution but to do so, it requires an accurate system model and exact stochastic information. However, in a number of practical situations, the system model and the stochastic information are incomplete. The Kalman filter with incomplete information may be degraded or even diverged. To solve this problem, a new adaptive fading filter using a forgetting factor has recently been proposed by Kim and co-authors. This paper analyzes the stability of the adaptive fading extended Kalman filter (AFEKF), which is a nonlinear filter form of the adaptive fading filter. The stability analysis of the AFEKF is based on the analysis result of Reif and co-authors for the EKF. From the analysis results, this paper shows the upper bounded condition of the error covariance for the filter stability and the bounded value of the estimation error. Keywords: Adaptive Kalman filter, forgetting factor, nonlinear filter, stability analysis. Recommended by Editorial Board member Huanshui Zhang under the direction of Editor Young Il Lee. Kwang-Hoon Kim received the Ph.D. degree in the School of Electrical Engineering and Computer Science at Seoul National University in 2006. His research interests include Kalman Filtering, GNSS/INS integration system, and GNSS signal processing algorithm. Gyu-In Jee received the Ph.D. degree in Systems Engineering from Case Western Reserve University in 1989. His research interests include Indoor GPS positioning, Software GPS receiver, GPS/Galileo baseband FPGA design, and IEEE 802.16e based wireless location system. Chan-Gook Park received the Ph.D. degree in Control and Instrumenta-tion Engineering from Seoul National University in 1993. His research interests include INS/GPS integration system, inertial sensor calibration, navigation and control for micro aerial vehicles, and estimation theory. Jang-Gyu Lee received the Ph.D. degree from the University of Pittsburgh in 1977. He is currently a Professor at the School of Electrical Engineering and Computer Science at Seoul National University. His research interests include micro inertial sensors, inertial navigation systems, GPS, and filtering theory.     

基于卡尔曼滤波的无人机组合导航系统设计

针对卡尔曼滤波在实际应用中遇到的系统通常不是严格线性的问题,改进了在组合导航系统中常用的卡尔曼滤波方法,用扩展卡尔曼滤波对INS和外部测量源的信息进行融合,推导了无人机GPS辅助惯性导航系统的导航方程.通过分析GPS和INS的定位原理,建立了GPS和INS的误差模型.完成了以INS为主导航系统,GPS作为辅助系统的组合导航系统的扩展卡尔曼滤波设计.最后,将线性卡尔曼滤波和扩展卡尔曼滤波的结果进行了仿真对比分析,结果表明:扩展卡尔曼滤波更适合系统为非线性的情况.     

卡尔曼滤波系统和量测噪声自适应估计的关联性

卡尔曼滤波是惯导系统(INS)/GPS组合导航的主要算法之一,Sage-Husa算法是在卡尔曼滤波基础上,为减少系统噪声和量测噪声的不确定性对误差估计的影响而采用的自适应估计方法.对Sage-Husa算法提出了4条改进措施;并通过在3种数据扰动情形下的仿真计算发现,只对一类噪声做自适应估计更容易产生较大的偏差,对系统噪声和量测噪声两类噪声同时做自适应估计,其效果要优于只对一类噪声做自适应估计,把此现象定义为卡尔曼滤波的系统和量测噪声自适应估计的关联性.这个结果不同于一些文献的观点.此项研究对自适应卡尔曼滤波在INS/GPS组合导航的工程化应用有较高的实用价值.     

基于移动长基线的多AUV 协同导航

基于扩展卡尔曼滤波（EKF）理论研究了多AUV 协同导航定位的移动长基线算法．移动长基线多AUV 协同导航结构中,主AUV 内部装备高精度导航设备,从AUV 内部装备低精度导航设备,外部均装备水声装置测量 相对位置关系,利用移动长基线算法融合内部和外部传感器信息,实时获取从AUV 的位置信息．建立了协同导航 系统数学模型,设计了EKF 协同导航算法,在各种测试情况下通过仿真验证了所推导的分析结果,对EKF 和几何 解方程算法的导航效果进行了比较．研究结果表明,以主AUV 作为移动的长基线节点时,通过EKF 算法可以显著 提高群体的导航定位精度．     

基于cubature Kalman filter的INS/GPS组合导航滤波算法

INS/GPS组合导航系统的本质是非线性的,为改善非线性下INS/GPS组合导航精度,提出将一种新的非线性滤波cubature Kalman filter（CKF）应用于INS/GPS组合导航中.为此,建立了基于平台失准角的非线性状态模型和以速度误差及位置误差描述的观测模型,分析了CKF滤波原理,设计了INS/GPS组合滤波器,对组合导航非线性模型进行了仿真.仿真结果显示,相对于扩展卡尔曼滤波（EKF）,CKF降低了姿态、位置和速度估计误差,CKF更适合于处理组合导航的状态估计问题.