Added conversion of laser_data->theta to radians

src/icp.cpp

@@ -27,6 +27,9 @@ public:
             ++i;
         }
 
+        for(int i = 0; i < num_rays; ++i){
+            laser_data->theta[i] = laser_data->theta[i] * 0.0175;
+        }
         laser_data->min_theta = laser_data->theta[0];
         laser_data->max_theta = laser_data->theta[num_rays-1];