Function CorrectCandidatesSegmentByOutgoing

libs/routing/turns_generator.cpp:280–345

}

void CorrectCandidatesSegmentByOutgoing(TurnInfo const & turnInfo, Segment const & firstOutgoingSeg,
                                        TurnCandidates & nodes)
{
  double const turnAngle = CalcOneSegmentTurnAngle(turnInfo);
  auto const IsFirstOutgoingSeg = [&firstOutgoingSeg](TurnCandidate const & turnCandidate)
  { return turnCandidate.m_segment == firstOutgoingSeg; };
  auto & candidates = nodes.candidates;
  auto it = find_if(candidates.begin(), candidates.end(), IsFirstOutgoingSeg);
  if (it == candidates.end())
  {
    // firstOutgoingSeg not found. Try to match by angle.
    auto const DoesAngleMatch = [&turnAngle](TurnCandidate const & candidate)
    {
      return (AlmostEqualAbs(candidate.m_angle, turnAngle, 0.001) ||
              fabs(candidate.m_angle) + fabs(turnAngle) > 359.999);
    };
    auto it = find_if(candidates.begin(), candidates.end(), DoesAngleMatch);
    if (it != candidates.end())
    {
      // Match by angle. Update candidate's segment.
      ASSERT(it->m_segment.GetMwmId() != firstOutgoingSeg.GetMwmId(), ());
      ASSERT(it->m_segment.GetSegmentIdx() == firstOutgoingSeg.GetSegmentIdx(), ());
      ASSERT(it->m_segment.IsForward() == firstOutgoingSeg.IsForward(), ());
      it->m_segment = firstOutgoingSeg;
    }
    else if (nodes.isCandidatesAngleValid)
    {
      // Typically all candidates are from one mwm, and missed one (firstOutgoingSegment) from another.
      LOG(LWARNING, ("Can't match any candidate with firstOutgoingSegment but isCandidatesAngleValid == true."));
    }
    else
    {
      LOG(LWARNING, ("Can't match any candidate with firstOutgoingSegment and isCandidatesAngleValid == false"));
      if (candidates.size() == 1)
      {
        auto & c = candidates.front();
        ASSERT(c.m_segment.GetMwmId() != firstOutgoingSeg.GetMwmId(), ());
        ASSERT(c.m_segment.GetSegmentIdx() == firstOutgoingSeg.GetSegmentIdx(), ());
        ASSERT(c.m_segment.IsForward() == firstOutgoingSeg.IsForward(), ());
        c.m_segment = firstOutgoingSeg;
        c.m_angle = turnAngle;
        nodes.isCandidatesAngleValid = true;
        LOG(LWARNING, ("but since candidates.size() == 1, this was fixed."));
      }
      else
        LOG(LWARNING, ("and since candidates.size() > 1, this can't be fixed."));
    }
  }
  else  // firstOutgoingSeg is found.
    if (nodes.isCandidatesAngleValid)
    {
#ifdef DEBUG
      double constexpr eps = 0.001;
      double const diff = fabs(it->m_angle - turnAngle);
      ASSERT(diff < eps || fabs(diff - 360) < eps, (it->m_angle, turnAngle));
#endif
    }
    else