Add buffer clearing when calling deactivate() or activate(). (DLu#33)

Author: chaiso-krit

range_sensor_layer/include/range_sensor_layer/range_sensor_layer.h

@@ -31,6 +31,8 @@ class RangeSensorLayer : public costmap_2d::CostmapLayer
                             double* min_x, double* min_y, double* max_x, double* max_y);
   virtual void updateCosts(costmap_2d::Costmap2D& master_grid, int min_i, int min_j, int max_i, int max_j);
   virtual void reset();
+  virtual void deactivate();
+  virtual void activate();
 
 private:
   void reconfigureCB(range_sensor_layer::RangeSensorLayerConfig &config, uint32_t level);

range_sensor_layer/src/range_sensor_layer.cpp

@@ -470,4 +470,14 @@ void RangeSensorLayer::reset()
   activate();
 }
 
+void RangeSensorLayer::deactivate()
+{
+  range_msgs_buffer_.clear();
+}
+
+void RangeSensorLayer::activate()
+{
+  range_msgs_buffer_.clear();
+}
+
 } // end namespace