private SortedList<int, Location> EnsureWaypointsOrigin() { if(_waypointsOrigin == null) { _waypointsOrigin = new SortedList<int, Location>(); } return _waypointsOrigin; }