modified updateWaypoint() and createWaypointGraphAtMap()
corrected a mistake and make comment clearer