Adaptive Huber-Based Filter for Hypersonic Cruise Vehicle Navigation

The navigation for hypersonic cruise vehicle (HCV) is a challenging task because of the complex vehicle dynamic and sensor measurement noise it suffered. This paper proposes a kind of adaptive robust Kalman filter using Mahalanobis distance for HCV navigation. The innovation-based adaptive estimation is discussed first. Based on Mahalanobis distance theory, a kind of robust covariance matrix estimation method is used to modify the innovation-based adaptive Kalman filter. Considering that the vehicle maneuver characteristics and noise statistics parameters varies during different periods, dual-freguency tuning for unknown noise statistics is designed based on this. The algorithm proposed by this paper is applied to hypersonic cruise vehicle navigation. Simulation has been made to verify the performance of the new algorithm according to HCV flight profile and characteristics; both Gaussian and non-Gaussian simulation are included.