Fix the linked list operation error (waypoint)