AI stay stuck on waypoints