Image segmentation algorithm of [P Felzenszwalb 2004] for Matlab