https://9dok.net/document/z1dwox93-branch-bound-approach-mixed-integer-optimal-control-using.html