From d61637c51b37819a6c7964c4ee7bfc57ae26513c Mon Sep 17 00:00:00 2001
From: jcasals <jcasals@iri.upc.edu>
Date: Wed, 4 Sep 2019 16:08:08 +0200
Subject: [PATCH] Added conversion of laser_data->theta to radians

---
 src/icp.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/src/icp.cpp b/src/icp.cpp
index 6536fc6..4cd599a 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];
 
-- 
GitLab