Green: Completed | Orange: Frontier/Queue | Blue: Pivot | Purple: Touched (W) | Pink: Sub-frontier (Si)
O(m log2/3 n)
O(m + n log n)