Bug in multiThreading seems fixed
Mean shift added for detection, need improvements