diff --git a/include/laser/capture/capture_laser_3d.h b/include/laser/capture/capture_laser_3d.h
index 7917cb0d7e5d50f9623350d069f70238558edfab..5eeb0e23622b0ec279b6b5621f5d96ad36110b3e 100644
--- a/include/laser/capture/capture_laser_3d.h
+++ b/include/laser/capture/capture_laser_3d.h
@@ -41,7 +41,8 @@ class CaptureLaser3d : public CaptureBase
   public:
     CaptureLaser3d(const TimeStamp& _timestamp, SensorBasePtr _sensor, pcl::PointCloud<pcl::PointXYZ>::Ptr _point_cloud);
     ~CaptureLaser3d();
-    pcl::PointCloud<pcl::PointXYZ>::Ptr getPointCloud() const;
+    pcl::PointCloud<pcl::PointXYZ>::Ptr getPointCloud();
+    pcl::PointCloud<pcl::PointXYZ>::ConstPtr getPointCloud() const;
 
     
   private:
diff --git a/src/capture/capture_laser_3d.cpp b/src/capture/capture_laser_3d.cpp
index 63fe33ceb4f4e9b5bb7ac54408d9d9c3902c3f27..3377b2910ba37c076a45a6c6dae7487403fd64a6 100644
--- a/src/capture/capture_laser_3d.cpp
+++ b/src/capture/capture_laser_3d.cpp
@@ -33,7 +33,12 @@ CaptureLaser3d::CaptureLaser3d(const TimeStamp& _timestamp, SensorBasePtr _senso
 
 CaptureLaser3d::~CaptureLaser3d() {}
 
-pcl::PointCloud<pcl::PointXYZ>::Ptr CaptureLaser3d::getPointCloud() const
+pcl::PointCloud<pcl::PointXYZ>::Ptr CaptureLaser3d::getPointCloud()
+{
+    return point_cloud_;
+}
+
+pcl::PointCloud<pcl::PointXYZ>::ConstPtr CaptureLaser3d::getPointCloud() const
 {
     return point_cloud_;
 }