This paper describes a novel visual simultaneous localization and mapping system based on the UD factored extended Kalman filter. A novel method for marginalizing and initializing state variables is presented, allowing for features to be added and removed directly to and from the covariance factors. An analysis of the number of operations in the marginalization and initialization algorithm are presented. A randomized analysis demonstrates the improvement in numerical stability over the standard and Joseph-form extended Kalman filter by as much as three orders of magnitude. The navigation system is implemented on an 80 kg unmanned aerial vehicle and a 0.5 kg unmanned aerial vehicle, and flight-test and simulation results with a controller in the loop are presented. The flight-test results agree with the simulation results and show a low state error and a consistent error covariance.


    Access

    Check access

    Check availability in my library

    Order at Subito €


    Export, share and cite



    Title :

    Factored Extended Kalman Filter for Monocular Vision-Aided Inertial Navigation


    Contributors:

    Published in:

    Publication date :

    2016-12-01




    Type of media :

    Conference paper , Article (Journal)


    Type of material :

    Electronic Resource


    Language :

    English






    LIDAR-Aided Inertial Navigation with Extended Kalman Filtering for Pinpoint Landing

    Busnardo, David M. / Aitken, Matthew L. / Tolson, Robert H. et al. | NTRS | 2011


    LIDAR-Aided Inertial Navigation with Extended Kalman Filtering for Pinpoint Landing

    D. M. Busnardo / M. L. Aitken / R. H. Tolson et al. | NTIS | 2011