Added DeviceTimeTranslator::resetTranslation method.

Author: HannesSommer

cuckoo_time_translator/include/cuckoo_time_translator/DeviceTimeTranslator.h

@@ -116,6 +116,11 @@ class DeviceTimeTranslator {
    * @return the current one way translator. Stays valid until the next update. Can be null.
    */
   const OneWayTranslator * getCurrentOwt() const;
+
+  /**
+   * Reset the translation state while keeping the expected settings such as expected algorithm or switch time.
+   */
+  void resetTranslation();
  private:
   void configCallback(DeviceTimeTranslatorConfig &config, uint32_t level);
 
@@ -153,7 +158,7 @@ class DeviceTimeUnwrapperAndTranslator {
 
   ros::Time translate(UnwrappedStamp unwrappedStamp) const;
   bool isReadyToTranslate() const;
-  
+
   FilterAlgorithm getCurrentFilterAlgorithm() const {
     return translator.getCurrentFilterAlgorithm();
   }
@@ -176,6 +181,13 @@ class DeviceTimeUnwrapperAndTranslator {
   const OneWayTranslator* getCurrentOwt() const {
     return translator.getCurrentOwt();
   }
+
+  /**
+   * Reset the translation state while keeping the expected settings such as expected algorithm or switch time.
+   */
+  void resetTranslation() {
+    translator.resetTranslation();
+  }
  protected:
   Unwrapper timestampUnwrapper;
   DeviceTimeTranslator translator;

cuckoo_time_translator/src/DeviceTimeTranslator.cpp

@@ -205,6 +205,9 @@ class DeviceTimeTranslator::Impl {
     return timeTranslator_.get();
   }
 
+  void resetTranslation() {
+    timeTranslator_.reset();
+  }
  private:
 
   template <typename Owt>
@@ -310,6 +313,10 @@ void DeviceTimeTranslator::setFilterAlgorithm(FilterAlgorithm filterAlgorithm) {
   pImpl_->setExpectedAlgo(filterAlgorithm);
 }
 
+void DeviceTimeTranslator::resetTranslation() {
+  pImpl_->resetTranslation();
+}
+
 ros::Time DeviceTimeTranslator::update(const TimestampUnwrapper & timestampUnwrapper, const ros::Time & receiveTime, const double offsetSecs) {
   if(!pImpl_) return receiveTime;