code: public int add(WaypointNode node) {
  		size++;
  		if (freeSlots.size() > 0){
  			int position = freeSlots.getFirst();
  			openList.set(position, node);
  			freeSlots.removeFirst();
  			return position;
  		} else{
  			openList.add(node);
  			return openList.size() - 1;
  		}
  	}
docs: /*
  METHODS