Kinematic/Dynamic SLAM for Autonomous Vehicles Using the Linear Parameter Varying Approach

Sensors (Basel). 2022 Oct 26;22(21):8211. doi: 10.3390/s22218211.

Abstract

Most existing algorithms in mobile robotics consider a kinematic robot model for the the Simultaneous Localization and Mapping (SLAM) problem. However, in the case of autonomous vehicles, because of the increase in the mass and velocities, a kinematic model is not enough to characterize some physical effects as, e.g., the slip angle. For this reason, when applying SLAM to autonomous vehicles, the model used should be augmented considering both kinematic and dynamic behaviours. The inclusion of dynamic behaviour implies that nonlinearities of the vehicle model are most important. For this reason, classical observation techniques based on the the linearization of the system model around the operation point, such as the well known Extended Kalman Filter (EKF), should be improved. Consequently, new techniques of advanced control must be introduced to more efficiently treat the nonlinearities of the involved models. The Linear Parameter Varying (LPV) technique allows working with nonlinear models, making a pseudolinear representation, and establishing systematic methodologies to design state estimation schemes applying several specifications. In recent years, it has been proved in many applications that this advanced technique is very useful in real applications, and it has been already implemented in a wide variety of application fields. In this article, we present a SLAM-based localization system for an autonomous vehicle considering the dynamic behaviour using LPV techniques. Comparison results are provided to show how our proposal outperforms classical observation techniques based on model linearization.

Keywords: Kalman Filter; LMI; LPV; SLAM; autonomous vehicles.

Grants and funding

This work has been co-financed by the Spanish State Research Agency (AEI) and the European Regional Development Fund (ERFD) through the project SaCoAV (ref. MINECO PID2020-114244RB-I00), by the European Regional Development Fund of the European Union in the framework of the ERDF Operational Program of Catalonia 2014–2020 (ref. 001-P-001643 Looming Factory) and by the DGR of Generalitat de Catalunya (SAC group ref. 2017/SGR/482). Authors are also supported by an Industrial PhD AGAUR grant (Ref. 2019 DI 040).