Add timestamp to capture in printeaders

src/capture/capture_base.cpp

@@ -232,7 +232,7 @@ void CaptureBase::setProblem(ProblemPtr _problem)
 
 void CaptureBase::printHeader(int _depth, bool _constr_by, bool _metric, bool _state_blocks, std::ostream& _stream, std::string _tabs) const
 {
-    _stream << _tabs << "Cap" << id() << " " << getType();
+    _stream << _tabs << "Cap" << id() << " " << getType() << " ts = " << std::setprecision(3) << getTimeStamp();
 
     if(getSensor() != nullptr)
     {
@@ -261,8 +261,7 @@ void CaptureBase::printHeader(int _depth, bool _constr_by, bool _metric, bool _s
         }
         else if (_metric)
         {
-            _stream << _tabs << (isFixed() ? "Fix" : "Est") << ", ts=" << std::setprecision(5)
-                    << getTimeStamp();
+            _stream << _tabs << (isFixed() ? "Fix" : "Est");
             _stream << ",\t x= ( " << std::setprecision(2) << getStateVector() << " )";
             _stream << std::endl;
         }

src/capture/capture_motion.cpp

@@ -72,7 +72,7 @@ bool CaptureMotion::containsTimeStamp (const TimeStamp& _ts, double _time_tolera
 
 void CaptureMotion::printHeader(int _depth, bool _constr_by, bool _metric, bool _state_blocks, std::ostream& _stream, std::string _tabs) const
 {
-    _stream << _tabs << "CapM" << id() << " " << getType();
+    _stream << _tabs << "CapM" << id() << " " << getType() << " ts = " << std::setprecision(3) << getTimeStamp();
 
     if(getSensor() != nullptr)
     {