https://123dok.org/document/nq77x3nq-cooperative-tracking-using-model-predictive-control.html