| 16 | } |
| 17 | |
| 18 | double GetShortestDistance(double rad1, double rad2) |
| 19 | { |
| 20 | double constexpr period = 2.0 * math::pi; |
| 21 | rad1 = fmod(rad1, period); |
| 22 | rad2 = fmod(rad2, period); |
| 23 | |
| 24 | double res = rad2 - rad1; |
| 25 | if (fabs(res) > math::pi) |
| 26 | { |
| 27 | if (res < 0.0) |
| 28 | res = period + res; |
| 29 | else |
| 30 | res = -period + res; |
| 31 | } |
| 32 | return res; |
| 33 | } |
| 34 | |
| 35 | double GetMiddleAngle(double a1, double a2) |
| 36 | { |
no outgoing calls