diff --git a/simulation/traffic_simulator/src/lanelet_wrapper/lanelet_map.cpp b/simulation/traffic_simulator/src/lanelet_wrapper/lanelet_map.cpp index e9f0986e1e1..37f5010022d 100644 --- a/simulation/traffic_simulator/src/lanelet_wrapper/lanelet_map.cpp +++ b/simulation/traffic_simulator/src/lanelet_wrapper/lanelet_map.cpp @@ -151,18 +151,7 @@ auto centerPoints(const lanelet::Ids & lanelet_ids) -> std::vector const auto & points = centerPoints(lanelet_id); center_points.insert(center_points.end(), points.begin(), points.end()); } - std::sort( - center_points.begin(), center_points.end(), [](const Point & lhs, const Point & rhs) -> bool { - if (lhs.x < rhs.x) { - return true; - } else if (lhs.x == rhs.x && lhs.y < rhs.y) { - return true; - } else if (lhs.x == rhs.x && lhs.y == rhs.y && lhs.z < rhs.z) { - return true; - } else { - return false; - } - }); + /// @note We intentionally do not sort here, because only consecutive duplicates are supposed to be removed center_points.erase( std::unique(center_points.begin(), center_points.end()), center_points.end()); return center_points;