计算成本路径

1、先用成本距离得到成本栅格和成本方向，然后再用成本路径得到最终路径。