Зачем изобретать свой собственный калькулятор расстояний, есть класс, встроенный в класс Location .
Выезд
distanceBetween(double startLatitude, double startLongitude, double endLatitude, double endLongitude, float[] results)
Computes the approximate distance in meters between two locations, and optionally the initial and final bearings of the shortest path between them.