Better comparison and fix helpers

a) ability to test and compare results for navigation methods for points on surface

b) added some missing implementations + bugfix in new Helpers