Working Clustering Algorithm

The algorithm for clustering is working, however there a logic errors
that adds data to multiple centroids. Looking over original algorithm to
find solution.