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;