Add an exception when failed to get current lanelet in EgoEntity::requestAssignRoute

HansRobo · HansRobo · commit e80970f31f4e · 2025-05-28T23:38:45.000+09:00
diff --git a/simulation/traffic_simulator/src/entity/ego_entity.cpp b/simulation/traffic_simulator/src/entity/ego_entity.cpp
@@ -265,6 +265,9 @@ void EgoEntity::requestAssignRoute(
     routing_configuration.allow_lane_change = true;
     if (auto current_lanelet_pose = getCanonicalizedLaneletPose()) {
       route_segments.push_back(make_segment(current_lanelet_pose->getLaneletId()));
+    } else {
+      throw common::Error(
+        "Failed to get current lanelet of ego entity. (", __FILE__, ":", __LINE__, ")");
     }
 
     for (size_t i = 0; i < route.size(); ++i) {

Original file line number	Diff line number	Diff line change
`@@ -265,6 +265,9 @@ void EgoEntity::requestAssignRoute(`
`265`	`265`	`routing_configuration.allow_lane_change = true;`
`266`	`266`	`if (auto current_lanelet_pose = getCanonicalizedLaneletPose()) {`
`267`	`267`	`route_segments.push_back(make_segment(current_lanelet_pose->getLaneletId()));`
	`268`	`+ } else {`
	`269`	`+ throw common::Error(`
	`270`	`+ "Failed to get current lanelet of ego entity. (", __FILE__, ":", __LINE__, ")");`
`268`	`271`	`}`
`269`	`272`
`270`	`273`	`for (size_t i = 0; i < route.size(); ++i) {`