Simultaneous localization, mapping, and path planning for unmanned vehicle using optimal control

Abstract

Among the huge number of functionalities that are required for autonomous navigation, the most important are localization, mapping, and path planning. In this article, investigation of the path planning problem of unmanned ground vehicle is based on optimal control theory and simultaneous localization and mapping. A new approach of optimal simultaneous localization, mapping, and path planning is proposed. Our approach is mainly affected by vehicle’s kinematics and environment constraints. Simultaneous localization, mapping, and path planning algorithm requires two main stages. First, the simultaneous localization and mapping algorithm depends on the robust smooth variable structure filter estimate accurate positions of the unmanned ground vehicle. Then, an optimal path is planned using the aforementioned positions. The aim of the simultaneous localization, mapping, and path planning algorithm is to find an optimal path planning using the Shooting and Bellman methods which minimizes the final time of the unmanned ground vehicle path tracking. The simultaneous localization, mapping, and path planning algorithm has been approved in simulation, experiments, and including real data employing the mobile robot Pioneer [Formula: see text]. The obtained results using smooth variable structure filter–simultaneous localization and mapping positions and the Bellman approach show path generation improvements in terms of accuracy, smoothness, and continuity compared to extended Kalman filter–simultaneous localization and mapping positions.