diff --git a/rslidar_pointcloud/src/rawdata.cc b/rslidar_pointcloud/src/rawdata.cc index 864bf9e..5e07285 100644 --- 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); }