Method ForEachNodeIdx

generator/routing_helpers.cpp:70–126

  }

  virtual void ForEachNodeIdx(uint64_t wayID, uint32_t candidateIdx, m2::PointU pt,
                              std::function<void(uint32_t, uint32_t)> const & fn) override
  {
    auto it = m_osm2features.find(base::MakeOsmWay(wayID));
    if (it == m_osm2features.end())
      return;

    auto const & fIDs = it->second;
    if (fIDs.size() == 1)
    {
      // Fast lane when mapped feature wasn't changed.
      fn(fIDs[0], candidateIdx);
      return;
    }

    auto const fullRect = mercator::Bounds::FullRect();

    for (uint32_t featureID : fIDs)
    {
      auto ft = m_featureGetter.GetFeatureByIndex(featureID);
      CHECK(ft, (featureID));

      // Skip non-line features (e.g., barriers on area boundaries)
      if (ft->GetGeomType() != feature::GeomType::Line)
      {
        // Use LDEBUG to reduce log spam for features processed multiple times per vehicle type
        LOG(LDEBUG, ("Skipping non-line feature", featureID, "for node penalty mapping"));
        continue;
      }

      // Conversion should work with the same logic as in WayNodesMapper::EncodePoint.
      auto const mercatorPt = PointUToPointD(pt, kPointCoordBits, fullRect);
      double minSquareDist = 1.0E6;

      ft->ParseGeometry(FeatureType::BEST_GEOMETRY);

      uint32_t const count = ft->GetPointsCount();
      uint32_t resIdx = 0;
      for (uint32_t i = 0; i < count; ++i)
      {
        auto const p = ft->GetPoint(i);
        double const d = p.SquaredLength(mercatorPt);
        if (d < minSquareDist)
        {
          minSquareDist = d;
          resIdx = i;
        }
      }

      // Final check to ensure that we have got exact point with Feature coordinates encoding.
      if (PointDToPointU(ft->GetPoint(resIdx), kFeatureSorterPointCoordBits, fullRect) ==
          PointDToPointU(mercatorPt, kFeatureSorterPointCoordBits, fullRect))
      {
        fn(featureID, resIdx);
      }
    }
  }
};