fix file utils

This commit is contained in:
duongtd 2025-12-08 11:08:11 +07:00
commit 22cfd07519

View File

@ -28,6 +28,7 @@ namespace costmap_2d
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;