Adding some test cases for the GeoTool class
Core: Fix getDistance, and getHeading, based on the test cases
Merge pull request #770 from arthurbenemann/issue764

Fixing and adding test cases for the Geotools class