added conservative resize in LaserScanProcessed struct...

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;