fix file utils

This commit is contained in:
2025-12-08 11:03:49 +07:00
parent af43332b28
commit d37daab594
4 changed files with 9 additions and 6 deletions

View File

@@ -25,8 +25,10 @@ namespace costmap_2d
for (const auto& p : node) {
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>();
fp.push_back(point);
}
std::cout << "Loaded footprint with " << fp.size() << " points." << std::endl;