Grassfire算法- 运动规划（Motion planning）