From ddff75465ca49b04bf22d2fbe26f61aa4bff7acb Mon Sep 17 00:00:00 2001
From: HiepLM <hiepleminh01@gmail.com>
Date: Fri, 5 Dec 2025 11:37:19 +0700
Subject: [PATCH] Hiep update

---
 include/costmap_2d/utils.h | 6 +++++-
 1 file changed, 5 insertions(+), 1 deletion(-)

diff --git a/include/costmap_2d/utils.h b/include/costmap_2d/utils.h
index 73ecb22..b8b4dd8 100644
--- a/include/costmap_2d/utils.h
+++ b/include/costmap_2d/utils.h
@@ -26,7 +26,11 @@ namespace costmap_2d
             if (p.size() != 2)
                 throw std::runtime_error("Footprint point must be [x, y]");
 
-            fp.push_back(geometry_msgs::Point{p[0].as<double>(), p[1].as<double>()});
+            geometry_msgs::Point point;
+            point.x = p[0].as<double>();
+            point.y = p[1].as<double>();
+            point.z = 0.0;
+            fp.push_back(point);
         }
         std::cout << "Loaded footprint with " << fp.size() << " points." << std::endl;