Optimal cooperative collision avoidance between multiple robots based on Bernstein–Bézier curves

In this paper a new cooperative collision-avoidance method for multiple, nonholonomic robots based on Bernstein–Bézier curves is presented. The main contribution focuses on an optimal, cooperative, collision avoidance for a multi-robot system where the velocities and accelerations of the mobile robots are constrained and the start and the goal velocity are defined for each robot. The optimal path of each robot, from the start pose to the goal pose, is obtained by minimizing the penalty function, which takes into account the sum of all the path lengths subjected to the distances between the robots, which should be larger than the minimum distance defined as the safety distance, and subjected to the velocities and accelerations, which should be lower than the maximum allowed for each robot. The model-predictive trajectory tracking is used to drive the robots on the obtained reference paths. The results of the path planning, real experiments and some future work ideas are discussed.