Intelligent Vehicle Infrastructure Cooperative System is the latest development direction of intelligent transportation, and autonomous navigation technology is the key technology in the field of intelligent transportation. The research of SLAM is especially necessary. However, it is difficult to establish an accurate priori noise model based on Kalman filter for SLAM algorithm. To solve this problem, this paper proposes a fast SLAM algorithm based on improved geese particle swarm optimization algorithm, which effectively improves the local part of the particle optimal and precocious problems. The algorithm of the geese group particle swarm optimization algorithm is improved, the position update formula is designed, and the geese position update is used instead of particle resampling to update the position of the unmanned vehicle . Through matlab simulation experiments and experiments with real datasets, the improved algorithm effectively improves the accuracy of positioning and mapping compared with the standard PSO-FASTSLAM, and verifies the superiority of the algorithm，there is certain practical value for further research on unmanned vehicle. Keywords: SLAM, geese particle swarm algorithm, PSO-SLAM

CICTP