Resolve "Publish odom"

Closes #266 (closed)

include/core/processor/is_motion.h

@@ -22,6 +22,7 @@ class IsMotion
 {
     public:
 
+        IsMotion(const StateStructure& _structure);
         virtual ~IsMotion();
 
         // Queries to the processor:
@@ -29,15 +30,33 @@ class IsMotion
         virtual VectorComposite getState(const StateStructure& _structure = "") const = 0;
         virtual VectorComposite getState(const TimeStamp& _ts, const StateStructure& _structure = "") const = 0;
 
+        VectorComposite getOdometry ( ) const;
+    private:
+        void setOdometry(const VectorComposite& _zero_odom) {odometry_ = _zero_odom;}
+
+    public:
         const StateStructure& getStateStructure ( ) { return state_structure_; };
         void setStateStructure(std::string _state_structure) { state_structure_ = _state_structure; };
         void addToProblem(ProblemPtr _prb_ptr, IsMotionPtr _motion_ptr);
-   
+
     protected:
         StateStructure state_structure_; ///< The structure of the state vector (to retrieve state blocks from frames)
+        VectorComposite odometry_;
 
 };
 
+inline IsMotion::IsMotion(const StateStructure& _structure) :
+        state_structure_(_structure)
+{
+    //
+}
+
+
+inline wolf::VectorComposite IsMotion::getOdometry ( ) const
+{
+    return odometry_;
+}
+
 }
 
 /////  IMPLEMENTATION ///////