Adding find the closest centroid
Adding centroid computation
Adding centroid initialization