[PHP] Razdalja med dvema koordinatama

Uporabil sem tole formulo za izračun razdalje med dvema koordinatama

function vincentyGreatCircleDistance($latitudeFrom, $longitudeFrom, $latitudeTo, $longitudeTo){
  $earthRadius=6372797;
  $latFrom = deg2rad($latitudeFrom);
  $lonFrom = deg2rad($longitudeFrom);
  $latTo = deg2rad($latitudeTo);
  $lonTo = deg2rad($longitudeTo);

  $lonDelta = $lonTo - $lonFrom;
  $a = pow(cos($latTo) * sin($lonDelta), 2) +
    pow(cos($latFrom) * sin($latTo) - sin($latFrom) * cos($latTo) * cos($lonDelta), 2);
  $b = sin($latFrom) * sin($latTo) + cos($latFrom) * cos($latTo) * cos($lonDelta);

  $angle = atan2(sqrt($a), $b);
  //return $angle * $earthRadius;
  return number_format(($angle * $earthRadius) / 1000, 3, '.', '');
}

Kar mi vrne nekaj, kar ne vem kaj je. Če vnesem iste koordinate za prvo in drugo točko dobim distanco ~1119km. Razdalja bi morala biti blizu 0.0km. Je kdo že delal kaj podobnega in ma kakšno rešitev, ki deluje?

Poglej si tole kodo za referenco:
http://www.johndcook.com/python_longitu...

Teli tvoji kvadrati mi ne grejo v račun.

Uff, sintaktični škrat v kodi :) latitude v to sm mu napačno dajal..No sej pol to je to; če pa kdo dobi še kakšno bolšo varianto se pa priporočam.