Add constructor and update method to Waypoint
Override Waypoint ToString Method