| 193 | } |
| 194 | |
| 195 | double CalcPathTurnAngle(LoadedPathSegment const & segment, size_t const pathIndex) |
| 196 | { |
| 197 | ASSERT_GREATER_OR_EQUAL(segment.m_path.size(), 3, ()); |
| 198 | ASSERT_GREATER(pathIndex, 0, ()); |
| 199 | ASSERT_LESS(pathIndex, segment.m_path.size() - 1, ()); |
| 200 | |
| 201 | return math::RadToDeg(PiMinusTwoVectorsAngle(segment.m_path[pathIndex].GetPoint(), |
| 202 | segment.m_path[pathIndex - 1].GetPoint(), |
| 203 | segment.m_path[pathIndex + 1].GetPoint())); |
| 204 | } |
| 205 | |
| 206 | } // namespace turns |
| 207 | } // namespace routing |
no test coverage detected