Initial C++ fast kmeans implementation

From https://kvsoceanvis.googlecode.com/svn-history/r271/trunk/pcs/FastKMeansClustering.cpp
Ugly but working port of kmeans from C++ to Java