Refactored KMeans
Merge branch 'KmeansRefactoring' into develop
Merge branch 'develop' of https://github.com/eluechin/KinectAutoCalibration into develop