Cálculo de la distancia entre dos puntos, usando la latitud longitud?

Aquí está mi intento, es solo un fragmento de mi código:

final double RADIUS = 6371.01;
double temp = Math.cos(Math.toRadians(latA))
            * Math.cos(Math.toRadians(latB))
            * Math.cos(Math.toRadians((latB) - (latA)))
            + Math.sin(Math.toRadians(latA))
            * Math.sin(Math.toRadians(latB));
    return temp * RADIUS * Math.PI / 180;

Estoy usando estas fórmulas para obtener la latitud y longitud:

x = Deg + (Min + Sec / 60) / 60)

Respuestas a la pregunta(6)

Su respuesta a la pregunta