Collision avoidance with differential drive robots using MPC-ORCA

摘要

This work describes a distributed solution using Model Predictive Control (MPC), including the collision avoidance algorithm ORCA applied to mobile robots following individual trajectories. Differential drive robots are used, defined by their position on the plane and controlled by velocity commands. Based on an explicit system model and velocity constraints designated by the collision avoidance algorithm, the MPC-ORCA computes optimal control actions to minimize a cost function over a prediction horizon. The methodology can efficiently handle multivariable control systems using state-space model representation and convex quadratic programming (QP). Simulation results show that the combined strategy MPC-ORCA provided smooth and collision-free trajectories in a changing environment. It also requires no trajectory replanning neither direct communication between agents.