Hiep update

2025-12-05 11:37:19 +07:00
parent af43332b28
commit ddff75465c
1 changed files with 5 additions and 1 deletions
--- 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;