Better non maximum suppression for Fornster
Susan2d

Simple implementation