Fixed the haversine formula to calculate distance between 2 points

Fixed formula and added bdd tests.