diff --git a/src/object_detector.h b/src/object_detector.h
index 35a6711ce1d9dc7e9986b4db608a4d71312c2b96..781c397ac276bdb47573e86c593a53d53a43a34b 100644
--- a/src/object_detector.h
+++ b/src/object_detector.h
@@ -47,7 +47,10 @@ namespace laserscanutils
         // Constructor
         LaserScanProcessed(unsigned int _num_points=10)
         {
-            this->scan_points_matrix_.resize(3,_num_points);
+            std::cout << " DEBUG INIT. LASERSCANPROCESSED: NumPoints = " << _num_points << std::endl;
+            assert(_num_points < 5000 && "Error: saving scan points in laser Scan Processed. Check initialization." );
+            this->scan_points_matrix_.conservativeResize(3,_num_points);
+//            this->scan_points_matrix_.resize(3,_num_points);
             this->odom_pos_ = {0.0, 0.0, 0.0};
             this->odom_ori_ = {0.0, 0.0, 0.0, 0.0};
             this->num_points_in_clusters_ = 0;