Add HasStateBlocks::getStateBlockVec()

include/core/state_block/has_state_blocks.h

@@ -27,6 +27,15 @@ class HasStateBlocks
         void appendToStructure(const std::string& _frame_type){structure_ += _frame_type;}
         const std::map<std::string, StateBlockPtr>& getStateBlockMap() const;
         std::map<std::string, StateBlockPtr>& getStateBlockMap();
+        std::vector<StateBlockPtr> getStateBlockVec() const
+        {
+            std::vector<StateBlockPtr> sbv;
+            for (auto& key : structure_)
+            {
+                sbv.push_back(getStateBlock(key));
+            }
+            return sbv;
+        }
 
     public:
         // Some typical shortcuts -- not all should be coded here, see notes below.