diff --git a/src/icp.cpp b/src/icp.cpp
index 6536fc649f3b6962a449b4171d681e4c965e8426..4cd599a74fda199e9fcb843dc4abf785450c1e7b 100644
--- a/src/icp.cpp
+++ b/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];