Integrated Localization and Planning for Cruise Control of UGV Platoons in Infrastructure-Free Environments

Abstract

This paper investigates the cruise control problem of unmanned ground vehicle (UGV) platoons from the implementation perspective. Unlike most existing works related to platoon cruise control which rely on positioning infrastructures such as lane markings, roadside units, and global navigation satellite systems (GNSS), this paper explores a new problem: platoon cruise control in environments without positioning infrastructures. The introduction of this constraint disables most existing cruise control approaches. To address this problem, an integrated localization and planning framework is proposed, which is composed of three modular algorithms. Firstly, to localize multiple vehicles in a common coordinate system, a collaborative localization algorithm is developed through matching local perceptions of different vehicles. Secondly, to maintain the desired platoon configuration, the historical trajectory of the preceding vehicle is reconstructed, based on which the target state is planned for the following vehicle. Finally, a virtual controller based algorithm is designed to generate feasible trajectories for the following vehicle in real time. The proposed framework has two salient features. Firstly, it does not depend on positioning infrastructures and does not introduce additional positioning sensors, such as GNSS/INS modules, ultra-wideband (UWB) devices, magnetic meters and so on, as long as each vehicle is equipped with a perception sensor (Lidar, radar or camera), which however is essential equipment for nowaday autonomous systems. Secondly, the proposed framework does not depend on direct observations between vehicles to achieve relative localization, making it applicable in non-line-of-sight (non-LOS) situations. Real-world experiments have been conducted to validate the effectiveness, robustness and practicality of the proposed framework.