MPS 路徑規劃
A: 排序 
B: 排序