Michael Neunert, Cedric de Crousaz, Fadri Furrer, Mina Kamel, Farbod Farshidian, Roland Siegwart, Jonas Buchli: Fast nonlinear Model Predictive Control for unified trajectory optimization and tracking. ICRA 2016: 1398-1404