fixed waypoint moving issue