fix minor by in GetWaypoints2D