Completed mean-shift

adds tests, sorting of modes.
Updated docs.