Initialize odometry when setting problem

src/processor/processor_base.cpp

@@ -118,7 +118,7 @@ void ProcessorBase::setProblem(ProblemPtr _problem)
     // adding processor is motion to the processor is motion vector
     auto is_motion_ptr = std::dynamic_pointer_cast<IsMotion>(shared_from_this());
     if (is_motion_ptr)
-        getProblem()->addProcessorIsMotion(is_motion_ptr);
+        is_motion_ptr->addToProblem(_problem, is_motion_ptr);
 }
 
 /////////////////////////////////////////////////////////////////////////////////////////