Fault Detection and Exclusion for Tightly Coupled GNSSINS System Considering Fault in State Prediction To ensure navigation integrity for safetycritical applications, this paper proposes an efficient Fault Detection and Exclusion (FDE) scheme for tightly coupled navigation system of Global Navigation Satellite Systems (GNSS) and Inertial Navigation System (INS). Special emphasis is placed on the potential faults in the Kalman Filter state prediction step (defined as xe2x80x9cfilter faultxe2x80x9d), which could be caused by the undetected faults occurring previously or the Inertial Measurement Unit (IMU) failures. The integration model is derived first to capture the features and impacts of GNSS faults and filter fault. To accommodate various fault conditions, two independent detectors, which are respectively designated for GNSS fault and filter fault, are rigorously established based on hypothesistest methods. Following a detection event, the newlydesigned exclusion function enables (a) identifying and removing the faulty measurements and (b) eliminating the effect of filter fault through filter recovery. Moreover, we also attempt to avoid wrong exclusion events by analyzing the underlying causes and optimizing the decision strategy for GNSS fault exclusion accordingly. The FDE scheme is validated through multiple simulations, where high efficiency and effectiveness have been achieved in various fault scenarios.

OutlierRobust Manifold PreIntegration for INSGPS Fusion We tackle the INSGPS sensor fusion problem for pose estimation, particularly in the common setting where the INS components (IMU and magnetometer) function at much higher frequencies than GPS, and where the magnetometer and GPS are prone to giving erroneous measurements (outliers) due to magnetic disturbances and glitches. Our main contribution is a novel nonlinear optimization framework that (1) fuses preintegrated IMU and magnetometer measurements with GPS, in a manner that respects the manifold structure of the state space; and (2) supports the usage of robust norms and efficient large scale optimization to effectively mitigate the effects of outliers. Through extensive experiments, we demonstrate the superior accuracy and robustness of our approach over filtering methods (which are customarily applied in the target setting) with minimal impact to computational efficiency. Our work further illustrates the strength of optimization approaches in state estimation problems and paves the way for their adoption in the control and navigation communities.