addInOrder
Add a new node to the NeighborArray. The new node must be worse than all previously stored nodes. This cannot be called after .addOutOfOrder
Add a new node to the NeighborArray. The new node must be worse than all previously stored nodes. This cannot be called after .addOutOfOrder