Localization Uncertainty Constrained Lateral PID Control with Aids of Fuzzy Logic Considering LiDAR NDT Matching Error

Sai Hu ； Yin-Chiu Kan ； Li-Ta Hsu

《Journal of Aeronautics, Astronautics and Aviation》 53卷1期 Vol.53 No.1 (2021/03) Pp. 27-42

https://doi.org/10.6125/JoAAA.202103_53(1).03

摘要

Localization and control are two key parts of autonomous driving. Accurate control relies on accurate positioning. Recently, the localization of autonomous vehicles based on the matching of Light Detection and Ranging (LiDAR) scan and High Definition (HD) map becomes the major solution. However, the matching can still possess meter-level positioning error in challenging areas with excessive dynamic vehicles or sparse features. Inaccurate positioning can result in obvious fluctuation in steering control of the vehicle subsequently, which is not acceptable for autonomous vehicles. In this paper, we propose to estimate the potential positioning uncertainty to further adaptively tune the parameters for the proportional-integral-derivative (PID) controller of vehicle steering. In this case, we can obtain a smoother control. Firstly, we generate the point cloud map of the tested area. Secondly, we correlate the uncertainty and optimal PID parameters using a fuzzy interference system. Finally, both the simulation and real experiments are conducted to validate the proposed method. The simulations show that the proposed adaptive PID controller is more resistant against unexpected positioning uncertainty and smoother control is obtained.

關鍵字

Fuzzy Logic ； Control ； Localization ； Positioning Uncertainty ； Adaptive PID

參考文獻

Montemerlo M, Becker J, Bhat S, Dahlkamp H, Dolgov D, Ettinger S, Haehnel D, et al., “Junior: The Stanford Entry in the Urban Challenge,” Journal of Field Robotics, Vol. 25, No. 9, 2008, pp. 569–597.

Levinson J, Montemerlo M, Thrun S, “Map-Based Precision Vehicle Localization in Urban Environments,” in Robotics Science and Systems, 2007.

Nejad HTN, Do QH, Sakai R, Han L, “Real time localization, path planning and motion control for autonomous parking in cluttered environment with narrow passages,” In Proceedings of the International IEEE Conference on Intelligent Transportation Systems, Anchorage, AK, USA, 16–19 September 2012; pp. 1357–1364.

Tagne G, Talj R, Charara A, “Higher-order sliding mode control for lateral dynamics of autonomous vehicles, with experimental validation,” In Proceedings of the Intelligent Vehicles Symposium, Gold Coast, QLD, Australia, 23–26 June 2013; pp. 678–683.

Takezawa S, Gulrez T, Herath DC, Dissanayake G, “Environmental Recognition forAutonomous Robot using Simultaneous Localization and Map Building (SLAM) (Real Time Path Planning with Dynamical Localized Voronoi Division),” Transactions of the Japan Society of Mechanical Engineers, Vol. 71, 2005, pp. 904–911.