Merge pull request #1137 from tier4/hotfix/v0.20.1/avoidance-2

fix(static_drivable_area_expansion): fix invalid z-pos (autowarefoundation#6357)
tier4 · Feb 8, 2024 · bb0fec3 · bb0fec3
2 parents 91b8c62 + 36d52e9
commit bb0fec3
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/...g/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp b/...g/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp
@@ -1347,7 +1347,7 @@ std::pair<std::vector<lanelet::ConstPoint3d>, bool> getBoundWithFreeSpaceAreas(
 
       if (intersect.has_value()) {
         ret.emplace_back(
-          lanelet::InvalId, intersect.value().x, intersect.value().y, intersect.value().z);
+          lanelet::InvalId, intersect.value().x, intersect.value().y, toGeomMsgPt(bound.at(i)).z);
         break;
       }
     }