WIP: Resolve "std::set and std::map instead of std::list in wolf nodes"

Closes #213 (closed)

include/core/trajectory/trajectory_base.h

@@ -96,6 +96,7 @@ class TrajectoryBase : public NodeBase, public std::enable_shared_from_this<Traj
                    bool state_blocks,
                    std::ostream& stream = std::cout,
                    std::string _tabs = "") const;
+        void printDebug();
     private:
         FrameBasePtr addFrame(FrameBasePtr _frame_ptr);
         void removeFrame(FrameBasePtr _frame_ptr);