Resolve "Problem::getState(structure) doesn't care about structure"

Closes #343 (closed)

src/processor/processor_motion.cpp

@@ -491,11 +491,16 @@ VectorComposite ProcessorMotion::getState(const StateStructure& _structure) cons
 
     else
     {
-        // remove states not requested
-        for (const auto& pair_key_vec : state)
+        // remove states not requested by structure
+        auto pair_key_vec_it = state.begin();
+        while (pair_key_vec_it != state.end())
         {
-            if (_structure.find(pair_key_vec.first) == std::string::npos)
-                state.erase(pair_key_vec.first);
+            if (_structure.find(pair_key_vec_it->first) == std::string::npos)
+                pair_key_vec_it = state.erase(pair_key_vec_it);
+
+            else
+                pair_key_vec_it ++;
+
         }
         return state;
     }
@@ -581,11 +586,16 @@ VectorComposite ProcessorMotion::getState(const TimeStamp& _ts, const StateStruc
 
         else
         {
-            // remove states not requested
-            for (const auto& pair_key_vec : state)
+            // remove states not requested by structure
+            auto pair_key_vec_it = state.begin();
+            while (pair_key_vec_it != state.end())
             {
-                if (_structure.find(pair_key_vec.first) == std::string::npos)
-                    state.erase(pair_key_vec.first);
+                if (_structure.find(pair_key_vec_it->first) == std::string::npos)
+                    pair_key_vec_it = state.erase(pair_key_vec_it);
+
+                else
+                    pair_key_vec_it ++;
+
             }
             return state;
         }