21 #include <navgraph/constraints/polygon_node_constraint.h> 58 if (!polygons_.empty()) {
68 for (
auto p : polygons_) {
69 Point point(node.x(), node.y());
70 if (in_poly(point, p.second)) {
virtual ~NavGraphPolygonNodeConstraint()
Virtual empty destructor.
Simple point representation for polygon.
Fawkes library namespace.
NavGraphPolygonNodeConstraint(const std::string &name)
Constructor.
Constraint that blocks nodes within and edges touching a polygon.
virtual bool compute(void)
Perform compuations before graph search and to indicate re-planning.
std::vector< Point > Polygon
A vector of points makes a polygon.
Constraint that can be queried to check if a node is blocked.
virtual bool blocks(const fawkes::NavGraphNode &node)
Check if constraint blocks a node.