Added an almost ready version of Hart's 1985 algorith, sample