fix: RS16 packet rate calc bug

hyye · May 15, 2019 · 6caeb2d · 6caeb2d
1 parent ec7c70c
commit 6caeb2d
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/rslidar_driver/src/rsdriver.cpp b/rslidar_driver/src/rsdriver.cpp
@@ -199,7 +199,7 @@ bool rslidarDriver::poll(void)
     {
       int packets_rate = ceil(POINTS_ONE_CHANNEL_PER_SECOND/BLOCKS_ONE_CHANNEL_PER_PKT);
       int mode = difop_input_->getReturnMode();
-      if (config_.model == "RS16" && (mode == 1))
+      if (config_.model == "RS16" && (mode == 1 || mode == 2))
       {
         packets_rate = ceil(packets_rate/2);
       }