Finished maze solver and got union find (Disjoint set) working