https://5dok.org/document/q5mrgn8r-control-hierarchical-quadratic-programming-implementation-evaluation-control-framework.html