[APATH] handle cur/next waypoint
fix GroundMoveType