Abstract. High accuracy positioning is crucial for various applications that require accurate and reliable positioning data, such as autonomous vehicles (AVs), agriculture, and intelligent transportation. Global Positioning System (GPS) is widely used in integration with Inertial Measurement Unit (IMU) and Visual Odometry (VO) to implement an accurate and robust navigation system. However, the performance of the integrated system can be severely degraded in urban environments due to non-line-of-sight (NLOS) reception and multipath interference. To overcome these challenges, a novel Fault Detection and Exclusion (FDE) algorithm aided with IMU and VO measurements is proposed to identify and isolate the contaminated satellite signals. The algorithm utilizes instantaneous measurements from IMU and VO to predict the current vehicle position, enabling the estimation of pseudorange errors in GPS measurements. A FDE algorithm based on Hierarchical clustering is then developed to identify GPS signals with significant errors based on the predicted pseudorange error. An experimental field test was conducted using a land vehicle to evaluate the effectiveness of the proposed algorithm. The results show that the GPS/IMU/VO integrated navigation system with the proposed FDE algorithm has significantly improved the positioning accuracy and reliability compared to the traditional system. The proposed algorithm achieves a positioning accuracy with a 3D Root Mean Square Error (RMSE) of 11.18m in urban environment, making an improvement of 68.2% over the traditional GPS/IMU/VO integrated navigation system.
Read full abstract