Rewrote clustering algorithm as iterative rather than recursive, working on ros integration