A new method is presented for optimally enforcing an algebraic constraint in Kalman filtering. The method is illustrated in the setting of inertial navigation using extended Kalman filtering. It is shown that to first order in the estimation error the constrained optimal update of the quaternion portion of the state vector is a projection of the unconstrained update onto the constraint space, and the update increment for the quaternion is perpendicular to the a priori estimate. The procedure is easy to implement and appears to provide a nearly optimal solution to the problem of quaternion normalization in the setting of inertial navigation. More importantly, it provides a correction for the covariance update that significantly enhances filter stability. Examples involving initial alignment and inertial navigation illustrate the efficacy of the approach, and the method is compared to several other methods in the literature. Presented as Papers 2007-6686, 2007-6865 at the AIAA Guidance, Navigation, and Control, Hilton Head, SC, 20-23 August 2007


    Access

    Access via TIB

    Check availability in my library

    Order at Subito €


    Export, share and cite



    Title :

    Enforcing an Algebraic Constraint in Extended Kalman Filter Design


    Contributors:


    Publication date :

    2017




    Type of media :

    Article (Journal)


    Type of material :

    Print


    Language :

    English



    Classification :

    BKL:    55.54 Flugführung
    Local classification TIB:    770/7040