Формула Хаверсина Unity

Question

Итак, я пытаюсь использовать формулу гаверсина в Unity, чтобы получить расстояние между двумя разными точками (широта и длительность). Код работает (без ошибок), но я не получаю неверный результат. Я следовал всей формуле, поэтому я не знаю, где проблема математики/кода. Есть идеи?

Вот код:

public float lat1 = 42.239616f; 
public float lat2 = -8.72304f; 
public float lon1 = 42.239659f; 
public float lon2 = -8.722305f; 

void operacion(){ 
float R = 6371000; // metres 
float omega1 = ((lat1/180)*Mathf.PI); 
float omega2 = ((lat2/180)*Mathf.PI); 
float variacionomega1 = (((lat2 - lat1)/180)*Mathf.PI); 
float variacionomega2 = (((lon2 - lon1)/180) * Mathf.PI); 
float a = Mathf.Sin(variacionomega1/2) * Mathf.Sin(variacionomega1/2) + 
      Mathf.Cos(omega1) * Mathf.Cos(omega2) * 
      Mathf.Sin(variacionomega2/2) * Mathf.Sin(variacionomega2/2); 
float c = 2 * Mathf.Atan2(Mathf.Sqrt(a), Mathf.Sqrt(1-a)); 

float d = R * c; 
} 

Answer 1

Я думаю, что эта линия неправильна:

float c = 2 * Mathf.Atan2(Mathf.Sqrt(a), Mathf.Sqrt(1-a)); 

ОБНОВЛЕНО:

Правильный путь будет:

float c = 2 * Mathf.Asin(Mathf.Sqrt(a));