路径规划算法结果输出并测试