From 36d52e96e0eaad2afe5b4c5a544b4369118c162d Mon Sep 17 00:00:00 2001
From: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Date: Thu, 8 Feb 2024 18:07:33 +0900
Subject: [PATCH] fix(static_drivable_area_expansion): fix invalid z-pos
 (#6357)

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
---
 .../src/utils/drivable_area_expansion/static_drivable_area.cpp  | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/planning/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp b/planning/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp
index 18627e8396239..abad804503476 100644
--- a/planning/behavior_path_planner_common/src/utils/drivable_area_expansion/static_drivable_area.cpp
+++ b/planning/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;
       }
     }