Hdmove2 New!

The lower level is solved using a fast alternating direction method of multipliers (ADMM) that converges in under 5 ms for ( n \leq 128 ).

Re-planning is triggered when: