onlineMPC Implementation of the paper "Fast nonlinear Model Predictive Control for unified trajectory optimization and tracking " Everything in Matlab. Psuedocode followed from the paper.