public void mergeUnsortedWithSortedList(ArrayList<node> unsorted,ArrayList<node> sorted){
        if(unsorted.size()>0){
            while(unsorted.size()>0){
                for(int i = 0;i<=sorted.size();i++){
                    if(i==sorted.size()){
                        sorted.add(unsorted.get(0));
                        unsorted.remove(0);
                        break;
                    }
                    else if(sorted.get(i).totalCost>unsorted.get(0).totalCost){
                        sorted.add(i,unsorted.get(0));
                        unsorted.remove(0);
                        break;
                    }
                }
            }
        }
    }