fix file utils
This commit is contained in:
commit
22cfd07519
|
|
@ -28,6 +28,7 @@ namespace costmap_2d
|
||||||
geometry_msgs::Point point;
|
geometry_msgs::Point point;
|
||||||
point.x = p[0].as<double>();
|
point.x = p[0].as<double>();
|
||||||
point.y = p[1].as<double>();
|
point.y = p[1].as<double>();
|
||||||
|
point.z = 0.0;
|
||||||
fp.push_back(point);
|
fp.push_back(point);
|
||||||
}
|
}
|
||||||
std::cout << "Loaded footprint with " << fp.size() << " points." << std::endl;
|
std::cout << "Loaded footprint with " << fp.size() << " points." << std::endl;
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue
Block a user