diff --git a/include/ros2_sick/LMS1xx_node.hpp b/include/ros2_sick/LMS1xx_node.hpp index 2d78240..120b8d2 100644 --- a/include/ros2_sick/LMS1xx_node.hpp +++ b/include/ros2_sick/LMS1xx_node.hpp @@ -25,7 +25,6 @@ #include #include #include -#include #include #include @@ -83,11 +82,6 @@ class Sick : public rclcpp::Node */ void get_measurements(); - /** - * @brief publishes scan messages - */ - void publish_scan(); - /** * @brief publishes cloud messages */ diff --git a/src/LMS1xx_node.cpp b/src/LMS1xx_node.cpp index ce7081e..ca7b380 100644 --- a/src/LMS1xx_node.cpp +++ b/src/LMS1xx_node.cpp @@ -65,7 +65,7 @@ void Sick::connect_lidar() void Sick::construct_scan() { scan_msg.header.frame_id = frame_id; - scan_msg.range_min = 0.01; + scan_msg.range_min = 0.5; scan_msg.range_max = 20.0; scan_msg.scan_time = 100.0 / cfg.scaningFrequency; scan_msg.angle_increment = @@ -158,7 +158,7 @@ void Sick::get_measurements() { scan_msg.intensities[i] = data.rssi1[i]; } - publish_scan(); + ls_publisher_->publish(scan_msg); publish_cloud(); } else @@ -174,8 +174,6 @@ void Sick::get_measurements() laser.disconnect(); } -void Sick::publish_scan() { ls_publisher_->publish(scan_msg); } - void Sick::publish_cloud() { sensor_msgs::msg::PointCloud2 cloud_msg;