Update EgoEntity::setMapPose to not call getRouteLanelets

Signed-off-by: yamacir-kit <[email protected]>
tier4 · Jan 27, 2025 · a663fc4 · a663fc4
1 parent b1fc84b
commit a663fc4
Showing 1 changed file with 7 additions and 1 deletion.
diff --git a/simulation/traffic_simulator/src/entity/ego_entity.cpp b/simulation/traffic_simulator/src/entity/ego_entity.cpp
@@ -283,7 +283,13 @@ auto EgoEntity::setMapPose(const geometry_msgs::msg::Pose & map_pose) -> void
   entity_status.lanelet_pose_valid = false;
   // prefer current lanelet on Autoware side
   status_->set(
-    entity_status, helper::getUniqueValues(getRouteLanelets()),
+    entity_status, helper::getUniqueValues([this]() {
+      auto ids = lanelet::Ids();
+      for (const auto & point : getPathWithLaneId().points) {
+        ids += point.lane_ids;
+      }
+      return ids;
+    }()),
     getDefaultMatchingDistanceForLaneletPoseCalculation());
 }
 }  // namespace entity