优先队列广搜,水过。。。不过广搜输出比较麻烦,需要把点串起来