三维动态规划,记录上一次的运动方向,AC了