ArrayList<Integer[]> toVisit = new ArrayList<Integer[]>();
    Integer [] origin = {0,0};
    toVisit.add(origin);