Fixed lat lon distance calculation, added test case.