ms function

Mean-shift mode seeking algorithm