diff --git a/src/graph-path-validation.cc b/src/graph-path-validation.cc
index ffaf6006db30819128e160cae66027e7458dc606..e550786655180a0bd79b42daa2f59d0fb74f6c9c 100644
--- a/src/graph-path-validation.cc
+++ b/src/graph-path-validation.cc
@@ -45,7 +45,8 @@ namespace hpp {
         for (int i = path->numberPaths () - 1; i >= 0; i--) {
           // We should stop at the first non valid subpath.
           if (!impl_validate (path->pathAtRank (i), true, validSubPart)) {
-            PathVectorPtr_t p = PathVector::create (path->outputSize());
+            PathVectorPtr_t p = PathVector::create
+	      (path->outputSize(), path->outputDerivativeSize());
             for (int v = path->numberPaths () - 1; v > i; v--)
               p->appendPath (path->pathAtRank(i)->copy());
             // TODO: Make sure this subpart is generated by the steering method.
@@ -58,7 +59,8 @@ namespace hpp {
         for (size_t i = 0; i != path->numberPaths (); i++) {
           // We should stop at the first non valid subpath.
           if (!impl_validate (path->pathAtRank (i), false, validSubPart)) {
-            PathVectorPtr_t p = PathVector::create (path->outputSize());
+            PathVectorPtr_t p = PathVector::create
+	      (path->outputSize(), path->outputDerivativeSize());
             for (size_t v = 0; v < i; v++)
               p->appendPath (path->pathAtRank(v)->copy());
             // TODO: Make sure this subpart is generated by the steering method.
diff --git a/src/graph/edge.cc b/src/graph/edge.cc
index a6361a036969e85b9eb681a707694a80a4c62335..31f3a7d955f8205ee86d8cd2e6b89e253976920b 100644
--- a/src/graph/edge.cc
+++ b/src/graph/edge.cc
@@ -211,7 +211,9 @@ namespace hpp {
           return false;
         core::PathVectorPtr_t pv = HPP_DYNAMIC_PTR_CAST (core::PathVector, pathToWaypoint);
         if (!pv) {
-          pv = core::PathVector::create (graph_.lock ()->robot ()->configSize ());
+          pv = core::PathVector::create
+	    (graph_.lock ()->robot ()->configSize (),
+	     graph_.lock ()->robot ()->numberDof ());
           pv->appendPath (pathToWaypoint);
         }
         path = pv;