diff --git a/src/graph/edge.cc b/src/graph/edge.cc index 1a3c5cd73c7be1e516f4cb3f0bfe2d2d2cf0cb9a..f0fad668f20c12b5108d248fb9f789418349d8e7 100644 --- a/src/graph/edge.cc +++ b/src/graph/edge.cc @@ -18,6 +18,7 @@ #include <sstream> +#include <hpp/pinocchio/configuration.hh> #include <hpp/core/path-vector.hh> #include <hpp/core/path-validation.hh> @@ -282,6 +283,7 @@ namespace hpp { ConfigurationIn_t q2) const { + using pinocchio::displayConfig; core::SteeringMethodPtr_t sm (steeringMethod_->get()); if (!sm) { buildPathConstraint (); @@ -304,7 +306,8 @@ namespace hpp { } } else { std::ostringstream oss; - oss << "The initial configuration does not satisfy the constraints of" + oss << "The initial configuration " << displayConfig (q1) + << " does not satisfy the constraints of" " edge " << name () << "." << std::endl; oss << "The graph is probably malformed"; throw std::runtime_error (oss.str ().c_str ());