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.     

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

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

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

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

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

对惯性导航系统（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更适合于处理组合导航的状态估计问题.     

INS/GPS组合导航系统卡尔曼滤波的并行实现*

本文采用并行处理技术对ＩＮＳ／ＧＰＳ组合导航系统中卡尔曼滤波的实时性问题进行了研究。     

基于INS/GPS/COMPASS的AUV组合式导航定位算法

导航定位问题是自主式水下机器人研究(AUV)的主要内容之一,本文针对一种开架式AUV设计了一种采用间接反馈校正的捷联惯性导航与GPS、罗盘相组合的导航方案,其中采用卡尔曼滤波器接收两套导航子系统对同一导航参数输出值的差值,经过滤波计算估计出各误差量。仿真实验的结果表明,SINS/GPS/COMPASS组合导航对SINS误差随时间不断加大的现象起到了很好的抑制作用,能够满足AUV定位精度的要求。     

Merits and limitations of using fuzzy inference system for temporal integration of INS/GPS in vehicular navigation

Most of the present vehicular navigation systems rely on global positioning system (GPS) combined with inertial navigation system (INS) for reliable determination of the vehicle position and heading. Integrating both systems provide several advantages and eliminate their individual shortcomings. Kalman filter (KF) has been widely used to fuse data from both systems. However, KF-based integration techniques suffer from several limitations related to its immunity to noise, observability and the necessity of accurate stochastic models of sensor random errors. This article investigates the potential use of adaptive neuro-fuzzy inference system (ANFIS) for temporal integration of INS/GPS in vehicular navigation. An ANFIS-based module named “P–δP” is designed, developed, implemented and tested for fusing INS and GPS position information. The fusion process aims at providing continuous correction of INS position to prevent its long-term growth using GPS position updates. In addition, it provides reliable prediction of the vehicle position during GPS outages. The P–δP module was examined using real navigation system data compromising an Ashtech Z12 GPS receiver and a Honeywell LRF-III INS. The proposed module proved to be successful as a modeless and platform independent module that does not require a priori knowledge of the navigation equipment utilized. Limitations of the ANFIS module are also discussed.     

基于信息融合的组合导航系统研究

针对GPS接收机在高机动工作状态或受遮挡时易出现“丢星”现象而导致定位中断的问题,提出了一种采用GPS／GLONASS／INS组俣导航系统对载体进行快速定位、定向的新方法。文中首先总结了GPS导航系统的不足,在此基础上给出了组合系统的设计方案和工作原理,然后对基于联合卡尔曼滤波的多传感器信息融合算法进行了论述与分析,最后给出了计算机仿真。结果表明：该方法可有效地提高导航系统的精度和可靠性,为融合导航系统的数据分析和处理提供了一个有效途径。     

变增益联邦KF组合导航定位算法研究

GPS接收模块解算出的伪距误差是GPS/INS组合导航系统的主要误差,采用一种二级联邦卡尔曼滤波组合导航算法加以削弱,将卫星接收模块解算出的伪距信息和多普勒频移信息在第一级卡尔曼滤波后,再通过主滤波器与INS模块解算出的信息进行修正处理,得到校正量和定位位置最优估计。随着滤波步数增加,系统预测误差方差阵逐渐趋于零,状态估计会过分依赖旧量测值,从而导致滤波发散,影响系统定位精度。为有效提高新量测值的修正作用,在联邦卡尔曼滤波组合导航算法中引入一种可变加权系数。仿真结果表明,改进后的变增益联邦卡尔曼滤波算法具备联邦卡尔曼滤波的优点,并且该算法滤波效果有较明显的改善,能有效抑制滤波发散,提高系统的定位精度。     

Enhancing positioning accuracy of GPS/INS system during GPS outages utilizing artificial neural network

