Real-time distributed trajectory planning for mobile robots

• Published in: IFAC-PapersOnLine Vol. 56; no. 2; pp. 2152 - 2157
• Main Authors: Nguyen, Binh, Nghiem, Truong, Nguyen, Linh, Nguyen, Anh Tung, Nguyen, Thang
• Format: Journal Article
• Language: English
• Published: Elsevier Ltd 01.01.2023
• Subjects: Convexification; Distributed Model Predictive Control; Multi-robot Systems; Nonholonomic Trajectory Planning; Real-time Optimization; Distributed Model Predictive Control; Multi-robot Systems; Nonholonomic Trajectory Planning; Real-time Optimization; Convexification
• ISSN: 2405-8963; 2405-8971; 2405-8963
• DOI: 10.1016/j.ifacol.2023.10.1120

Efficiently planning trajectories for nonholonomic mobile robots in formation tracking is a fundamental yet challenging problem. Nonholonomic constraints, complexity in collision avoidance, and limited computing resources prevent the robots from being practically deployed in realistic applications. This paper addresses these difficulties by modeling each mobile platform as a nonholonomic motion and formulating trajectory planning as an optimization problem using model predictive control (MPC). That is, the optimization problem is subject to both nonholonomic motions and collision avoidance. To reduce computing costs in real time, the nonholonomic constraints are convexified by finding the closest nominal points to the nonholonomic motion, which are then incorporated into a convex optimization problem. Additionally, the predicted values from the previous MPC step are utilized to form linear avoidance conditions for the next step, preventing collisions among robots. The formulated optimization problem is solved by the alternating direction method of multiplier (ADMM) in a distributed manner, which makes the proposed trajectory planning method scalable. More importantly, the convergence of the proposed planning algorithm is theoretically proved while its effectiveness is validated in a synthetic environment.