This paper addresses the numerical and statistical stability in the integration of inertial navigation system and global navigation satellite system (GNSS) using Kalman filter (KF). Due to the different units used in horizontal and vertical components of the geodetic (curvilinear) coordinates in the vicinity of the earth’s surface, i.e. radians in the former and meters in the latter, the covariance of the innovation vector in KF, which should be inversed, can be ill-conditioned, resulting in severe numerical instability. A simple rescaling method is proposed to address this problem, specifically, the horizontal components of the positioning error, i.e. the latitude and longitude errors are rescaled by multiplying the average radius of the earth and hence the covariance of the state, and the state space model should be modified accordingly. This method is applicable on most of the earth surface except for two small regions near the poles. Due to the multipath and/or jamming effect under some adverse circumstances, the GNSS measurements are prone to outliers which will degrade the KF’s performance severely. A robust refinement to the KF based on Chi-square test and covariance inflation is proposed to make the integration outlier-resistant, and specifically, in the presence of GNSS measurements, a Chi-square test is carried out to detect outlier, and once detected, the outlier is less weighted by inflating the covariance of the innovation vector, and the inflating factor is solved in closed form. Simulation results validate the efficacy of the proposed method.


    Access

    Check access

    Check availability in my library

    Order at Subito €


    Export, share and cite



    Title :

    Numerically and statistically stable Kalman filter for INS/GNSS integration


    Contributors:
    Liu, Ming (author) / Chang, Guobin (author)


    Publication date :

    2016-02-01


    Size :

    12 pages




    Type of media :

    Article (Journal)


    Type of material :

    Electronic Resource


    Language :

    English





    Robust numerically stable Kalman filter for autonomous vehicles

    BOSSE MICHAEL CARSTEN / COSTANTINO ADRIAN MICHAEL / DAS SUBHASIS et al. | European Patent Office | 2023

    Free access

    Modified federated Kalman filter for INS/GNSS/CNS integration

    Hu, Gaoge / Gao, Shesheng / Zhong, Yongmin et al. | SAGE Publications | 2016



    System and method for hybrid optical/inertial headtracking via numerically stable Kalman filter

    KIRCHNER WILLIAM T / FOOTE BOBBY D / GEORGE CHRISTOPHER L et al. | European Patent Office | 2019

    Free access