Adding some test cases for the GeoTool class
Core: Fix getDistance, and getHeading, based on the test cases