Update WaypointMovementGenerator.cpp