diff --git a/src/graph-optimizer.cc b/src/graph-optimizer.cc
index 7f8e838453f5339aadbe172dbac34a2f1ee7e231..af60207740e913204e6531e476cdde576efe98c3 100644
--- a/src/graph-optimizer.cc
+++ b/src/graph-optimizer.cc
@@ -75,7 +75,7 @@ namespace hpp {
           toConcat = pathOptimizer_->optimize (toOpt);
         }
         i_s = i_e;
-        opted->concatenate (*toConcat);
+        opted->concatenate (toConcat);
       }
       pathOptimizer_.reset ();
       return opted;
diff --git a/src/graph/guided-state-selector.cc b/src/graph/guided-state-selector.cc
index 4bd7e93917313d23b444d90f009ffe947d3567f3..78bad90323861ab17efe14380304bc8c6de3294f 100644
--- a/src/graph/guided-state-selector.cc
+++ b/src/graph/guided-state-selector.cc
@@ -58,7 +58,7 @@ namespace hpp {
           Astar alg (roadmap_->distance (), wkPtr_.lock(), static_cast <RoadmapNodePtr_t> (roadmap_->initNode ()));
           list = alg.solution (from);
         } else {
-          core::Nodes_t::const_iterator itg = roadmap_->goalNodes ().begin ();
+          core::NodeVector_t::const_iterator itg = roadmap_->goalNodes ().begin ();
           for (; itg != roadmap_->goalNodes ().end (); ++itg)
             if ((*itg)->connectedComponent () == from->connectedComponent ())
               break;