| @@ 168-193 (lines=26) @@ | ||
| 165 | ||
| 166 | $iterations = 0; |
|
| 167 | ||
| 168 | do { |
|
| 169 | $sinλ = sin($λ); |
|
| 170 | $cosλ = cos($λ); |
|
| 171 | $sinSqσ = ($cosU2 * $sinλ) * ($cosU2 * $sinλ) |
|
| 172 | + ($cosU1 * $sinU2 - $sinU1 * $cosU2 * $cosλ) * ($cosU1 * $sinU2 - $sinU1 * $cosU2 * $cosλ); |
|
| 173 | $sinσ = sqrt($sinSqσ); |
|
| 174 | ||
| 175 | if ($sinσ == 0) { |
|
| 176 | return 0; |
|
| 177 | } |
|
| 178 | ||
| 179 | $cosσ = $sinU1 * $sinU2 + $cosU1 * $cosU2 * $cosλ; |
|
| 180 | $σ = atan2($sinσ, $cosσ); |
|
| 181 | $sinα = $cosU1 * $cosU2 * $sinλ / $sinσ; |
|
| 182 | $cosSqα = 1 - $sinα * $sinα; |
|
| 183 | ||
| 184 | if ($cosSqα == 0.0) { |
|
| 185 | $cos2σM = 0; |
|
| 186 | } else { |
|
| 187 | $cos2σM = $cosσ - 2 * $sinU1 * $sinU2 / $cosSqα; |
|
| 188 | } |
|
| 189 | ||
| 190 | $C = $f / 16 * $cosSqα * (4 + $f * (4 - 3 * $cosSqα)); |
|
| 191 | $λp = $λ; |
|
| 192 | $λ = $L + (1 - $C) * $f * $sinα * ($σ + $C * $sinσ * ($cos2σM + $C * $cosσ * (- 1 + 2 * $cos2σM * $cos2σM))); |
|
| 193 | } while (abs($λ - $λp) > 1e-12 && ++ $iterations < 200); |
|
| 194 | ||
| 195 | if ($iterations >= 200) { |
|
| 196 | throw new NotConvergingException('Inverse Vincenty Formula did not converge'); |
|
| @@ 69-101 (lines=33) @@ | ||
| 66 | $cosU1 = cos($U1); |
|
| 67 | $cosU2 = cos($U2); |
|
| 68 | ||
| 69 | do { |
|
| 70 | $sinLambda = sin($lambda); |
|
| 71 | $cosLambda = cos($lambda); |
|
| 72 | ||
| 73 | $sinSigma = sqrt( |
|
| 74 | ($cosU2 * $sinLambda) * ($cosU2 * $sinLambda) + |
|
| 75 | ($cosU1 * $sinU2 - $sinU1 * $cosU2 * $cosLambda) * ($cosU1 * $sinU2 - $sinU1 * $cosU2 * $cosLambda) |
|
| 76 | ); |
|
| 77 | ||
| 78 | if ($sinSigma == 0) { |
|
| 79 | return 0.0; |
|
| 80 | } |
|
| 81 | ||
| 82 | $cosSigma = $sinU1 * $sinU2 + $cosU1 * $cosU2 * $cosLambda; |
|
| 83 | ||
| 84 | $sigma = atan2($sinSigma, $cosSigma); |
|
| 85 | ||
| 86 | $sinAlpha = $cosU1 * $cosU2 * $sinLambda / $sinSigma; |
|
| 87 | ||
| 88 | $cosSqAlpha = 1 - $sinAlpha * $sinAlpha; |
|
| 89 | ||
| 90 | if ($cosSqAlpha == 0) { |
|
| 91 | $cos2SigmaM = 0; |
|
| 92 | } else { |
|
| 93 | $cos2SigmaM = $cosSigma - 2 * $sinU1 * $sinU2 / $cosSqAlpha; |
|
| 94 | } |
|
| 95 | ||
| 96 | $C = $f / 16 * $cosSqAlpha * (4 + $f * (4 - 3 * $cosSqAlpha)); |
|
| 97 | ||
| 98 | $lambdaP = $lambda; |
|
| 99 | ||
| 100 | $lambda = $L + (1 - $C) * $f * $sinAlpha * ($sigma + $C * $sinSigma * ($cos2SigmaM + $C * $cosSigma * (- 1 + 2 * $cos2SigmaM * $cos2SigmaM))); |
|
| 101 | } while (abs($lambda - $lambdaP) > 1e-12 && -- $iterationLimit > 0); |
|
| 102 | ||
| 103 | if ($iterationLimit == 0) { |
|
| 104 | throw new NotConvergingException(); |
|