added kmeans
fixed bugs
added Kmeans
added dynamic reconfigure for hsv thresholds. there are dependency issues so it's not fully working. separated kmeans into a different file - this has bugs