修改寻路算法

使地图的长宽可以作为参数传递给算法