fixed bug in icp
changed algrism in color_histogram_mathcer

changed algolism in color_histogram_matcher
added some more algorism

added some algolism