Applied frame_id argument

include/lipkg.h

@@ -93,6 +93,8 @@ class LiPkg
   sensor_msgs::msg::LaserScan GetLaserScan() {return output;}
   void setStamp(rclcpp::Time timeStamp) {output.header.stamp = timeStamp;}
 
+  void setFrameId(std::string frameId) {frame_id = frameId;}
+
 private:
   uint16_t mTimestamp;
   double mSpeed;
@@ -105,6 +107,7 @@ class LiPkg
   FrameData mFrameData;
   sensor_msgs::msg::LaserScan output;
   void ToLaserscan(std::vector < PointData > src);
+  std::string frame_id;
 };
 
 class LD00_LiPkg: public LiPkg

launch/ld08.launch.py

@@ -18,15 +18,23 @@
 
 
 from launch import LaunchDescription
+from launch.substitutions import LaunchConfiguration
 from launch_ros.actions import Node
 
 
 def generate_launch_description():
+    frame_id = LaunchConfiguration("frame_id", default="base_scan")
+    namespace = LaunchConfiguration('namespace')
 
-    return LaunchDescription([
-        Node(
-            package='ld08_driver',
-            executable='ld08_driver',
-            name='ld08_driver',
-            output='screen'),
-    ])
+    return LaunchDescription(
+        [
+            Node(
+                namespace=namespace,
+                package="ld08_driver",
+                executable="ld08_driver",
+                name="ld08_driver",
+                parameters=[{"frame_id": frame_id}],
+                output="screen",
+            ),
+        ]
+    )

src/lipkg.cpp

@@ -230,7 +230,7 @@ void LiPkg::ToLaserscan(std::vector<PointData> src)
   // Calculate the number of scanning points
   unsigned int beam_size = ceil((angle_max - angle_min) / angle_increment);
   // output.header.stamp = rclcpp::Time::now();
-  output.header.frame_id = "base_scan";
+  output.header.frame_id = frame_id;
   output.angle_min = angle_min;
   output.angle_max = angle_max;
   output.range_min = range_min;

src/main.cpp

@@ -30,10 +30,15 @@ int main(int argc, char ** argv)
   rclcpp::Publisher<sensor_msgs::msg::LaserScan>::SharedPtr lidar_pub;
 
   LiPkg * pkg;
-  std::string product;
+  std::string product, frame_id;
   int32_t ver = 8;
   pkg = new LD08_LiPkg;
 
+  node->declare_parameter<std::string>("frame_id");
+  node->get_parameter_or<std::string>("frame_id", frame_id, "base_scan");
+
+  pkg->setFrameId(frame_id);
+
   CmdInterfaceLinux cmd_port(ver);
   std::vector<std::pair<std::string, std::string>> device_list;
   std::string port_name;