Skip to content
Snippets Groups Projects
Commit 71df5a8b authored by Joseph Mirabel's avatar Joseph Mirabel Committed by Joseph Mirabel
Browse files

Remove WaypointEdge::direction.

parent 5f4e428f
No related branches found
No related tags found
No related merge requests found
...@@ -232,8 +232,6 @@ namespace hpp { ...@@ -232,8 +232,6 @@ namespace hpp {
const GraphWkPtr_t& graph, const StateWkPtr_t& from, const GraphWkPtr_t& graph, const StateWkPtr_t& from,
const StateWkPtr_t& to); const StateWkPtr_t& to);
virtual bool direction (const core::PathPtr_t& path) const;
virtual bool canConnect (ConfigurationIn_t q1, ConfigurationIn_t q2) const; virtual bool canConnect (ConfigurationIn_t q1, ConfigurationIn_t q2) const;
virtual bool build (core::PathPtr_t& path, ConfigurationIn_t q1, ConfigurationIn_t q2) const; virtual bool build (core::PathPtr_t& path, ConfigurationIn_t q1, ConfigurationIn_t q2) const;
......
...@@ -85,28 +85,6 @@ namespace hpp { ...@@ -85,28 +85,6 @@ namespace hpp {
return !(src_contains_q0 && (!src_contains_q1 || dst_contains_q1)); return !(src_contains_q0 && (!src_contains_q1 || dst_contains_q1));
} }
bool WaypointEdge::direction (const core::PathPtr_t& path) const
{
Configuration_t q0 = path->initial (),
q1 = path->end ();
const bool src_contains_q0 = waypoints_.back().second->contains (q0);
const bool dst_contains_q0 = to ()->contains (q0);
const bool src_contains_q1 = waypoints_.back().second->contains (q1);
const bool dst_contains_q1 = to ()->contains (q1);
/// See Edge::direction for Karnaugh table
/// true if reverse
if ( (!src_contains_q0 && !src_contains_q1)
|| (!dst_contains_q0 && !dst_contains_q1)
|| (!src_contains_q0 && !dst_contains_q0))
HPP_THROW (std::runtime_error,
"Edge " << name() << " does not seem to have generated path from"
<< pinocchio::displayConfig(q0) << " to "
<< pinocchio::displayConfig(q1)
);
return !(src_contains_q0 && (!src_contains_q1 || dst_contains_q1));
}
bool Edge::intersectionConstraint (const EdgePtr_t& other, bool Edge::intersectionConstraint (const EdgePtr_t& other,
ConfigProjectorPtr_t proj) const ConfigProjectorPtr_t proj) const
{ {
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment