https://9dok.net/document/q5mr98or-global-optimal-control-direct-multiple-shooting-method.html