RRTNode* p() const;
/*! Set parent node. */
+ void p(RRTNode& p, bool can_be_too_close);
void p(RRTNode& p);
/*! Get number of backward-forward direction changes.
/*! Set if the parent node is cusp (direction changed from parent). */
void p_is_cusp(bool isit);
+ /*! Return true if p would be cusp if set as parent of this. */
+ bool would_be_cusp_if_parent(RRTNode const& p) const;
+
bool operator==(RRTNode const& n);
};