https://9lib.org/document/zgwg7e7y-combining-iterations-nonlinear-predictive-control-realize-squatting-motions.html