Distributed model predictive control for multi-agent point-to-point transitions.
This code is writed according to the paper "Trajectory Generation for Multiagent Point-To-Point Transitions via Distributed Model Predictive Control".
IEEE Robotics and automation letters.2018
This code is just a simple implementation.