Constrained Unscented Particle Filter for SINS/GNSS/ADS Integrated Airship Navigation in the Presence of Wind Field Disturbance

摘要

Due to the disturbance of wind field, it is difficult to achieve precise airship positioning and navigation in the stratosphere. This paper presents a new constrained unscented particle filter (UPF) for SINS/GNSS/ADS (inertial navigation system/global navigation satellite system/atmosphere data system) integrated airship navigation. This approach constructs a wind speed model to describe the relationship between airship velocity and wind speed using the information output from ADS, and further establishes a mathematical model for SINS/GNSS/ADS integrated navigation. Based on these models, it also develops a constrained UPF to obtain system state estimation for SINS/GNSS/ADS integration. The proposed constrained UPF uses the wind speed model to constrain the UPF filtering process to effectively resist the influence of wind field on the navigation solution. Simulations and comparison analysis demonstrate that the proposed approach can achieve optimal state estimation for SINS/GNSS/ADS integrated airship navigation in the presence of wind field disturbance.