diff --git a/src/rbprmbuilder.impl.cc b/src/rbprmbuilder.impl.cc
index 50a9871ef4e32a57b180ac4f469b68dfb8924866..c758c030e934c3b400539a2ff52215716146ac46 100644
--- a/src/rbprmbuilder.impl.cc
+++ b/src/rbprmbuilder.impl.cc
@@ -1594,8 +1594,8 @@ namespace hpp {
             }
             else
             {
-                lastStatesComputed_.insert(lastStatesComputed_.begin(), newStates.begin(), newStates.end());
-                lastStatesComputedTime_.insert(lastStatesComputedTime_.begin(), newTimeStates.begin(), newTimeStates.end());
+                lastStatesComputed_.insert(lastStatesComputed_.end(), newStates.begin(), newStates.end());
+                lastStatesComputedTime_.insert(lastStatesComputedTime_.end(), newTimeStates.begin(), newTimeStates.end());
             }
             return res;
         }
@@ -2305,8 +2305,8 @@ namespace hpp {
         }
         else
         {
-            lastStatesComputed_.insert(lastStatesComputed_.begin(), newStates.begin(), newStates.end());
-            lastStatesComputedTime_.insert(lastStatesComputedTime_.begin(), newTimeStates.begin(), newTimeStates.end());
+            lastStatesComputed_.insert(lastStatesComputed_.end(), newStates.begin(), newStates.end());
+            lastStatesComputedTime_.insert(lastStatesComputedTime_.end(), newTimeStates.begin(), newTimeStates.end());
         }
         return res;
         }