More kmeans stuff in C++ + openmp