Tree/graph QP interface
Implement new interface where QP is defined as a graph, where nodes correspond to stages, and edges correspond to shooting equalities. The graph interface can be based on Boost Graph Library.
Implement new interface where QP is defined as a graph, where nodes correspond to stages, and edges correspond to shooting equalities. The graph interface can be based on Boost Graph Library.