DuongTD/costmap_2d
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Hiep update

Browse Source
This commit is contained in:
HiepLM 2025-12-05 11:37:19 +07:00
parent af43332b28
commit ddff75465c
1 changed files with 5 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
include/costmap_2d/utils.h
View File

@ -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;