Integrated global positioning system and inertial navigation system (GPS/INS) have been extensively employed for navigation purposes. However, low-grade GPS/INS systems generate erroneous navigation solutions in the absence of GPS signals and drift very fast. We propose in this paper a novel method to integrate a low-grade GPS/INS with an artificial neural network (ANN) structure. Our method is based on updating the INS in a Kalman filter structure using ANN during GPS outages. This study focuses on the design, implementation and integration of such an ANN employing an optimum multilayer perceptron (MLP) structure with relevant number of layers/perceptrons and an appropriate learning. As a result, a land test is conducted with the proposed ANN + GPS/INS system and we here provide the system performance with the land trials.     

A low-cost INS/GPS integration methodology based on random forest regression

This paper, for the first time, introduces a random forest regression based Inertial Navigation System (INS) and Global Positioning System (GPS) integration methodology to provide continuous, accurate and reliable navigation solution. Numerous techniques such as those based on Kalman filter (KF) and artificial intelligence approaches exist to fuse the INS and GPS data. The basic idea behind these fusion techniques is to model the INS error during GPS signal availability. In the case of outages, the developed model provides an INS error estimates, thereby maintaining the continuity and improving the navigation solution accuracy. KF based approaches possess several inadequacies related to sensor error model, immunity to noise, and computational load. Alternatively, neural network (NN) proposed to overcome KF limitations works unsatisfactorily for low-cost INS, as they suffer from poor generalization capability due to the presence of high amount of noise.In this study, random forest regression has shown to effectively model the highly non-linear INS error due to its improved generalization capability. To evaluate the proposed method effectiveness in bridging the period of GPS outages, four simulated GPS outages are considered over a real field test data. The proposed methodology illustrates a significant reduction in the positional error by 24–56%.     

Adaptive fuzzy neuro-observer applied to low cost INS/GPS

A combined MEMS Inertial Navigation System (INS) with GPS is used to provide position and velocity data of land vehicles. Data fusion of INS and GPS measurements are commonly achieved through a conventional Extended Kalman filter (EKF). Considering the required accurate model of system together with perfect knowledge of predefined error models, the performance of the EKF is decreased due to unmodeled nonlinearities and unknown bias uncertainties of MEMS inertial sensors. Universal knowledge based approximators comprising of neural networks and fuzzy logic methods are capable of approximating the nonlinearities and the uncertainties of practical systems. First, in this paper, a new fuzzy neural network (FNN) function approximator is used to model unknown nonlinear systems. Second, the process of design and real-time implementation of an adaptive fuzzy neuro-observer (AFNO) in integrated low-cost INS/GPS positioning systems is proposed. To assess the long time performance of the proposed AFNO method, wide range tests of a real INS/GPS with a car vehicle have been performed. The unbiased estimation results of the AFNO show the superiority of the proposed method compared with the classic EKF and the adaptive neuro-observer (ANO) including a pure artificial neural network (ANN) function approximator.     

基于联邦UKF算法的移动机器人自主组合导航

组合导航技术是解决地面机器人自主导航的一个有效途径,其中GPS/DR是一种典型的组合方式。常用的卡尔曼滤波主要用于处理线性问题,针对该导航系统非线性的特点,对Unscented卡尔曼滤波（UKF）与分散式滤波技术相结合的方法进行了研究,建立了用于GPS/DR导航系统的联邦UKF算法。数值仿真实验表明,联邦UKF比联邦EKF有更好的滤波精度,同时有更高的稳定性和容错性,是一种理想的GPS/DR导航非线性滤波方法。     

基于模糊逻辑的自适应卡尔曼滤波在GPS/INS组合导航中的应用

提出了一种利用模糊逻辑控制器来在线调节卡尔曼滤波器的自适应数据融合方法,并着重研究了其在GPS/INS组合导航中的应用．根据位置误差系数和卡尔曼滤波器的新息的统计信息，采用模糊逻辑控制器对卡尔曼滤波器进行连续修正，将卡尔曼滤波器调整到最优状态，从而提高组合导航系统的精度．仿真结果证明这种方法比标准卡尔曼滤波具有更高的精度．