Finally working K-means; some refactoring (Point structure)