Trajectory Planning and Tracking Strategy Applied to an Unmanned Ground Vehicle in the Presence of Obstacles

In a dynamic environment, moving to the destination safely and effectively is of paramount importance for an unmanned ground vehicle (UGV). This article presents a strategy of trajectory planning and tracking that aims to ensure the UGV’s safety in an uncertain environment. Specifically, based on the initial environment information, a global optimal trajectory connecting the start and the destination is predefined by an artificial fish swarm algorithm (AFSA). In the presence of unforeseen obstacles, a trial-based forward search (TFS) algorithm based on the Markov chain is proposed in the local trajectory planning module, while collision prediction is integrated as heuristic information. The vehicle’s current state is updated accordingly for the sake of avoiding entire state spaces involved in the computation. Therefore, the storage efficiency and convergence rate in local path planning are sufficiently enhanced in comparison to dynamic programming. Moreover, command signals can be calculated with the proposed multiconstrained model predictive controller (MMPC), ensuring the vehicle to track the reference trajectory and smoothen the motion. Finally, the results in both simulations and experiments reveal the effectiveness of the proposed algorithm in the presence of both static and dynamic obstacles.
Note to Practitioners
—This article is motivated by the unmanned ground vehicle (UGV) collision avoidance problem in practical missions, such as farming and emergency response. In recent years, various trajectory planning and tracking algorithms have been widely developed. However, the environmental complexity and the intruders’ unexpected movement pose difficulties in trajectory planning, especially in ensuring the computation time under the allowable threshold. Moreover, the UGV practical trajectory tracking is a challenging task which demands a desired response within various physical constraints. In this article, a two-stage conflict resolution system is proposed. First, a trial-based forward search (TFS) is used to generate a new trajectory deviating the UGV from the initially generated trajectory by the artificial fish swarm algorithm (AFSA), aiming to avoid the unforeseen intruders (unknown in prior) in real-time. Using these two trajectory planning algorithms alternatively, both global trajectory optimality in a cluttered environment and appropriate maneuvers with respect to unexpected intruders can be achieved. Subsequently, the UGV is modeled according to its kinematic characteristics, and thus a multiconstrained model predictive controller (MMPC) is designed to follow the reference trajectory. The physical constraints are respected by integrating them into the controller. Simulations and experimental results demonstrate that the proposed strategy can guide and control a UGV from the start to the destination safely and smoothly, even in the case of multiple obstacles with constant or varying velocities. Furthermore, the proposed collision avoidance strategy can be extended to other unmanned systems, including unmanned aerial vehicles and unmanned surface vehicles.