feat: array HORI_ANGLE[] initialize 0 when RSLidar16

RoboSense-LiDAR · Sep 3, 2019 · 47580ce · 47580ce
1 parent 761bb9e
commit 47580ce
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/rslidar_pointcloud/src/rawdata.cc b/rslidar_pointcloud/src/rawdata.cc
@@ -222,6 +222,12 @@ void RawData::loadConfigFile(ros::NodeHandle node, ros::NodeHandle private_nh)
       VERT_ANGLE[loopn] = b[loopn] * 100;
       HORI_ANGLE[loopn] = d[loopn] * 100;
     }
+
+    if (numOfLasers == 16)
+    {
+      memset(HORI_ANGLE, 0, sizeof(HORI_ANGLE));
+    }
+
     fclose(f_angle);
   }