Haversine公式Unity

Question

所以我試圖在Unity中使用haversine公式來獲得兩個不同點（緯度和縱向給定）之間的距離。代碼工作（沒有錯誤），但我一直gettting錯誤的結果。我遵循整個公式，所以我不知道數學/代碼問題在哪裏。任何想法？

下面的代碼：

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));