https://9lib.org/document/zlgv235g-horizon-nonlinear-predictive-control-approximation-application-tracking-trajectory.html